JP2022063624A - Work vehicle control system, work vehicle control method, and work vehicle - Google Patents

Abstract

To automatically control a pitch angle of a blade in accordance with a work state of a work vehicle.SOLUTION: A control system for a work vehicle, which comprises a vehicle body and a work machine capable of changing a height and a pitch with respect to the vehicle body, has a controller. The controller: determines a switch point with reference to target displacement data showing target displacement in the height of the work machine in accordance with a travel distance of the work vehicle from a work start position; determines whether or not the work vehicle reaches the switch point on the basis of the travel distance of the work vehicle from the work start position; and outputs a command to change a pitch of the work machine when the work vehicle is determined to reach the switching point.SELECTED DRAWING: Figure 7

Description

The present disclosure relates to a work vehicle control system, a work vehicle control method, and a work vehicle.

Patent Document 1 discloses a technique relating to a bulldozer that improves the efficiency of excavation, soil transportation, and soil removal by switching the pitch angle of blades. According to Patent Document 1, the pitch angle of the blade can be changed by tilting the operation lever with the tilt / pitch changeover switch turned on.

Japanese Unexamined Patent Publication No. 7-252859

On the other hand, when the pitch angle of the blade is manually adjusted as in the technique described in Patent Document 1, if the operator makes a mistake in the operation timing or operation amount, the work efficiency may decrease.

An object of the present disclosure is to provide a work vehicle control device for automatically controlling a blade pitch according to a work state of the work vehicle, and a work vehicle control method.

According to the first aspect of the present invention, it is a control system of a work vehicle having a vehicle body and a work machine capable of changing the height and pitch with respect to the vehicle body, and includes a controller. The controller determines the switching point with reference to the target displacement data indicating the target displacement of the height of the work machine according to the amount of movement of the work vehicle from the work start position. The controller determines whether or not the work vehicle has reached the switching point based on the amount of movement of the work vehicle from the work start position. When it is determined that the work vehicle has reached the switching point, the controller outputs a command to change the pitch of the work machine.

According to the second aspect of the present invention, it is a control method of a work vehicle having a vehicle body and a work machine capable of changing the height and pitch with respect to the vehicle body, and includes the following processing. In the first process, the switching point is determined with reference to the target displacement data indicating the target displacement of the height of the work machine according to the movement amount of the work vehicle from the work start position. The second process determines whether or not the work vehicle has reached the switching point based on the amount of movement of the work vehicle from the work start position. The third process outputs a command to change the pitch of the work machine when it is determined that the work vehicle has reached the switching point.

According to the third aspect of the present invention, the work vehicle includes a vehicle body, a work machine whose height and pitch can be changed with respect to the vehicle body, and a controller. The controller determines the switching point with reference to the target displacement data indicating the target displacement of the height of the work machine according to the amount of movement of the work vehicle from the work start position. The controller determines whether or not the work vehicle has reached the switching point based on the amount of movement of the work vehicle from the work start position. When it is determined that the work vehicle has reached the switching point, the controller outputs a command to change the pitch of the work machine so that the work machine tilts backward with respect to the vehicle body.

According to the above aspect, the control device can automatically control the pitch of the blades according to the working state of the work vehicle.

It is a side view of the work vehicle which concerns on 1st Embodiment. It is a figure which shows the posture of the blade which concerns on 1st Embodiment. It is a block diagram which shows the structure of the drive system and the control system of the work vehicle which concerns on 1st Embodiment. It is a schematic block diagram which shows the structure of the controller of the work vehicle which concerns on 1st Embodiment. It is a flowchart which shows the process of control of the work machine which concerns on 1st Embodiment. It is a figure which shows the example of the final design topography, the present state topography, and the target design topography which concerns on 1st Embodiment. It is a figure which shows the example of the target displacement data which concerns on 1st Embodiment. It is a flowchart which shows the process for determining the target displacement which concerns on 1st Embodiment. It is a figure which shows the fluctuation of the height of the blade which concerns on 1st Embodiment. It is a block diagram which shows the structure of the drive system and the control system which concerns on 1st modification. It is a block diagram which shows the structure of the drive system and the control system which concerns on the 2nd modification.

<First Embodiment>
Hereinafter, embodiments will be described in detail with reference to the drawings.
FIG. 1 is a side view of the work vehicle 100 according to the first embodiment.
The work vehicle 100 according to the first embodiment is, for example, a bulldozer. The work vehicle 100 includes a vehicle body 110, a traveling device 120, and a working machine 130.

The vehicle body 110 has a driver's cab 140. The driver's cab 140 is provided on the upper part of the vehicle body 110. A driver's seat (not shown) is arranged in the driver's cab 140. The traveling device 120 is provided at the lower part of the vehicle body 110. The traveling device 120 has a pair of left and right tracks 121, a sprocket 122, and an idler 124. In FIG. 1, only the left crawler belt 121, the sprocket 122, and the idler 124 are shown. The work vehicle 100 travels due to the rotation of the crawler belt 121. The traveling of the work vehicle 100 may be in any form of autonomous traveling, semi-autonomous traveling, and traveling operated by an operator. A rotation sensor 123 is provided on the rotation axis of the sprocket 122. The rotation sensor 123 measures the rotation speed of the rotation axis of the sprocket 122. The rotation speed of the rotation shaft of the sprocket 122 can be converted into the speed of the traveling device 120 and the movement amount of the vehicle body 110.

The working machine 130 is used for excavating and transporting an excavated object such as earth and sand. The working machine 130 is provided at the front portion of the vehicle body 110. The working machine 130 has a lift frame 131, a blade 132, a lift cylinder 133, and a pitch cylinder 134.

The lift frame 131 is attached to the side surface of the vehicle body 110 via a pin extending in the vehicle width direction. The lift frame 131 is rotatably supported in the vertical direction with respect to the vehicle body 110 about the axis X1 extending in the vehicle width direction. The lift frame 131 supports the blade 132.

The blade 132 is attached to the front of the vehicle body 110 via the lift frame 131. The blade 132 is rotatably supported with respect to the lift frame 131 about an axis X2 extending in the vehicle width direction. The blade 132 moves up and down as the lift frame 131 moves up and down. A cutting edge 132e is provided at the lower end of the front surface of the blade 132.

The lift cylinder 133 is a hydraulic cylinder. The lift cylinder 133 is connected to the vehicle body 110 and the blade 132. As the lift cylinder 133 expands and contracts, the lift frame 131 and the blade 132 rotate in the vertical direction about the axis X1.

The pitch cylinder 134 is a hydraulic cylinder. The pitch cylinder 134 is connected to the lift frame 131 and the blade 132. As the pitch cylinder 134 expands and contracts, the blade 132 rotates about the axis X2 with respect to the lift frame 131. More specifically, as the pitch cylinder 134 extends, the blade 132 tilts forward (pitch dump) with respect to the lift frame 131 about the axis X2. As the pitch cylinder 134 shrinks, the blade 132 tilts (pitch back) rearward of the vehicle body about the axis X2 with respect to the lift frame 131.

FIG. 2 is a diagram showing the posture of the blade 132 according to the first embodiment. The blade 132 is switched to an excavation posture, a soil transport posture, and a soil discharge posture by a controller 320 described later. The excavation posture is a posture in which the angle of the cutting edge of the blade 132 is the first angle (for example, 52 degrees) with respect to the bottom surface of the track 121. The soil transportation posture is a posture in which the angle of the cutting edge of the blade 132 is set as the second angle by inclining the blade 132 to the rear of the vehicle body as much as possible. The soil removal posture is a posture in which the angle of the cutting edge of the blade 132 is set to the third angle by inclining the blade 132 to the front of the vehicle body. The first angle is larger than the second angle and smaller than the third angle.

FIG. 3 is a block diagram showing a configuration of a drive system 200 and a control system 300 of the work vehicle 100 according to the first embodiment.

<< Drive system 200 >>
The drive system 200 includes a power source 210, a PTO (Power Take Off) 220, a power transmission device 230, and a hydraulic pump 240.

The power source 210 is, for example, a diesel engine.

The PTO 220 transmits a part of the driving force of the power source 210 to the hydraulic pump 240. That is, the PTO 220 distributes the driving force of the power source 210 to the power transmission device 230 and the hydraulic pump 240.

The power transmission device 230 transmits the driving force of the power source 210 to the traveling device 120. The power transmission device 230 may be, for example, an HST (Hydro Static Transmission). Alternatively, the power transmission device 230 is, for example, a torque converter, a transmission having a plurality of transmission gears, an HMT (Hydraulic Mechanical Transmission), or an electric transmission device in which a generator and a drive electric motor are combined. May be good.

The hydraulic pump 240 is driven by the power source 210 and discharges hydraulic oil. The hydraulic oil discharged from the hydraulic pump 240 is supplied to the lift cylinder 133 and the pitch cylinder 134 via the control valve 330. The control valve 330 controls the flow rate of the hydraulic oil discharged from the hydraulic pump 240.

<< Control system 300 >>
The control system 300 includes an operating device 310, a controller 320, and a control valve 330.

The operating device 310 is a device for operating the working machine 130 and the traveling device 120. The operating device 310 is arranged in the driver's cab 140. The operation device 310 receives an operation by an operator for driving the working machine 130 and the traveling device 120, and outputs an operation signal corresponding to the operation. The operating device 310 includes, for example, an operating lever, a pedal, a switch, and the like.

The operating device 310 includes a pitch operating switch 312 for controlling the pitch of the blade 132. The pitch operation switch 312 is, for example, a momentary switch that can be operated at a pitch dump position and a pitch back position. The operation signal of the pitch operation switch 312 is output to the controller 320. In response to the operation signal from the pitch operation switch 312, the controller 320 sends a command signal for controlling the pitch cylinder 134 so that the blade 132 rotates about the axis X2 with respect to the lift frame 131. Output to. The controller 320 controls the control valve 330 so that the blade 132 tilts forward of the vehicle body when the operation position of the pitch operation switch 312 is the pitch dump position. The controller 320 controls the control valve 330 so that the blade 132 tilts to the rear of the vehicle body when the operation position of the pitch operation switch 312 is the pitch back position. The pitch operation switch 312 may be composed of two push buttons that output pitch dump operation signals and pitch back operation signals, respectively.

The controller 320 controls the work vehicle 100. The controller 320 automatically controls the working machine 130 based on the current topography of the construction site, the final design surface, and the measured values of various sensors by a program described later.

The control valve 330 is a proportional control valve and is controlled by a command signal from the controller 320. The control valve 330 is arranged between the hydraulic actuators such as the lift cylinder 133 and the pitch cylinder 134 and the hydraulic pump 240. The control valve 330 controls the flow rate of the hydraulic oil supplied from the hydraulic pump 240 to the lift cylinder 133 and the pitch cylinder 134. The controller 320 generates a command signal to the control valve 330 so that the blade 132 operates in response to the operation of the operating device 310 described above. As a result, the lift cylinder 133 and the pitch cylinder 134 are controlled according to the operation amount of the operation device 310. The control valve 330 may be a pressure proportional control valve. Alternatively, the control valve 330 may be an electromagnetic proportional control valve.

The control system 300 includes a stroke sensor 133s. The stroke sensor 133s detects the stroke amount of the lift cylinder 133. By using the stroke amount detected by the stroke sensor 133s, the position of the cutting edge 132e in the vehicle body coordinate system, which is the local coordinate system with respect to the vehicle body 110, can be calculated. Specifically, the controller 320 calculates the rotation angle of the lift frame 131 based on the stroke amount of the lift cylinder 133. Since the dimensions of the lift frame 131 and the blade 132 are known, the position of the cutting edge 132e of the blade 132 can be specified from the rotation angle of the lift frame 131. The work vehicle 100 according to another embodiment may detect the angle of rotation by another sensor such as an encoder.

As shown in FIG. 3, the control system 300 includes a position detecting device 340. The position detection device 340 measures the position of the work vehicle 100. The position detecting device 340 includes a GNSS (Global Navigation Satellite System) receiver 341 and an IMU (Inertial Measurement Unit) 342. The GNSS receiver 341 is, for example, a receiver for GPS (Global Positioning System). The antenna of the GNSS receiver 341 is mounted, for example, on the driver's cab 140. The GNSS receiver 341 receives a positioning signal from the satellite, calculates the position of the antenna by the positioning signal, and generates vehicle position data. The GNSS receiver 341 outputs the position data of the work vehicle 100 to the controller 320.

The IMU 342 acquires vehicle body tilt angle data and vehicle body acceleration data. The vehicle body tilt angle data includes an angle with respect to the horizontal in the front-rear direction of the vehicle (pitch angle) and an angle with respect to the horizontal in the lateral direction of the vehicle (roll angle). The vehicle body acceleration data includes the acceleration of the work vehicle 100. The IMU342 outputs the vehicle body tilt angle data and the vehicle body acceleration data to the controller. The controller 320 obtains the traveling direction and the vehicle speed of the work vehicle 100 from the vehicle body acceleration data.

FIG. 4 is a schematic block diagram showing the configuration of the controller 320 of the work vehicle 100 according to the first embodiment. The controller 320 is a computer including a processor 321, a main memory 322, a storage 323, and an interface 324. The processor 321 calculates and processes the operation of the working machine 130 by executing the program.

The main memory 322 stores the design terrain data and the work site terrain data. The design terrain data indicates the final design terrain. The final design terrain is the final target shape of the surface of the work site. The design topography data is, for example, a civil engineering construction drawing in a three-dimensional data format. The work site topography data shows the current topography of the work site. The work site topographical data is, for example, a current topographical survey map in a three-dimensional data format. Work site topography data can be obtained, for example, by aerial laser surveying.

Storage 323 is a non-temporary tangible storage medium. Examples of the storage 323 include magnetic disks, magneto-optical disks, semiconductor memories, and the like. The storage 323 may be an internal medium directly connected to the bus of the controller 320, or an external medium connected to the controller 320 via the interface 324 or a communication line. The storage 323 stores a program for controlling the work vehicle 100.

In another embodiment, the controller 320 may include a custom LSI (Large Scale Integrated Circuit) such as a PLD (Programmable Logic Device) in addition to or in place of the above configuration. Examples of PLDs include PAL (Programmable Array Logic), GAL (Generic Array Logic), CPLD (Complex Programmable Logic Device), and FPGA (Field Programmable Gate Array). In this case, some or all of the functions realized by the processor 321 may be realized by the integrated circuit.

<< Operation of work vehicle 100 >>
Hereinafter, the control of the working machine 130 in excavation executed by the controller 320 will be described. FIG. 5 is a flowchart showing a control process of the working machine 130 according to the first embodiment. At the start of work of the work vehicle 100, the posture of the blade 132 takes an excavation posture.

As shown in FIG. 5, in step S1, the controller 320 acquires the current position data from the position detection device 340.

In step S2, the controller 320 acquires the design terrain data of the construction site. As shown in FIG. 6, the design terrain data includes the height Zdesign of the final design terrain 60 at a plurality of reference points in the traveling direction of the work vehicle 100. The plurality of reference points indicate a plurality of points at predetermined intervals along the traveling direction of the work vehicle 100. The plurality of reference points are on the traveling path of the blade 132. In FIG. 6, the final design terrain 60 has a flat shape parallel to the horizontal direction, but may have a different shape. The design terrain data may be acquired via the interface 324, may be acquired via an external storage device, or may be acquired from another device connected via a network. The controller 320 stores the design terrain data in the main memory 322.

In step S3, the controller 320 acquires the current topographical data of the construction site. The controller 320 acquires the current terrain data by calculation from the work site terrain data obtained from the main memory 322, the vehicle body position data and the traveling direction data obtained from the position detection device 340. The current terrain data is information indicating the terrain located in the traveling direction of the work vehicle 100. FIG. 6 shows a cross section of the current terrain 50. In FIG. 6, the vertical axis indicates the height of the terrain, and the horizontal axis indicates the distance from the current position in the traveling direction of the work vehicle 100.

In step S4, the controller 320 acquires the work start position. For example, the controller 320 calculates the position of the cutting edge 132e of the blade 132 in the field coordinate system based on the measured value of the stroke sensor 133s and the measured value of the position detection device 340, and the position of the cutting edge 132e is the first to be the height of the current terrain. The position when the value falls below is acquired as the excavation start position. However, the controller 320 may acquire the excavation start position by another method. For example, the controller 320 may acquire the excavation start position based on the operation of the working machine operating device 311. For example, the controller 320 may acquire the excavation start position based on an operation such as a button or a screen operation using a touch panel.

In step S5, the controller 320 acquires the movement amount of the work vehicle 100. The controller 320 acquires the distance traveled from the excavation start position to the current position in the traveling path of the blade 132 as the movement amount. The movement amount of the work vehicle 100 may be the movement amount of the vehicle body 110. Alternatively, the amount of movement of the work vehicle 100 may be the amount of movement of the cutting edge 132e.

In step S6, the controller 320 determines the target design terrain data. The target design terrain data shows the target design terrain 70 shown by the broken line in FIG. The target design terrain 70 indicates the desired trajectory of the cutting edge 132e of the blade 132 in the work. The target design terrain 70 is the desired terrain profile as a result of the excavation work. As shown in FIG. 6, the controller 320 determines the target design terrain 70 displaced downward by the displacement distance ΔZ from the current terrain 50. The displacement distance ΔZ is the target displacement in the vertical direction at each reference point. In the present embodiment, the displacement distance ΔZ is the target depth at each reference point, and indicates the target position of the blade 132 below the current terrain 50. The target position of the blade 132 means the position of the cutting edge 132e of the blade 132. In other words, the displacement distance ΔZ indicates the amount of soil per unit movement amount excavated by the blade 132. Therefore, the target design topographical data shows the relationship between a plurality of reference points and a plurality of target soil volumes. The controller 320 determines the target design terrain 70 so as not to exceed the final design terrain 60 downward. Therefore, the controller 320 determines the target design terrain 70 whose target height is equal to or higher than the final design terrain 60 and located below the current terrain 50.

Specifically, the controller 320 determines the height Z of the target design terrain 70 by the following equation (1).
[Number 1]
Z = Zm-ΔZ
ΔZ = t1 * t2 * Z_offset

Zm (m = 1, ..., N) is the height Z0 to Zn of the current terrain 50 at a plurality of reference points. ΔZ is the displacement distance, and FIG. 6 shows the excavation depth. t1 is a magnification based on traction force data indicating the magnitude of traction force available to the work vehicle.

t2 is a magnification based on the blade specification data. The blade specification data is determined according to the specifications of the selected blade.

Z_offset is a target displacement determined according to the amount of movement of the work vehicle 100. The target displacement Z_offset is an example of a target load parameter related to the load on the blade 132. The target displacement Z_offset indicates the amount of displacement of the blade 132 in the height direction (vertical direction) from the ground surface. FIG. 7 is a diagram showing an example of the target displacement data C. The target displacement data C shows the excavation depth (target displacement) Z_offset in the vertical downward direction from the ground surface of the blade 132 as a dependent variable of the horizontal movement amount n of the work vehicle 100. The horizontal movement amount n of the work vehicle 100 is substantially the same as the horizontal movement amount of the blade 132. The controller 320 determines the target displacement Z_offset from the movement amount n of the work vehicle 100 with reference to the target displacement data C shown in FIG. 7.

As shown in FIG. 7, the target displacement data C defines the relationship between the movement amount n of the work vehicle 100 and the target displacement Z_offset. The target displacement data C is stored in the main memory 322. Hereinafter, for the sake of simplicity, the values of t1 and t2 are set to 1, and the displacement distance ΔZ is assumed to be equal to the target displacement Z_offset.

As shown in FIG. 7, the target displacement data C includes start data c1, excavation data c2, transition data c3, and soil transportation data c4. The start data c1 defines the relationship between the movement amount n in the excavation start region and the target displacement Z_offset. The excavation start area is an area from the excavation start point S to the steady excavation start point D. As shown by the start data c1, in the excavation start region, the target displacement Z_offset that gradually increases with the increase of the movement amount n is defined. The start data c1 defines a target displacement Z_offset that linearly increases with respect to the movement amount n.

The excavation data c2 defines the relationship between the movement amount n in the excavation region and the target displacement Z_offset. The excavation area is an area from the steady excavation start point D to the soil transfer start point T. As shown in the excavation data c2, the target displacement Z_offset is defined as a constant value in the excavation region. The excavation data c2 defines a constant target displacement Z_offset with respect to the movement amount n.

The transition data c3 defines the relationship between the movement amount n in the transportation transition region and the target displacement Z_offset. The transportation transition area is an area from the transportation transition start point T to the transportation start point P. As shown by the transition data c3, the target displacement Z_offset that gradually decreases as the movement amount n increases is defined in the transportation transition region. The transition data c3 defines a target displacement Z_offset that linearly decreases with respect to the movement amount n.

The soil transportation data c4 defines the relationship between the movement amount n in the soil transportation area and the target displacement Z_offset. The soil transportation area is an area starting from the soil transportation start point P. As shown in the soil transportation data c4, the target displacement Z_offset is defined as a constant value in the soil transportation region. The soil transportation data c4 defines a constant target displacement Z_offset with respect to the movement amount n.

Specifically, the excavation area starts at the first start value b1 and ends at the first end value b2. The soil transportation area starts from the second starting value b3. The first end value b2 is smaller than the second start value b3. Therefore, the excavation area is started when the movement amount n is smaller than that of the soil transportation area. The target displacement Z_offset in the excavation region is constant at the first target value a1. The target displacement Z_offset in the soil transport area is constant at the second target value a2. The first target value a1 is larger than the second target value a2. Therefore, a displacement distance ΔZ larger than that in the soil transportation area is defined in the excavation area.

The target displacement Z_offset at the excavation start position is the start value a0. The starting value a0 is smaller than the first target value a1. In the example shown in FIG. 7, the starting target value a0 is smaller than the second target value a2.

FIG. 8 is a flowchart showing a determination process of the target displacement Z_offset. For the sake of simplicity, in the determination process described below, it is assumed that the work vehicle 100 travels only forward. The determination process is started when the operating device 310 for operating the traveling device 120 moves to the forward position. In step S201, the controller 320 determines whether the movement amount n is 0 or more and is less than the first start value b1. When the movement amount n is 0 or more and less than the first start value b1, in step S202, the controller 320 gradually increases the target displacement Z_offset from the start value a0 in accordance with the increase in the movement amount n.

The start value a0 is a constant and is stored in the main memory 322. The starting value a0 is preferably a small value so that the load on the blade 132 at the start of excavation does not become excessively large. The first start value b1 is obtained by calculation from the slope c1 in the excavation start region shown in FIG. 7, the start value a0, and the first target value a1. The slope c1 is a constant and is stored in the main memory 322. It is preferable that the inclination c1 is a value that can quickly shift from the start of excavation to the excavation work and that the load on the blade 132 does not become excessively large.

In step S203, the controller 320 determines whether the movement amount n is equal to or more than the first start value b1 and less than the first end value b2. When the movement amount n is equal to or greater than the first start value b1 and less than or equal to the first end value b2, in step S204, the controller 320 sets the target displacement Z_offset to the first target value a1. The first target value a1 is a constant and is stored in the main memory 322. The first target value a1 is preferably a value that enables efficient excavation and does not excessively increase the load on the blade 132.

In step S205, the controller 320 determines whether the movement amount n is equal to or more than the first end value b2 and less than the second start value b3. When the movement amount n is equal to or more than the first end value b2 and less than the second start value b3, in step S206, the controller 320 sets the target displacement Z_offset to the first target value a1 in accordance with the increase in the movement amount n. Gradually reduce from.

The first end value b2 is the amount of movement when the amount of soil currently held by the blade 132 exceeds a predetermined threshold value. Therefore, when the current amount of soil held by the blade 132 exceeds a predetermined threshold value, the controller 320 reduces the target displacement Z_offset from the first target value a1. The predetermined threshold is determined, for example, based on the maximum capacity of the blade 132. For example, the current amount of soil held by the blade 132 may be determined by calculation from the load measured on the blade 132. Alternatively, an image of the blade 132 may be acquired by a camera and the image may be analyzed to calculate the current amount of soil held by the blade 132. Alternatively, the point cloud data of the blade 132 may be acquired by a scanner and the current amount of soil held by the blade 132 may be calculated by analyzing the point cloud data.

At the start of work, a predetermined initial value is set as the first end value b2. After the start of the work, the movement amount when the amount of soil held by the blade 132 exceeds a predetermined threshold value is stored as an update value, and the first end value b2 is updated based on the stored update value.

In step S207, the controller 320 determines whether the movement amount n is equal to or greater than the second start value b3. When the movement amount n is equal to or greater than the second start value b3, in step S208, the controller 320 sets the target displacement Z_offset to the second target value a2.

The second target value a2 is a constant and is stored in the main memory 322. The second target value a2 is preferably set to a value suitable for soil transportation work. For example, the second target value a2 may be set so that the target displacement Z_offset in the soil transport area becomes 0. That is, the second target value a2 may be a value equal to or less than the initial target value a0. The second start value b3 is obtained by calculation from the slope c3 in the land transportation transition region shown in FIG. 7, the first target value a1, and the second target value a2. The slope c3 is a constant and is stored in the main memory 322. It is preferable that the inclination c3 is a value such that the excavation work can be quickly shifted to the soil transportation work and the load on the blade 132 is not excessively increased.

The start value a0, the first target value a1, and the second target value a2 may be changed according to the situation of the work vehicle 100 and the like. The first start value b1, the first end value b2, and the second start value b3 may be stored in the main memory 322 as constants.

As described above, the height Z of the target design terrain 70 is determined by determining the target displacement Z_offset.

In step S7, the controller 320 controls the working machine 130 toward the target design terrain 70. Here, the controller 320 generates a command signal to the working machine 130 so that the position of the cutting edge 132e of the blade 132 moves toward the target design terrain 70 created in step S6. The generated command signal is input to the control valve 330. As a result, the cutting edge 132e of the blade 132 moves along the target design terrain 70.

In the above-mentioned excavation area, the displacement distance ΔZ between the current terrain 50 and the target design terrain 70 is larger than in other areas. As a result, in the excavation area, excavation work of the existing terrain 50 is performed. In the soil transportation area, the displacement distance ΔZ between the current terrain 50 and the target design terrain 70 is smaller than in other areas. As a result, in the soil transportation area, excavation of the ground is refrained from, and the earth and sand held by the blade 132 is transported.

In step S8, the controller 320 determines whether the work vehicle 100 has reached the switching point or the pitch operation switch 312 has been continuously operated to the bitch back position by the operator for a certain period of time based on the movement amount acquired in step S5. judge. The switching point is either a point separated by a first distance from the excavation start point, a point separated by a second distance, or a point separated by a third distance from the excavation start point. The switching point can be appropriately selected by the operator. As shown in FIG. 7, the point separated by the first distance from the excavation start point corresponds to the steady excavation start point D. Further, the point separated by the second distance from the excavation start point corresponds to the soil transfer start point T. Further, the point separated by the third distance from the excavation start point corresponds to the soil transportation start point P. The determination reference position is the position of the center of gravity of the vehicle body 110 or the position of the cutting edge 132e.

When the determination reference position has not reached the switching point and the pitch operation switch 312 has not been continuously operated to the bitchback position for a certain period of time (step S8: NO), in step S9, the controller 320 is the target design. The working machine 130 is controlled toward the terrain 70. Here, a command signal to the working machine 130 is generated so that the position of the cutting edge 132e of the blade 132 moves toward the target design terrain 70 created in step S6. The generated command signal is input to the control valve 330. As a result, the position of the cutting edge 132e of the working machine 130 moves along the target design terrain 70.

On the other hand, when the determination reference position reaches the switching point or the pitch operation switch 312 is continuously operated to the bitchback position for a certain period of time (step S8: YES), in step S10, the controller 320 moves the blade 132. A command signal to the working machine 130 is generated so as to be in the soil posture. Here, a command signal for controlling the pitch cylinder 134 so that the blade 132 is in the soil transport posture is generated. For example, since the soil transportation posture is a posture in which the blade 132 is tilted to the rear of the vehicle body to the maximum extent, the controller 320 has the controller 320 from the time when the discharge pressure of the hydraulic pump 240 becomes equal to or higher than the relief pressure of the pitch cylinder 134 until a predetermined time elapses. The command signal may be output to the control valve 330.

In step S11, the controller 320 controls the lift cylinder 133 toward the target design terrain 70. FIG. 9 is a diagram showing changes in the height of the blade according to the first embodiment. The state ST_A indicates a state in which the blade 132 is in the excavation posture and the cutting edge 132e is adjusted to the reference height H0. In the work vehicle 100, when the pitch cylinder 134 is extended so that the blade 132 dumps the pitch in the state ST_A, the blade 132 rotates about the axis X2, and the height of the cutting edge 132e is lower than the reference height H0. State The state ST_B is set.

In the work vehicle 100, when the pitch cylinder 134 is reduced so that the blade 132 pitches back in the state ST_A, the blade 132 rotates around the axis X2, and the height of the cutting edge 132e is higher than the reference height H0. The state is ST_C. Therefore, in step S11, the controller 320 moves to the lift cylinder 133 so that the position of the cutting edge 132e of the blade 132 moves toward the target design terrain 70 while offsetting the fluctuation of the cutting edge height due to the drive of the pitch cylinder 134. Generates a control signal for. The amount of fluctuation in the height of the cutting edge due to the drive of the pitch cylinder 134 can be specified by the dimensional data of the working machine 130.

In step S12, the controller 320 updates the work site terrain data. The controller 320 acquires position data indicating the latest trajectory of the cutting edge 132e as the current terrain data, and updates the work site terrain data with the acquired current terrain data. Alternatively, the controller 320 may calculate the position of the bottom surface of the crawler belt 121 from the vehicle body position data and the vehicle body dimension data, and acquire the position data indicating the locus of the bottom surface of the crawler belt 121 as the current topographical data. In this case, the work terrain data can be updated immediately.

《Action / Effect》
As described above, the controller 320 according to the first embodiment determines the switching point with reference to the target displacement data indicating the target displacement of the height of the work machine according to the amount of movement of the work vehicle from the work start position. .. Further, it is determined whether or not the work vehicle 100 has reached the switching point, and when it is determined that the work vehicle 100 has reached the switching point, the work machine 130 is tilted rearward of the vehicle body. As a result, the controller 320 automatically operates the pitch of the blade 132 at the time of transition from the excavation work to the soil transportation work, so that the work load of the operator can be reduced. Further, the controller 320 controls the pitch of the blade 132 and also controls the height of the blade 132 to prevent soil spillage during the transition from the excavation work to the soil transportation work. Further, the controller 320 can maximize the amount of soil at the time of soil transportation and improve the work efficiency by changing the pitch angle of the blade 132 at the optimum timing.

Further, according to the first embodiment, the switching point is set to a point separated by a first distance from the excavation start point, a point separated by a second distance from the excavation start point, or a first point from the excavation start point. It is set by the operator whether the points are separated by 3 distances, the determination reference position is the cutting edge 132e of the blade 132, or the center of gravity of the vehicle body 110. Thereby, the operator can set the control timing of the pitch angle of the blade 132 so as to be suitable for the soil quality of the work target and the operation feeling of the operator. For example, depending on the soil quality, if the blade 132 remains in the excavation posture when the blade 132 is lifted up, the blade 132 may be pressed against the work target and excavation may not be performed efficiently. In such a case, the pitch angle of the blade 132 is controlled at an appropriate timing by setting the switching point to a point separated by the second distance from the excavation start point and setting the determination reference position to the cutting edge 132e of the blade 132. Can be done. In another embodiment, the switching point is preset to a point separated by a first distance from the excavation start point, a point separated by a second distance from the excavation start point, or a point separated by a third distance from the excavation start point. In addition, the determination reference position may be set in advance at the cutting edge 132e of the blade 132 or the center of gravity of the vehicle body 110, so that the setting by the operator may not be accepted.

<Other embodiments>
Although one embodiment has been described in detail with reference to the drawings, the specific configuration is not limited to the above-mentioned one, and various design changes and the like can be made. That is, in other embodiments, the order of the above-mentioned processes may be changed as appropriate. In addition, some processes may be executed in parallel.

The controller 320 according to the above-described embodiment may be configured by a single computer, or the configuration of the controller 320 may be divided into a plurality of computers, and the plurality of computers cooperate with each other to form a controller. It may function as a 320. For example, as shown in FIG. 10, the controller 320 may include a remote controller 350 arranged outside the work vehicle 100 and an in-vehicle controller 360 mounted on the work vehicle 100. The remote controller 350 and the vehicle-mounted controller 360 may be capable of wireless communication via the communication devices 380 and 390. Then, a part of the functions of the controller 320 described above may be executed by the remote controller 350, and the remaining functions may be executed by the in-vehicle controller 360. For example, the process of determining the target design terrain 70 may be executed by the remote controller 350, and the process of outputting the command signal to the working machine 130 may be executed by the vehicle-mounted controller 360.

Alternatively, the operating device 310 may be arranged outside the work vehicle 100. In that case, the driver's cab may be omitted from the work vehicle 100. Alternatively, the operating device 310 may be omitted from the work vehicle 100. The work vehicle 100 may be operated only by the automatic control by the controller 320 without the operation by the operation device 310.

Alternatively, as shown in FIG. 11, the current terrain data may be generated from survey data measured by an external surveying device 400 of the work vehicle 100. As an external surveying device, for example, aerial laser surveying may be used. Alternatively, the current terrain 50 may be photographed by a camera, and the current terrain data may be generated from the image data obtained by the camera. For example, aerial surveying by UAV (Unmanned Aerial Vehicle) may be used. In the case of an external surveying device or camera, the work site topographical data may be updated at predetermined intervals or at any time.

The controller 320 according to the above-described embodiment creates a target design terrain at the start of excavation and controls the cutting edge 132e to follow the target design terrain, but the present invention is not limited to this. For example, the controller 320 according to another embodiment may calculate the target displacement from the mileage based on the target displacement function at regular timing intervals without creating the target design terrain, and calculate the target height each time.

The work vehicle 100 according to the above-described embodiment is a bulldozer, but the vehicle is not limited to this. For example, the work vehicle 100 according to another embodiment may be a motor grader.

100 ... Work vehicle 110 ... Body 120 ... Traveling device 121 ... Footband 122 ... Sprocket 123 ... Rotation sensor 124 ... Idler 130 ... Working machine 131 ... Lift frame 132 ... Blade 132e ... Cutting edge 133 ... Lift cylinder 133s ... Stroke sensor 134 ... Pitch cylinder 140 ... Driver's cab 210 ... Power source 220 ... PTO 230 ... Power transmission device 240 ... Hydraulic pump 310 ... Operation device 311 ... Work equipment operation device 312 ... Pitch operation switch 320 ... Controller 321 ... Processor 322 ... Main memory 323 ... Storage 324 ... Interface 330 ... Control valve 341 ... GNSS receiver 342 ... IMU

Claims (19)

A control system for a work vehicle having a vehicle body and a work machine capable of changing the height and pitch of the vehicle body.
Equipped with a controller
The controller
The switching point is determined with reference to the target displacement data indicating the target displacement of the height of the work machine according to the amount of movement of the work vehicle from the work start position.
Based on the amount of movement of the work vehicle from the work start position, it is determined whether or not the work vehicle has reached the switching point.
When it is determined that the work vehicle has reached the switching point, a command for changing the pitch of the work machine is output.
Work vehicle control system. The controller according to claim 1, wherein when it is determined that the work vehicle has reached the switching point, the controller outputs the command to change the pitch so that the work machine tilts backward with respect to the vehicle body. Work vehicle control system. The target displacement data is
For the first region where the movement amount of the work vehicle is less than the first distance, a target displacement that monotonically increases as the movement amount of the work vehicle increases in a range of zero or more and less than a predetermined value is shown.
For the second region where the movement amount of the work vehicle is equal to or more than the first distance and less than the second distance, the target displacement equal to the predetermined value is shown.
In the third region where the movement amount of the work vehicle is the second distance or more and less than the third distance, the target displacement that monotonically decreases as the movement amount of the work vehicle increases in the range of zero or more and less than the predetermined value is shown. ,
The switching point is located within the range of the second region and the third region.
The work vehicle control system according to claim 1. The control system for a work vehicle according to claim 3, wherein the switching point is a point separated from the work start position by the second distance. The control system for a work vehicle according to claim 3, wherein the switching point is a point separated from the work start position by the first distance. The control system for a work vehicle according to claim 3, wherein the switching point is a point separated from the work start position by the third distance. The controller according to any one of claims 1 to 6, which outputs the command for changing the pitch of the working machine when it is determined that the cutting edge of the working machine has reached the switching point. Work vehicle control system. The controller according to any one of claims 1 to 6, which outputs the command to change the pitch of the working machine when it is determined that the position of the center of gravity of the vehicle body has reached directly above the switching point. The work vehicle control system described. The controller
Acquires the current terrain information indicating the current terrain of the work target,
With reference to the target displacement data, the target design surface displaced in the vertical direction from the current topography is determined.
A command to change the height of the working machine is output along with the target design surface.
The work vehicle control system according to any one of claims 1 to 8. The target design surface is located below the current terrain.
The work vehicle control system according to claim 9. The work according to any one of claims 1 to 10, wherein the controller lowers the work machine so as to offset the fluctuation of the cutting edge height of the work machine due to the command to change the pitch of the work machine. Vehicle control system. A method for controlling a work vehicle having a vehicle body and a work machine capable of changing the height and pitch of the vehicle body.
The switching point is determined with reference to the target displacement data indicating the target displacement of the height of the work machine according to the amount of movement of the work vehicle from the work start position.
Based on the amount of movement of the work vehicle from the work start position, it is determined whether or not the work vehicle has reached the switching point.
When it is determined that the work vehicle has reached the switching point, it is provided with a command to change the pitch of the work machine.
How to control the work vehicle. The control of the work vehicle according to claim 12, wherein when it is determined that the work vehicle has reached the switching point, the command for changing the pitch so that the work machine tilts rearward with respect to the vehicle body is output. Method. The work vehicle control method according to claim 12 or 13, wherein when it is determined that the cutting edge of the work machine has reached the switching point, the command for changing the pitch of the work machine is output. The work vehicle control method according to claim 12 or 13, wherein when it is determined that the position of the center of gravity of the vehicle body has reached directly above the switching point, the command for changing the pitch of the work machine is output. Acquires the current terrain information indicating the current terrain of the work target,
With reference to the target displacement data, the target design surface displaced in the vertical direction from the current topography is determined.
A command to change the height of the working machine is output along with the target design surface.
The work vehicle control method according to any one of claims 12 to 15. The target design surface is located below the current terrain.
The work vehicle control method according to claim 16. The work vehicle control method according to any one of claims 12 to 17, wherein the work machine is lowered so as to cancel the fluctuation of the cutting edge height of the work machine due to the command for changing the pitch of the work machine. .. With the car body
A work machine whose height and pitch can be changed with respect to the vehicle body,
A work vehicle equipped with a controller
The controller
The switching point is determined with reference to the target displacement data indicating the target displacement of the height of the work machine according to the amount of movement of the work vehicle from the work start position.
Based on the amount of movement of the work vehicle from the work start position, it is determined whether or not the work vehicle has reached the switching point.
When it is determined that the work vehicle has reached the switching point, a command for changing the pitch of the work machine so that the work machine tilts rearward with respect to the vehicle body is output.
Work vehicle.

Images