WO2022163272A1 - 作業機械を制御するためのシステム、方法、および作業機械 - Google Patents

作業機械を制御するためのシステム、方法、および作業機械 Download PDF

Info

Publication number
WO2022163272A1
WO2022163272A1 PCT/JP2021/048372 JP2021048372W WO2022163272A1 WO 2022163272 A1 WO2022163272 A1 WO 2022163272A1 JP 2021048372 W JP2021048372 W JP 2021048372W WO 2022163272 A1 WO2022163272 A1 WO 2022163272A1
Authority
WO
WIPO (PCT)
Prior art keywords
data
work
target displacement
controller
target
Prior art date
Application number
PCT/JP2021/048372
Other languages
English (en)
French (fr)
Inventor
裕輔 山▲崎▼
友起 安藤
総一 津村
Original Assignee
株式会社小松製作所
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by 株式会社小松製作所 filed Critical 株式会社小松製作所
Priority to US18/250,832 priority Critical patent/US20230383495A1/en
Priority to AU2021424823A priority patent/AU2021424823B2/en
Priority to CA3200424A priority patent/CA3200424A1/en
Publication of WO2022163272A1 publication Critical patent/WO2022163272A1/ja

Links

Images

Classifications

    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/76Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/80Component parts
    • E02F3/84Drives or control devices therefor, e.g. hydraulic drive systems
    • E02F3/841Devices for controlling and guiding the whole machine, e.g. by feeler elements and reference lines placed exteriorly of the machine
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/20Drives; Control devices
    • E02F9/2025Particular purposes of control systems not otherwise provided for
    • E02F9/2045Guiding machines along a predetermined path
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F9/00Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26Indicating devices
    • E02F9/261Surveying the work-site to be treated
    • E02F9/262Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller
    • EFIXED CONSTRUCTIONS
    • E02HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02FDREDGING; SOIL-SHIFTING
    • E02F3/00Dredgers; Soil-shifting machines
    • E02F3/04Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/76Graders, bulldozers, or the like with scraper plates or ploughshare-like elements; Levelling scarifying devices
    • E02F3/80Component parts
    • E02F3/84Drives or control devices therefor, e.g. hydraulic drive systems
    • E02F3/841Devices for controlling and guiding the whole machine, e.g. by feeler elements and reference lines placed exteriorly of the machine
    • E02F3/842Devices for controlling and guiding the whole machine, e.g. by feeler elements and reference lines placed exteriorly of the machine using electromagnetic, optical or photoelectric beams, e.g. laser beams

Definitions

  • the present invention relates to systems, methods, and work machines for controlling work machines.
  • control has been proposed that automatically adjusts the position of work machines such as blades.
  • the controller acquires current terrain data indicating the current terrain.
  • the controller determines the target profile as the terrain obtained by vertically displacing the current terrain by the target displacement.
  • the controller operates the work implement according to the target profile.
  • the existing terrain is thereby formed into a shape according to the target profile.
  • the work machine moves forward, starts work with the work machine from a predetermined starting position, and operates the work machine according to the target profile. Then, when the work machine reaches the predetermined end position, it moves backward to the next start position. In this manner, the work machine performs work in one work path.
  • a work pass means a series of work steps from a predetermined start position to a predetermined end position.
  • the target profile when the target profile is determined by displacing the current topography in the vertical direction by the target displacement, the target profile is affected by the current topography.
  • the target profile for the next work pass is determined over the previous work pass, the target profile for the next work pass is affected by the current terrain from the previous work pass. Therefore, the target profile in the next work pass may have steep slopes or bumps due to the existing terrain from the previous work pass. In that case, the quality of work or work efficiency will fall. For example, when the cutting angle suddenly increases, the load applied to the work machine suddenly increases, resulting in a decrease in work efficiency.
  • An object of the present disclosure is to improve the quality of work or work efficiency in the next work pass by suppressing the influence of the terrain caused by the previous work pass in automatic control of a work machine.
  • a system is a system for controlling a working machine including a working machine.
  • a system includes a sensor and a controller.
  • a sensor detects the current position of the work machine.
  • a controller communicates with the sensor.
  • the controller is programmed to do the following:
  • the controller acquires current position data indicating the current position of the work machine.
  • a controller obtains existing terrain data indicative of existing terrain.
  • the controller obtains default target displacement data.
  • the default target displacement data defines a target displacement according to the amount of movement of the work machine.
  • the controller gets the work interval.
  • the work interval indicates the distance between the previous start position of the work by the work machine and the current start position located behind the previous start position.
  • the controller generates modified data by modifying the default target displacement data according to the work interval.
  • the controller refers to the correction data and determines a target displacement according to the movement amount of the work machine from the current start position.
  • the controller determines terrain data obtained by vertically displacing the current terrain data downward by the target displacement as the target profile.
  • the controller operates the work implement according to the target profile.
  • a method is a method for controlling a working machine including a working machine.
  • the method according to this aspect includes the following processes.
  • a first process is to obtain current position data indicating the current position of the work machine.
  • the second process is to obtain current terrain data indicating current terrain.
  • the third process is to obtain default target displacement data.
  • the default target displacement data defines a target displacement according to the amount of movement of the work machine.
  • the fourth process is to obtain the work interval.
  • the work interval indicates the distance between the previous start position of the work by the work machine and the current start position located behind the previous start position.
  • a fifth process is to generate corrected data by correcting the default target displacement data according to the work interval.
  • a sixth process is to refer to the correction data and determine a target displacement according to the amount of movement of the work machine from the current start position.
  • the seventh process is to determine, as a target profile, terrain data obtained by vertically displacing the current terrain data downward by the target displacement.
  • the eighth process is to operate the work implement according to the target profile. Note that the order in which each process is executed is not limited to the order described above, and may be changed.
  • a working machine includes a working machine, a sensor, and a controller.
  • a sensor detects the current position of the work machine.
  • a controller communicates with the sensor.
  • the controller is programmed to do the following: The controller acquires current position data indicating the current position of the work machine.
  • a controller obtains existing terrain data indicative of existing terrain.
  • the controller obtains default target displacement data.
  • the default target displacement data defines a target displacement according to the amount of movement of the work machine.
  • the controller gets the work interval.
  • the work interval indicates the distance between the previous start position of the work by the work machine and the current start position located behind the previous start position.
  • the controller generates modified data by modifying the default target displacement data according to the work interval.
  • the controller refers to the correction data and determines a target displacement according to the movement amount of the work machine from the current start position.
  • the controller determines terrain data obtained by vertically displacing the current terrain data downward by the target displacement as the target profile.
  • the controller operates the work implement according to the target profile.
  • corrected data is generated by correcting the default target displacement data according to the distance between the previous start position and the current start position. Then, the target displacement is determined by referring to the correction data, and the terrain data obtained by vertically displacing the current terrain data downward by the target displacement is determined as the target profile. Therefore, the target profile for the current work pass is determined in consideration of the topography of the previous work pass. As a result, it is possible to suppress the influence of the topography caused by the previous work pass and improve the quality of work or work efficiency.
  • FIG. 1 is a block diagram showing the configuration of a drive system and a control system of a working machine;
  • FIG. 1 is a schematic diagram showing a configuration of a working machine;
  • FIG. 2 illustrates an example final design terrain, existing terrain, and a target profile;
  • 4 is a flow chart showing processing of automatic control of the working machine; It is a figure which shows an example of target displacement data.
  • FIG. 10 is a diagram showing a target profile generated from target displacement data; 4 is a flowchart showing processing for correcting target displacement data; It is a figure which shows an example of 1st correction data.
  • FIG. 10 is a diagram showing a target profile generated from first correction data; It is a figure which shows an example of 2nd correction data.
  • FIG. 10 is a diagram showing a target profile generated from second correction data;
  • FIG. 11 is a block diagram showing the configuration of a drive system and a control system of a working machine according to a modification;
  • FIG. 11 is a block diagram showing a configuration of a drive system and a control system of a work machine according to another modified example; It is a figure which shows an example of the 1st correction data which concerns on a modification.
  • It is a figure which shows an example of the 2nd correction data which concerns on a modification.
  • FIG. 10 is a diagram showing a target profile generated from second correction data according to a modification;
  • FIG. 1 is a side view showing a work machine 1 according to an embodiment.
  • a working machine 1 according to this embodiment is a bulldozer.
  • the working machine 1 includes a vehicle body 11, a traveling device 12, and a working machine 13.
  • the vehicle body 11 has a driver's cab 14 and an engine room 15.
  • a driver's seat (not shown) is arranged in the driver's cab 14 .
  • the engine compartment 15 is arranged in front of the operator's cab 14 .
  • the travel device 12 is attached to the lower portion of the vehicle body 11 .
  • the travel device 12 has a pair of left and right crawler belts 16 . 1, only the left crawler belt 16 is illustrated.
  • the work machine 1 travels as the crawler belt 16 rotates.
  • the traveling of the work machine 1 may be in any form of autonomous traveling, semi-autonomous traveling, and traveling by operator's operation.
  • the working machine 13 is attached to the vehicle body 11 and the traveling device 12.
  • the working machine 13 has a lift frame 17 , blades 18 and lift cylinders 19 .
  • Trunnions (cylindrical protrusions) are arranged on the left and right side portions of the travel device 12 with the axis X extending in the vehicle width direction as the central axis.
  • the lift frame 17 is attached to the travel device 12 via a trunnion so as to be vertically operable.
  • Lift frame 17 supports blade 18 .
  • the blade 18 is arranged in front of the vehicle body 11 .
  • the blade 18 moves up and down as the lift frame 17 moves up and down.
  • Lift cylinder 19 is connected to vehicle body 11 and lift frame 17 .
  • the lift frame 17 rotates up and down around the axis X by extending and contracting the lift cylinder 19 . Extension of the lift cylinder 19 raises the blade 18 .
  • Blade 18 is lowered by retraction of lift cylinder 19 .
  • Fig. 2 is a block diagram showing the configuration of the drive system 2 and the control system 3 of the work machine 1.
  • the drive system 2 includes an engine 22, a hydraulic pump 23, and a power transmission device .
  • the hydraulic pump 23 is driven by the engine 22 and discharges hydraulic oil. Hydraulic oil discharged from the hydraulic pump 23 is supplied to the lift cylinder 19 .
  • one hydraulic pump 23 is illustrated in FIG. 2, a plurality of hydraulic pumps may be provided.
  • the power transmission device 24 transmits the driving force of the engine 22 to the traveling device 12.
  • the power transmission device 24 may be, for example, an HST (Hydro Static Transmission).
  • the power transmission device 24 may be, for example, a torque converter or a transmission with multiple gears.
  • the control system 3 includes an operation device 25a, an input device 25b, a controller 26, a storage device 28, and a control valve 27.
  • the operation device 25a is a device for operating the work implement 13 and the traveling device 12. As shown in FIG.
  • the operation device 25a is arranged in the operator's cab 14. As shown in FIG.
  • the operation device 25a receives an operator's operation for driving the work implement 13 and the traveling device 12, and outputs an operation signal according to the operation.
  • the operation device 25a includes, for example, operation levers, pedals, switches, and the like.
  • the operating device 25a for traveling can be operated to a forward position, a reverse position, and a neutral position.
  • the operating device 25a for the working machine 13 can be operated between a raised position and a lowered position.
  • An operation signal indicating the position of the operation device 25a is output to the controller .
  • the controller 26 controls the travel device 12 or the power transmission device 24 so that the work machine 1 moves forward when the operating position of the operating device 25a is the forward position.
  • the controller 26 controls the traveling device 12 or the power transmission device 24 so that the working machine 1 moves backward.
  • the input device 25b is, for example, a touch panel type input device. However, the input device 25b may be another input device such as a switch. The operator can use the input device 25b to input settings for automatic control, which will be described later.
  • the controller 26 is programmed to control the work machine 1 based on the acquired data.
  • Controller 26 includes storage device 28 and processor 30 .
  • Processor 30 includes, for example, a CPU.
  • Storage device 28 includes, for example, a memory and an auxiliary storage device.
  • the storage device 28 may be, for example, RAM or ROM.
  • the storage device 28 may be a semiconductor memory, hard disk, or the like.
  • Storage device 28 is an example of a non-transitory computer-readable recording medium.
  • Storage device 28 stores computer instructions executable by processor 30 to control work machine 1 .
  • the controller 26 acquires an operation signal from the operation device 25a. Controller 26 controls control valve 27 based on the operation signal. Control valve 27 is a proportional control valve and is controlled by a command signal from controller 26 . Control valve 27 is arranged between a hydraulic actuator such as lift cylinder 19 and hydraulic pump 23 . A control valve 27 controls the flow rate of hydraulic oil supplied from the hydraulic pump 23 to the lift cylinder 19 . The controller 26 generates a command signal to the control valve 27 so that the blade 18 operates according to the operation of the operating device 25a described above. Thereby, the lift cylinder 19 is controlled according to the operation amount of the operating device 25a.
  • the controller 26 controls the control valve 27 so that the work implement 13 is raised.
  • the controller 26 controls the control valve 27 so that the work implement 13 is lowered.
  • the control valve 27 may be a pressure proportional control valve.
  • the control valve 27 may be an electromagnetic proportional control valve.
  • the control system 3 includes a stroke sensor 29.
  • the stroke sensor 29 detects the stroke length of the lift cylinder 19 (hereinafter referred to as "lift cylinder length").
  • the controller 26 calculates the lift angle ⁇ lift of the blade 18 based on the lift cylinder length.
  • FIG. 3 is a schematic diagram showing the configuration of the working machine 1. As shown in FIG.
  • the origin position of the working machine 13 is indicated by a two-dot chain line.
  • the origin position of the work implement 13 is the position of the blade 18 on the horizontal ground when the cutting edge of the blade 18 is in contact with the ground.
  • the lift angle ⁇ lift is defined by the lower end (cutting edge position P0) of the blade 18 at the origin position when the work machine 1 is viewed from the side, the axis X, and the lower end (cutting edge position P0 ).
  • the control system 3 has a position sensor 31.
  • Position sensor 31 measures the position of work machine 1 .
  • the position sensor 31 comprises a GNSS (Global Navigation Satellite System) receiver 32 , an IMU 33 and an antenna 35 .
  • the GNSS receiver 32 is, for example, a GPS (Global Positioning System) receiver.
  • the GNSS receiver 32 receives positioning signals from satellites, calculates the position of the antenna 35 based on the positioning signals, and generates vehicle body position data.
  • Controller 26 obtains vehicle body position data from GNSS receiver 32 .
  • the IMU 33 is an inertial measurement unit.
  • the IMU 33 acquires vehicle body tilt angle data and vehicle acceleration data.
  • the vehicle body tilt angle data includes an angle (pitch angle) in the longitudinal direction of the vehicle with respect to the horizontal and an angle (roll angle) in the lateral direction of the vehicle with respect to the horizontal.
  • the vehicle body acceleration data includes the acceleration of work machine 1 .
  • the controller 26 obtains the traveling direction and vehicle speed of the working machine 1 from the vehicle body acceleration data.
  • the controller 26 acquires vehicle body tilt angle data and vehicle body acceleration data from the IMU 33 .
  • the controller 26 calculates the cutting edge position P0 from the lift cylinder length, vehicle body position data, and vehicle body tilt angle data.
  • the controller 26 calculates global coordinates of the antenna 35 based on the vehicle body position data.
  • the controller 26 calculates the lift angle ⁇ lift based on the lift cylinder length and vehicle body dimension data.
  • the vehicle body dimension data is stored in storage device 28 and includes data indicating the position of work implement 13 with respect to axis X.
  • the controller 26 calculates the local coordinates of the cutting edge position P0 with respect to the antenna 35 based on the lift angle ⁇ lift and the vehicle body dimension data.
  • Controller 26 calculates the traveling direction and vehicle speed of work machine 1 from the vehicle body acceleration data.
  • the vehicle body dimension data includes data indicating the position of work implement 13 with respect to antenna 35 .
  • the controller 26 calculates the global coordinates of the cutting edge position P0 based on the global coordinates of the antenna 35, the local coordinates of the cutting edge position P0, and the vehicle body tilt angle data.
  • the controller 26 acquires the global coordinates of the cutting edge position P0 as cutting edge position data.
  • the storage device 28 stores work site data and designed terrain data.
  • Worksite data indicates the current topography of the worksite.
  • the work site data is, for example, a current topographic survey map in the form of three-dimensional data.
  • Worksite data can be obtained, for example, by aerial laser surveying. Alternatively, the work site data may be acquired based on the work results of the work machines operating at the work site.
  • the controller 26 acquires current terrain data.
  • the existing terrain data indicates the existing terrain 50 of the work site.
  • the current terrain data is information indicating the terrain located in the traveling direction of the work machine 1 .
  • Existing terrain data may be obtained from worksite data. Alternatively, the current terrain data may be obtained based on the work results of the previous work pass.
  • the current topography data may be acquired based on the position data of the work machine during the backward movement after the previous work path work.
  • FIG. 4 shows a cross-section of the existing terrain 50. As shown in FIG. In FIG. 4, 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 working machine 1. As shown in FIG.
  • the current topography data is calculated and acquired by the controller 26 from the work site data, the position of the work machine 1 obtained from the position sensor 31 described above, and the traveling direction of the work machine 1.
  • the current topography data may be data obtained by smoothing the data obtained from the work site data, the position of the work machine 1 obtained from the position sensor 31, and the traveling direction of the work machine 1.
  • the current terrain data includes heights Z0 to Zn of the current terrain 50 at a plurality of reference points from the current position to a predetermined terrain recognition distance dn in the traveling direction of the work machine 1.
  • the current position is a position determined based on the current cutting edge position P0 of the work machine 1.
  • the current position may be determined based on the current positions of other parts of work machine 1 .
  • the current position may be updated sequentially as the work machine travels.
  • a plurality of reference points are arranged at predetermined intervals, for example, every 1 m.
  • the design topography data indicates the final design topography 60.
  • the final design terrain 60 is the final target shape of the worksite surface.
  • the designed landform data is calculated and acquired from, for example, civil engineering working drawings in a three-dimensional data format.
  • the designed topography data includes heights Zdesign of the final designed topography 60 at a plurality of reference points in the traveling direction of the work machine 1 .
  • a plurality of reference points indicate a plurality of points at predetermined intervals along the traveling direction of work machine 1 .
  • the current landform 50 and the final design landform 60 have flat shapes parallel to the horizontal direction, but they may have different shapes.
  • FIG. 5 is a flow chart showing processing for automatic control of the work implement 13 in excavation work. Note that FIG. 5 shows the processing in one work pass in the excavation work. It means the process up to the start of backward movement to move to the starting position.
  • step S101 the controller 26 acquires current position data.
  • the controller 26 acquires the current cutting edge position data of the blade 18 as the current position data, as described above.
  • the controller 26 acquires the design landform data described above.
  • step S103 the controller 26 acquires the current terrain data described above.
  • the controller 26 acquires the work start position.
  • the controller 26 acquires the position when the cutting edge position P0 first falls below the height Z0 of the current terrain 50 as the start position.
  • the position at which the cutting edge of the blade 18 is lowered and excavation of the current landform 50 is started is obtained as the start position.
  • the work start position may be acquired when the work implement 13 is lowered by the operator operating the operation device 25a.
  • the work start position may be acquired when the work implement 13 is lowered by the controller 26 automatically controlling the work implement 13 .
  • controller 26 may obtain the starting position by other methods.
  • the controller 26 may acquire the start position based on an operation such as a screen operation using a button or a touch panel.
  • the controller 26 acquires the movement amount of the work machine 1. Controller 26 acquires the distance traveled by work machine 1 from the start position to the current position as the amount of movement.
  • the amount of movement of work machine 1 may be the amount of movement of vehicle body 11 .
  • the amount of movement of work machine 1 may be the amount of movement of cutting edge position P0 of blade .
  • step S106 the controller 26 determines the target profile 70.
  • target profile 70 indicates the desired trajectory of the cutting edge of blade 18 during operation.
  • the target profile 70 is the target shape of the terrain being worked on and indicates the shape desired as a result of the excavation operation.
  • controller 26 determines the target profile 70 so as not to exceed the final design topography 60 below. Accordingly, controller 26 determines a target profile 70 located above and including final design terrain 60 and below existing terrain 50 during an excavation operation.
  • the controller 26 determines a target displacement dz and a downwardly displaced target profile 70 from the current topography 50 .
  • the target displacement dz is the target depth in the vertical direction at each reference point. Alternatively, the target displacement dz may be the target depth of the existing terrain 50 in the vertical direction.
  • Controller 26 refers to target displacement data C and determines target displacement dz in accordance with the amount of movement of work machine 1 .
  • the target displacement data C is stored in the storage device 28.
  • FIG. FIG. 6 is a diagram showing an example of target displacement data C. As shown in FIG.
  • the target displacement data C defines the target displacement dz for the horizontal movement amount n of the working machine 1 .
  • the controller 26 refers to the target displacement data C shown in FIG. 6 and determines the target displacement dz from the movement amount n of the work machine 1.
  • the target displacement data C includes start time data C1, excavation time data C2, transition time data C3, and soil transport time data C4.
  • the start time data C1 defines the relationship between the movement amount n and the target displacement dz in the excavation start area.
  • the excavation start area is an area where the movement amount n is from 0 to the value b1.
  • a target displacement dz that gradually increases as the movement amount n increases is defined.
  • the starting time data C1 defines a target displacement dz that linearly increases up to the first target value a1 with respect to the movement amount n.
  • Starting data C1 has a slope A1.
  • the slope A1 is the ratio of the amount of change in the target displacement dz to the amount of change in the amount of movement n in the starting time data C1.
  • the target displacement dz at the position where the movement amount n is 0, that is, the work start position is the start value a0.
  • the excavation time data C2 defines the relationship between the movement amount n and the target displacement dz in the excavation area.
  • the excavation area is an area where the amount of movement n ranges from value b1 to value b2.
  • the excavation time data C2 defines a constant target displacement dz with respect to the movement amount n.
  • the target displacement dz in the excavation area is constant at the first target value a1.
  • the transition data C3 defines the relationship between the movement amount n and the target displacement dz in the soil transition area.
  • the soil transfer region is a region where the amount of movement n ranges from value b2 to value b3.
  • the target displacement dz that gradually decreases as the movement amount n increases is defined in the soil transition area.
  • the transition data C3 defines the target displacement dz that linearly decreases to the second target value a2 with respect to the movement amount n.
  • Transition data C3 has a slope A2.
  • the slope A2 is the ratio of the amount of change in the target displacement dz to the amount of change in the amount of movement n in the transition data C3.
  • the soil-carrying data C4 defines the relationship between the movement amount n and the target displacement dz in the soil-carrying area.
  • the soil transport area is an area where the movement amount n is equal to or greater than the value b3.
  • the target displacement dz is defined as a constant value in the soil-carrying area.
  • the target displacement dz in the soil transport area is constant at the second target value a2.
  • the second target value a2 is smaller than the first target value a1. Therefore, in the excavation area, a larger target displacement dz is defined than in the soil transportation area.
  • the starting value a0, the first target value a1, and the second target value a2 are constants and stored in the storage device .
  • the starting value a0 is preferably a small value that does not excessively increase the load on the blade 18 at the start of excavation.
  • the first target value a1 is preferably a value that enables efficient excavation according to the performance of the work machine 1 and does not excessively increase running resistance.
  • the second target value a2 is preferably set to a value suitable for soil transport work.
  • the slopes A1 and A2 are constants and stored in the storage device 28. It is preferable that the slope A1 of the data C1 at the time of start is a value that enables a rapid transition from the start of excavation to the excavation work and that the load on the blade 18 does not become excessively large.
  • the slope A2 of the transition time data C3 is preferably a value that enables rapid transition from excavation work to soil transport work and does not excessively increase the load on the blade 18 .
  • the value b1 of the movement amount n when the excavation area starts is calculated from the slope A1, the start value a0, and the first target value a1.
  • the value b2 of the amount of movement n when the excavation area ends is the amount of movement when the current amount of soil retained by the blade 18 exceeds a predetermined threshold. Therefore, the controller 26 reduces the target displacement dz from the first target value a1 when the current amount of soil retained by the blade 18 exceeds a predetermined threshold.
  • the predetermined threshold is determined based on the maximum capacity of blade 18, for example. For example, the current soil holding volume of the blade 18 may be determined computationally from the measured load on the blade 18 .
  • an image of the blade 18 may be captured by a camera and the current soil holding volume of the blade 18 may be calculated by analyzing the image.
  • a predetermined initial value is set as the value b2. If the amount of soil retained by the blade 18 exceeds a predetermined threshold before reaching the value b2, instead of the above initial value, it is based on the amount of movement when the soil amount retained by the blade 18 exceeds the predetermined threshold.
  • the value b2 is updated to the new value.
  • the movement amount when the retained soil amount exceeds a predetermined threshold value may be set as the updated value b2.
  • a value smaller than the movement amount when the retained soil amount exceeds a predetermined threshold value may be set as the updated value b2.
  • the value b3 of the movement amount n at the start of the soil transport area is calculated from the slope A2, the first target value a1, and the second target value a2 of the transition data C3.
  • the values b1, b2, b3 may be stored in storage device 28 as constants.
  • b3 may be defined as b2 + constant.
  • b3 may be updated in conjunction with b2.
  • the controller 26 determines the target displacement dz according to the movement amount n. Then, the controller 26 determines the height Z of the target profile 70 (thick dashed line) shown in FIG. 4 from the height Z of the current terrain 50 and the target displacement dz.
  • FIG. 7 is a diagram showing an example of the target profile 70.
  • FIG. A target profile 70 in FIG. 7 is an example of a target profile determined based on the target displacement data in FIG.
  • the work machine 1 starts work from the start position Ps1 and ends the work at the end position Pe1.
  • the target profile 70 includes a first target surface 71, a second target surface 72, a third target surface 73, and a fourth target surface 74.
  • FIG. 7 is a diagram showing an example of the target profile 70.
  • FIG. A target profile 70 in FIG. 7 is an example of a target profile determined based on the target displacement data in FIG.
  • the work machine 1 starts work from the start position Ps1 and ends the work at the end position Pe1.
  • the target profile 70 includes a first target surface 71, a second target surface 72, a third target surface 73, and a fourth target surface 74.
  • the first target plane 71 is the target profile in the excavation start area.
  • the controller determines the target displacement dz on the first target plane 71 from the amount of movement by referring to the starting time data C1.
  • the first target plane 71 slopes downward toward the front of the work machine 1 .
  • a second target plane 72 is the target profile in the drilling area.
  • the controller determines the target displacement dz on the second target plane 72 from the movement amount with reference to the excavation time data C2.
  • a second target plane 72 is parallel to the existing terrain 50 . In this embodiment, the second target plane 72 extends horizontally.
  • the third target surface 73 is the target profile in the soil transfer area.
  • the controller determines the target displacement dz on the third target plane 73 from the amount of movement with reference to the transition data C3.
  • the third target plane 73 slopes upward toward the front of the work machine 1 .
  • a fourth target plane 74 is a target profile in the soil transport area.
  • the controller determines the target displacement dz on the fourth target plane 74 from the amount of movement by referring to the soil-carrying data C4.
  • a fourth target plane 74 is parallel to the existing terrain 50 . In this embodiment, the fourth target plane 74 extends horizontally.
  • the controller 26 controls the blade 18 according to the target profile 70.
  • controller 26 generates a command signal to work implement 13 so that cutting edge position P0 of blade 18 moves according to target profile 70 created in step S106.
  • the generated command signal is input to control valve 27 .
  • the cutting edge position P0 of work implement 13 moves along target profile 70.
  • the target displacement dz between the current terrain 50 and the target profile 70 is larger than in other areas.
  • the excavation work of the current landform 50 is performed in the excavation area.
  • the target displacement dz between the current topography 50 and the target profile 70 is smaller than in other areas.
  • the controller 26 updates the work site data.
  • the controller 26 acquires the position data indicating the latest actual trajectory of the cutting edge position P0 as the current terrain data, and updates the work site data with the acquired current terrain data.
  • the controller 26 may calculate the position of the bottom surface of the crawler belt 16 from the vehicle body position data and the vehicle body dimension data, and acquire position data indicating the actual locus of the bottom surface of the crawler belt 16 as the current terrain data. In this case, updating of the working terrain data can be done immediately.
  • the current topography data may be generated from survey data measured by a surveying device external to the work machine 1.
  • a surveying device for example, an airborne laser survey may be used.
  • 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.
  • aerial survey by UAV Unmanned Aerial Vehicle
  • the worksite data may be updated at predetermined intervals or as needed.
  • the controller 26 determines whether the current work pass has been completed.
  • the controller 26 determines that the current work pass is completed when the work machine 1 reaches a predetermined work end position. For example, the controller 26 determines that the current work pass is completed when it determines that the cutting edge position P0 has reached the end position Pe1 based on the current position data.
  • the controller 26 may determine that the current work pass is completed when the operator operates the operation device 25a to raise the work implement 13. FIG.
  • the controller 26 may determine that the current work pass is completed when the work machine 1 is switched from forward to reverse. If the current work pass has not been completed, the process returns to step S105.
  • the second and subsequent work passes may be affected by the topography of the previous work pass. Therefore, the controller 26 corrects the target displacement dz according to the distance between the start position of the previous work pass and the start position of the current work pass (hereinafter referred to as "work interval"). Specifically, the controller 26 corrects the target displacement dz according to the movement amount of the work machine 1 by correcting the target displacement data C according to the work interval.
  • FIG. 8 is a flow chart showing processing for correcting the target displacement data C. As shown in FIG.
  • step S201 the controller 26 determines whether the first condition is satisfied.
  • the first condition indicates that the current work pass is not affected by the topography of the previous work pass, or is less affected.
  • the first condition includes that the current work pass is the first work pass. Also, the first condition includes that the work interval is greater than the value b2, which is the amount of movement of the end of the excavation area.
  • step S202 the controller 26 uses the default target displacement data C. That is, the controller 26 refers to the target displacement data C described above and determines the target displacement dz from the movement amount n of the work machine 1.
  • FIG. 1 the controller 26 refers to the target displacement data C described above and determines the target displacement dz from the movement amount n of the work machine 1.
  • step S201 when the first condition is not satisfied, the process proceeds to step S203.
  • step S203 the controller 26 determines whether the second condition is satisfied.
  • the second condition indicates that the current start position is close to the previous start position, so that the current work path is affected by the topography of the previous work path.
  • a second condition includes that the work interval is less than the first threshold.
  • the first threshold is, for example, the same as the value b1, which is the amount of movement of the end of the excavation start area. However, the first threshold may differ from the value b1.
  • step S204 the controller 26 corrects the target displacement data C by the first correction process.
  • FIG. 9 is a diagram showing an example of data generated from the target displacement data C by the first correction process (hereinafter referred to as "first correction data C'").
  • FIG. 10 is a diagram showing a target profile 70 generated from the first correction data C'.
  • the current terrain 50 is the terrain formed by the previous work pass (hereinafter referred to as "first work pass").
  • first work pass is not limited to the work pass that is first performed on the current terrain 50 .
  • the first work pass may be a second or subsequent work pass on the existing terrain 50 .
  • the controller 26 determines the target profile 70 by vertically displacing the current terrain 50 by the target displacement dz determined from the target displacement data C, as in FIG. After that, the working machine 1 moves backward by the operator's operation or automatic control, and starts the second work pass from the second starting position Ps2.
  • the controller 26 obtains the second start position Ps2 and calculates the work interval b0 between the first start position Ps1 and the second start position Ps2.
  • the controller 26 modifies the target displacement data C to generate the first modified data C' shown in FIG.
  • the controller 26 sets the target displacement data so that the position where the amount of movement n from the second start position Ps2 is the work interval b0 is the end position of the excavation start area in the second work pass. fix C.
  • the controller 26 changes the first target value from the value a1 to the value a1' without changing the slope A1.
  • the corrected first target value a1' is smaller than the first target value a1 before correction.
  • the excavation start area is the area where the movement amount n is 0 to the work interval b0.
  • the starting time data C1' of the first correction data C' defines the same target displacement dz as the target displacement data C for the movement amount n from 0 to the work interval b0. That is, in the starting time data C1', the target displacement dz linearly increases with a slope A1 to the corrected first target value a1' with respect to the movement amount n from 0 to the work interval b0.
  • the controller 26 calculates a modified first target value a1' from the starting value a0, the slope A1 and the work interval b0.
  • the controller 26 generates the first target plane 71 inclined downward in the region from the second start position Ps2 to the first start position Ps1, as shown in FIG. 10, using the starting data C1'.
  • the excavation area is the area where the movement amount n is from the work interval b0 to the value b2+x.
  • the excavation time data C2' of the first correction data C' defines a constant target displacement dz with respect to the movement amount n in the excavation area.
  • the target displacement dz in the excavation area is constant at the corrected first target value a1'.
  • the controller 26 generates the second target surface 72 in the excavation area, as indicated by the thick dashed line in FIG. 10, using the excavation time data C2'.
  • the second target surface 72 includes a first portion 72a, a second portion 72b and a third portion 72c.
  • the first portion 72a is located in front of the first target surface 71. As shown in FIG.
  • the first portion 72a slopes downward.
  • the inclination angle of the first portion 72a is the same as the inclination angle of the first target surface 71.
  • the second portion 72b extends horizontally.
  • the third portion 72c is located in front of the second portion 72b.
  • the third portion 72c slopes upward.
  • 80 indicates the target profile in the second work pass determined by the uncorrected target displacement data C. If the second start position Ps2 is too close to the first start position Ps1, the inclination of the target profile 80 will suddenly increase at the point where the movement amount n is the work interval b0.
  • the controller 26 uses the first correction data C′ to set the target Determine the profile 70. Thereby, the controller 26 can generate the first target plane 71 inclined at a certain angle and the first portion 72a of the second target plane 72.
  • FIG. As a result, by suppressing the occurrence of an increase in the cutting angle in the excavation area, it is possible to suppress a sudden increase in the load that the blade 18 receives.
  • the soil transfer area is the area where the movement amount n ranges from the value b2+x to the value b3+y.
  • the transition data C3' of the first correction data C' defines the target displacement dz that linearly decreases with a slope A2 with respect to the movement amount n from the value b2+x to the value b3+y.
  • the controller 26 generates a third target plane 73 inclined upward in the soil transfer area, as shown in FIG. Note that the controller 26 determines the value x and the value y so that the excavated soil volume based on the first correction data C′ is the same as the excavated soil volume based on the target displacement data C.
  • the excavated soil volume based on the first corrected data C' is indicated by the area of the first corrected data C' in FIG.
  • the excavated soil volume based on the target displacement data C is indicated by the area of the target displacement data C in FIG. Therefore, the controller 26 determines the value x and the value y when the area of the first correction data C' and the area of the target displacement data C shown in FIG. 9 are to be the same.
  • controller 26 determines the value x and the value y so that the area B1 and the area B2 of the hatched portion in FIG. 9 are the same. Controller 26 also limits the maximum value of value y to working interval b0. This prevents the work machine 1 from excavating ahead of the soil transfer area of the first work path.
  • the soil transport area is the area where the amount of movement n is greater than or equal to b3+y.
  • the soil transport data C4' of the first correction data C' defines a constant target displacement dz with respect to the movement amount n in the soil transport area.
  • the target displacement dz in the soil transport area is constant at the second target value a2.
  • the controller 26 generates a fourth target plane 74 parallel to the current landform 50 in the soil transportation area, as shown in FIG. 10, using the soil transportation time data C4'.
  • step S203 When it is determined in step S203 that the second condition is not satisfied, the process proceeds to step S205.
  • the fact that the second condition is not satisfied indicates that the current start position is far from the previous start position, and that the current work path is affected by the topography of the previous work path.
  • the controller 26 may execute the process of step S205 when the third condition is satisfied.
  • the third condition may include that the work interval is greater than or equal to the second threshold.
  • the second threshold may be the same as the first threshold.
  • the second threshold may be greater than the first threshold.
  • the second threshold may be greater than or equal to the value b1, which is the amount of movement of the end of the excavation start area, and smaller than the value b2, which is the amount of movement of the end of the excavation area.
  • step S205 the controller 26 corrects the target displacement data C (chain line) by the second correction process.
  • FIG. 11 is a diagram showing an example of data generated from the target displacement data C by the second correction process (hereinafter referred to as "second correction data C''").
  • FIG. 12 is a diagram showing a target profile 70 (thick dashed line) generated from the second correction data C′′.
  • the controller 26 corrects the target displacement data C in the second work pass so that the target displacement dz gradually increases from the second start position Ps2 to the first start position Ps1, as shown in FIG.
  • the excavation start region is the region where the movement amount n is from 0 to the work interval b0.
  • a gradually increasing target displacement dz is defined for the movement amount n from 0 to the work interval b0. and linearly increases to the first target value a1 with the corrected slope A1′′.
  • the corrected slope A1′′ is smaller than the slope A1.
  • the controller 26 calculates the corrected inclination A1′′ from the starting value a0, the first target value a1, and the work interval b0.
  • a first target plane 71 inclined downward is generated in the region from the second start position Ps2 to the first start position Ps1.
  • a dashed-dotted line 80 is the target profile generated from the default target displacement data C.
  • the controller 26 uses the second correction data C′′ to set the target position. Determine the profile 70. Thereby, the controller 26 can reduce the variation in the inclination angle between the first target surface 71 and the first portion 72a of the second target surface 72. As a result, the unevenness By suppressing the occurrence, a sudden increase in the load applied to the blade 18 can be suppressed.
  • the excavation area is an area where the movement amount n is from the work interval b0 to the value b2+x.
  • a constant target displacement dz is defined for n.
  • the target displacement dz in the excavation area is constant at the first target value a1.
  • the controller 26 generates a second target surface 72 in the excavation area, as shown in FIG. 12, based on the excavation time data C2′′.
  • the second target surface 72 includes a first portion 72a and a second portion 72b.
  • the first portion 72a is located in front of the first target plane 71.
  • the first portion 72a is inclined downward, and the inclination angle of the first portion 72a is formed by the first work pass.
  • the inclination angle of the first target surface 71 is an angle corresponding to the inclination A1′′.
  • the first target surface 71 and the first portion 72a of the second target surface 72 are continuously connected without forming a horizontal portion therebetween.
  • the soil transition region is a region where the movement amount n ranges from the value b2+x to the value b3+y.
  • a gradually decreasing target displacement dz is defined for the amount of movement n from x to the value b3+y.
  • the amount n is linearly decreased with a slope A2 up to a second target value a2.
  • the controller 26 generates a third target plane 73 inclined upward in the soil transfer area as shown in FIG. ', when the excavated soil volume based on the second correction data C'' is to be the same as the excavated soil volume based on the target displacement data C, the value x and the value y are determined. That is, controller 26 determines value x and value y so that area B3 and area B4 of the hatched portion in FIG. 11 are the same.
  • the soil transportation area is an area where the movement amount n is equal to or greater than the value b3+y.
  • a constant target displacement dz is defined for .
  • the target displacement dz in the soil-carrying area is constant at the second target value a2.
  • the controller 26 generates a fourth target plane 74 parallel to the current topography 50 in the soil transportation area as shown in FIG. 12, based on the soil transportation time data C4''. Since the formation of unevenness after the soil transfer area does not lead to a sudden increase in the load received by the blade, this embodiment assumes that this is the case, but it is necessary to eliminate the unevenness. , the value y may be determined.
  • the processing shown in FIG. 8 described above is repeated in the third work pass as well.
  • the distance between the third start position of the third work pass and the above-mentioned second start position is used as the work interval.
  • the controller 26 corrects the target displacement data C according to the work interval to generate the first corrected data C' or the second corrected data C''.
  • the controller 26 corrects the first corrected data C' or the second corrected data C′′ to determine the target displacement dz according to the amount of movement from the third start position.
  • the controller 26 determines the terrain obtained by vertically displacing the current terrain 50 downward by the target displacement dz as the target profile 70 in the third work pass.
  • the controller 26 repeats the same processing for the fourth and subsequent work passes.
  • the default target displacement data C is referred to, and the target displacement dz (first target displacement ) is determined. Then, the terrain obtained by vertically displacing the current terrain 50 downward by the target displacement dz is determined as the target profile 70 in the first work pass. Further, when the work interval between the first work pass and the second work pass is equal to or less than the value b2, the first corrected data C′ or the second corrected data obtained by correcting the default target displacement data C is obtained according to the work interval. C′′ is generated. The target displacement dz (second target displacement) is determined with reference to the correction data C′, C′′.
  • the terrain obtained by vertically displacing the current terrain 50 downward by the target displacement dz is determined as the target profile 70 in the second work pass. Therefore, the target profile 70 in the second work pass is determined considering the terrain from the first work pass. As a result, it is possible to suppress the influence of the topography caused by the previous work pass and improve the quality of work or work efficiency.
  • the work machine 1 is not limited to a bulldozer, and may be other vehicles such as wheel loaders and motor graders.
  • the work machine 1 may be a remotely controllable vehicle. In that case, part of the control system 3 may be located outside the work machine 1 .
  • controller 26 may be located outside work machine 1 . Controller 26 may be located in a control center remote from the work site.
  • the controller 26 may have a plurality of controllers separate from each other.
  • the controller 26 may include a remote controller 261 arranged outside the working machine 1 and an on-vehicle controller 262 mounted on the working machine 1.
  • the remote controller 261 and the in-vehicle controller 262 may be able to communicate wirelessly via the communication devices 38 and 39 .
  • a part of the functions of the controller 26 described above may be executed by the remote controller 261 and the rest of the functions may be executed by the in-vehicle controller 262 .
  • remote controller 261 may perform the process of determining target profile 70
  • vehicle-mounted controller 262 may perform the process of outputting a command signal to work implement 13 .
  • the operating device 25a and the input device 25b may be arranged outside the work machine 1. In that case, the cab may be omitted from the work machine 1. Alternatively, the operating device 25a and the input device 25b may be omitted from the working machine 1. The work machine 1 may be operated only by automatic control by the controller 26 without operation by the operating device 25a.
  • the current topography 50 may be acquired by other devices, not limited to the position sensor 31 described above.
  • current terrain 50 may be acquired by an interface device 37 that accepts data from an external device.
  • the interface device 37 may wirelessly receive current terrain data measured by an external measuring device 41 .
  • the interface device 37 may be a recording medium reading device, and may receive the current terrain data measured by the external measuring device 41 via the recording medium.
  • the processing by the controller 26 is not limited to the above embodiment, and may be modified. A part of the processing described above may be omitted. Alternatively, part of the processing described above may be changed. For example, the process of determining target profile 70 may be changed.
  • FIG. 15 is a diagram showing first correction data Cm' according to the modification.
  • the excavation start area is the area where the movement amount n is from 0 to the work interval b0.
  • the start time data Cm1' of the first correction data Cm' defines the same target displacement dz as the target displacement data C for the movement amount n from 0 to the work interval b0. That is, in the starting time data Cm1', the target displacement dz linearly increases with a slope A1 to the corrected first target value a1' with respect to the movement amount n from 0 to the work interval b0.
  • the excavation area is the area where the movement amount n is from the work interval b0 to the value b2+x.
  • the excavation time data Cm2' of the first corrected data Cm' defines a constant target displacement dz with the corrected first target value a1' for the movement amount n from the work interval b0 to the value b1+b0. Further, the excavation time data Cm2' defines a target displacement dz that linearly increases with a slope A1 up to the first target value a1 with respect to the movement amount n from the value b1+b0 to the value 2b1.
  • the excavation time data Cm2' defines a constant target displacement dz at the first target value a1 for the movement amount n from the value 2b1 to the value b2+x.
  • the controller 26 generates the first target plane 71 inclined downward in the region from the second start position Ps2 to the first start position Ps1, as shown in FIG.
  • the controller 26 generates the second target surface 72 in the excavation area as shown in FIG. 16, using the excavation time data Cm2'.
  • the second target surface 72 includes a first portion 72a and a second portion 72b.
  • the first portion 72a is located in front of the first target surface 71. As shown in FIG.
  • the first portion 72a slopes downward.
  • the inclination angle of the first portion 72a is the same as the inclination angle of the first target surface 71.
  • the second portion 72b extends horizontally.
  • the soil transfer area is the area where the movement amount n ranges from the value b2+x to the value b3+y.
  • the transition data Cm3' of the first correction data Cm' defines the target displacement dz that linearly decreases with a slope A2 with respect to the movement amount n from the value b2+x to the value b3+y.
  • the controller 26 generates a third target plane 73 inclined upward in the soil transfer area, as shown in FIG. Note that the controller 26 determines the value x and the value y so that the excavated soil volume based on the first correction data Cm′ is the same as the excavated soil volume based on the target displacement data C. That is, the controller 26 determines the value x and the value y so that the area B5 and area B6 of the hatched portion in FIG. 15 are the same.
  • the soil transport area is the area where the amount of movement n is equal to or greater than b3+y.
  • the soil-carrying data Cm4' of the first correction data Cm' defines a constant target displacement dz with respect to the movement amount n in the soil-carrying area.
  • the target displacement dz in the soil transport area is constant at the second target value a2.
  • the controller 26 generates a fourth target plane 74 parallel to the current landform 50 in the soil transportation area, as shown in FIG. 16, using the soil transportation data Cm4'.
  • FIG. 17 is a diagram showing the second corrected data Cm′′ according to the modification.
  • the excavation start region is from the movement amount n of 0 to the work interval b0.
  • is the area of The start time data Cm1′′ of the second correction data Cm′′ defines a gradually increasing target displacement dz for the movement amount n from 0 to the work interval b0. That is, in the starting time data Cm1′′, the target displacement dz linearly increases with a slope A1 up to the corrected first target value a1′′ with respect to the movement amount n from 0 to the work interval b0.
  • the modified first target value a1'' is greater than the first target value a1.
  • the controller 26 calculates the modified first target value a1'' from the starting value a0, the slope A1 and the work interval b0. .
  • the controller 26 generates a downwardly inclined first target plane 71 in the region from the second start position Ps2 to the first start position Ps1, as shown in FIG. 18, using the start time data Cm1′′.
  • the excavation region is a region in which the amount of movement n ranges from the value b0 to the value b2-x.
  • the target displacement dz in the excavation area is constant at the modified first target value a1''.
  • the controller 26 controls the excavation data Cm2 ” generates a second target plane 72 in the excavation area as shown in FIG.
  • the second target surface 72 includes a first portion 72a and a second portion 72b.
  • the first portion 72a is located in front of the first target surface 71. As shown in FIG.
  • the first portion 72a slopes downward.
  • the inclination angle of the first portion 72 a is the same as the inclination angle of the first target surface 71 .
  • the first target surface 71 and the first portion 72a of the second target surface 72 are continuously connected without forming a horizontal portion therebetween.
  • the soil transfer region is a region in which the movement amount n ranges from the value b2-x to the value b3-y.
  • a gradually decreasing target displacement dz is defined for the amount of movement n from x to value b3-y. It linearly decreases with the slope A2 with respect to the quantity n.
  • the controller 26 generates a third target plane 73 inclined upward in the soil transfer area as shown in FIG. ” is the same as the amount of soil excavated by the target displacement data C, the value x and the value y are determined. That is, the controller 26 determines the value x and the value y so that the area B7 and the area B8 of the hatched portion in FIG. 17 are the same.
  • the soil transportation area is a region where the amount of movement n is equal to or greater than the value b3-y.
  • the target displacement dz in the soil-carrying area is constant at the second target value a2.
  • the controller 26 generates a fourth target plane 74 parallel to the current landform 50 in the soil transportation area, as shown in FIG. 18, using the soil transportation data Cm4′′.
  • the method of determining the value x and the value y may differ from that described above.
  • the excavated soil volume based on the first correction data C′ may be different from the excavated soil volume based on the target displacement data C.
  • the excavated soil volume according to the second correction data C′′ may differ from the excavated soil volume according to the target displacement data C.
  • the shape of the target displacement data C may differ from that described above.

Landscapes

  • Engineering & Computer Science (AREA)
  • Mining & Mineral Resources (AREA)
  • Civil Engineering (AREA)
  • General Engineering & Computer Science (AREA)
  • Structural Engineering (AREA)
  • Mechanical Engineering (AREA)
  • Operation Control Of Excavators (AREA)
  • Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
  • Electrical Discharge Machining, Electrochemical Machining, And Combined Machining (AREA)
  • Jib Cranes (AREA)
  • Lifting Devices For Agricultural Implements (AREA)

Abstract

コントローラは、作業機械の移動量に応じた目標変位を規定するデフォルト目標変位データを取得する。コントローラは、作業機械による作業の前回の開始位置と、前回の開始位置よりも後方に位置する今回の開始位置との間の距離を示す作業間隔を取得する。コントローラは、作業間隔に応じてデフォルト目標変位データを修正した修正データを生成する。コントローラは、修正データを参照して、今回の開始位置からの作業機械の移動量に応じた目標変位を決定する。コントローラは、現況地形データを、目標変位だけ鉛直方向下向きに変位させた地形データを、目標プロファイルとして決定する。コントローラは、目標プロファイルに従って作業機を動作させる。

Description

作業機械を制御するためのシステム、方法、および作業機械
 本発明は、作業機械を制御するためのシステム、方法、および作業機械に関する。
 従来、ブルドーザ、或いはグレーダ等の作業機械において、ブレードなどの作業機の位置を自動的に調整する制御が提案されている。例えば、特許文献1では、コントローラは、現況地形を示す現況地形データを取得する。コントローラは、現況地形を目標変位だけ鉛直方向に変位させた地形を、目標プロファイルとして決定する。コントローラは、目標プロファイルに従って、作業機を動作させる。それにより、現況地形が、目標プロファイルに従った形状に形成される。
国際公開WO2018/179383
 作業機械は、前進して、所定の開始位置から作業機による作業を開始し、目標プロファイルに従って、作業機を動作させる。そして、作業機械が、所定の終了位置に到達すると、後進して次の開始位置に移動する。このようにして、作業機械は、一の作業パスにおける作業を実行する。作業パスは、所定の開始位置から所定の終了位置までの一連の作業工程を意味する。
 上述のように、現況地形を目標変位だけ鉛直方向に変位させた地形を、目標プロファイルとして決定する場合、目標プロファイルは、現況地形の影響を受ける。前回の作業パスに重ねて、次の作業パスの目標プロファイルを決定する場合、次の作業パスにおける目標プロファイルは、前回の作業パスによる現況地形の影響を受ける。従って、前回の作業パスによる現況地形に起因して、次の作業パスにおける目標プロファイルに、急な傾斜や凸凹が生じることがある。その場合、作業の品質、或いは作業効率が低下してしまう。例えば、切込み角が急に大きくなると、作業機の受ける負荷が急に増えて作業効率が低下する。また、凸凹を多く含む目標プロファイルに沿って作業機を制御すると、仕上りの地形も凸凹を多く含む地形となり、品質が低下する。本開示の目的は、作業機械の自動制御において、前回の作業パスによる地形の影響を抑えて、次の作業パスにおける作業の品質、或いは作業効率を向上させることにある。
 本開示の第1の態様に係るシステムは、作業機を含む作業機械を制御するためのシステムである。本態様に係るシステムは、センサとコントローラとを備える。センサは、作業機械の現在位置を検出する。コントローラは、センサと通信する。コントローラは、以下の処理を実行するようにプログラムされている。コントローラは、作業機械の現在位置を示す現在位置データを取得する。コントローラは、現況地形を示す現況地形データを取得する。コントローラは、デフォルト目標変位データを取得する。デフォルト目標変位データは、作業機械の移動量に応じた目標変位を規定する。コントローラは、作業間隔を取得する。作業間隔は、作業機械による作業の前回の開始位置と、前回の開始位置よりも後方に位置する今回の開始位置との間の距離を示す。コントローラは、作業間隔に応じてデフォルト目標変位データを修正した修正データを生成する。コントローラは、修正データを参照して、今回の開始位置からの作業機械の移動量に応じた目標変位を決定する。コントローラは、現況地形データを、目標変位だけ鉛直方向下向きに変位させた地形データを、目標プロファイルとして決定する。コントローラは、目標プロファイルに従って作業機を動作させる。
 本開示の第2の態様に係る方法は、作業機を含む作業機械を制御するための方法である。本態様に係る方法は、以下の処理を備える。第1の処理は、作業機械の現在位置を示す現在位置データを取得することである。第2の処理は、現況地形を示す現況地形データを取得することである。第3の処理は、デフォルト目標変位データを取得することである。デフォルト目標変位データは、作業機械の移動量に応じた目標変位を規定する。第4の処理は、作業間隔を取得することである。作業間隔は、作業機械による作業の前回の開始位置と、前回の開始位置よりも後方に位置する今回の開始位置との間の距離を示す。第5の処理は、作業間隔に応じてデフォルト目標変位データを修正した修正データを生成することである。第6の処理は、修正データを参照して、今回の開始位置からの作業機械の移動量に応じた目標変位を決定することである。第7の処理は、現況地形データを、目標変位だけ鉛直方向下向きに変位させた地形データを、目標プロファイルとして決定することである。第8の処理は、目標プロファイルに従って作業機を動作させることである。なお、各処理が実行される順番は、上記の順番に限らず、変更されてもよい。
 本開示の第3の態様に係る作業機械は、作業機と、センサと、コントローラとを備える。センサは、作業機械の現在位置を検出する。コントローラは、センサと通信する。コントローラは、以下の処理を実行するようにプログラムされている。コントローラは、作業機械の現在位置を示す現在位置データを取得する。コントローラは、現況地形を示す現況地形データを取得する。コントローラは、デフォルト目標変位データを取得する。デフォルト目標変位データは、作業機械の移動量に応じた目標変位を規定する。コントローラは、作業間隔を取得する。作業間隔は、作業機械による作業の前回の開始位置と、前回の開始位置よりも後方に位置する今回の開始位置との間の距離を示す。コントローラは、作業間隔に応じてデフォルト目標変位データを修正した修正データを生成する。コントローラは、修正データを参照して、今回の開始位置からの作業機械の移動量に応じた目標変位を決定する。コントローラは、現況地形データを、目標変位だけ鉛直方向下向きに変位させた地形データを、目標プロファイルとして決定する。コントローラは、目標プロファイルに従って作業機を動作させる。
 本開示によれば、前回の開始位置と今回の開始位置との間の距離に応じてデフォルト目標変位データを修正した修正データが生成される。そして、修正データを参照して目標変位が決定され、目標変位だけ現況地形データを鉛直方向下向きに変位させた地形データが、目標プロファイルとして決定される。従って、前回の作業パスによる地形を考慮して、今回の作業パスにおける目標プロファイルが決定される。それにより、前回の作業パスによる地形の影響を抑えて、作業の品質、或いは作業効率を向上させることができる。
実施形態に係る作業機械を示す側面図である。 作業機械の駆動系と制御システムとの構成を示すブロック図である。 作業機械の構成を示す模式図である。 最終設計地形、現況地形、及び目標プロファイルの一例を示す図である。 作業機の自動制御の処理を示すフローチャートである。 目標変位データの一例を示す図である。 目標変位データから生成された目標プロファイルを示す図である。 目標変位データを修正するための処理を示すフローチャートである。 第1修正データの一例を示す図である。 第1修正データから生成された目標プロファイルを示す図である。 第2修正データの一例を示す図である。 第2修正データから生成された目標プロファイルを示す図である。 変形例に係る作業機械の駆動系と制御システムとの構成を示すブロック図である。 他の変形例に係る作業機械の駆動系と制御システムとの構成を示すブロック図である。 変形例に係る第1修正データの一例を示す図である。 変形例に係る第1修正データから生成された目標プロファイルを示す図である。 変形例に係る第2修正データの一例を示す図である。 変形例に係る第2修正データから生成された目標プロファイルを示す図である。
 以下、実施形態に係る作業機械について、図面を参照しながら説明する。図1は、実施形態に係る作業機械1を示す側面図である。本実施形態に係る作業機械1は、ブルドーザである。作業機械1は、車体11と、走行装置12と、作業機13と、を備えている。
 車体11は、運転室14とエンジン室15とを有する。運転室14には、図示しない運転席が配置されている。エンジン室15は、運転室14の前方に配置されている。走行装置12は、車体11の下部に取り付けられている。走行装置12は、左右一対の履帯16を有している。なお、図1では、左側の履帯16のみが図示されている。履帯16が回転することによって、作業機械1が走行する。作業機械1の走行は、自律走行、セミ自律走行、オペレータの操作による走行のいずれの形式であってもよい。
 作業機13は、車体11と走行装置12とに取り付けられている。作業機13は、リフトフレーム17と、ブレード18と、リフトシリンダ19と、を有する。走行装置12の左右の側部には、車幅方向に延びる軸線Xを中心軸としてトラニオン(円筒形の突起)が配置されている。リフトフレーム17は、トラニオンを介して、上下に動作可能に走行装置12に取付けられている。リフトフレーム17は、ブレード18を支持している。ブレード18は、車体11の前方に配置されている。ブレード18は、リフトフレーム17の上下動に伴って上下に移動する。リフトシリンダ19は、車体11とリフトフレーム17とに連結されている。リフトシリンダ19が伸縮することによって、リフトフレーム17は、軸線Xを中心として上下に回転する。リフトシリンダ19が伸びることによって、ブレード18が上昇する。リフトシリンダ19が縮むことによって、ブレード18が下降する。
 図2は、作業機械1の駆動系2と制御システム3との構成を示すブロック図である。図2に示すように、駆動系2は、エンジン22と、油圧ポンプ23と、動力伝達装置24と、を備えている。油圧ポンプ23は、エンジン22によって駆動され、作動油を吐出する。油圧ポンプ23から吐出された作動油は、リフトシリンダ19に供給される。なお、図2では、1つの油圧ポンプ23が図示されているが、複数の油圧ポンプが設けられてもよい。
 動力伝達装置24は、エンジン22の駆動力を走行装置12に伝達する。動力伝達装置24は、例えば、HST(Hydro Static Transmission)であってもよい。或いは、動力伝達装置24は、例えば、トルクコンバータ、或いは複数の変速ギアを有するトランスミッションであってもよい。
 制御システム3は、操作装置25aと、入力装置25bと、コントローラ26と、記憶装置28と、制御弁27とを備える。操作装置25aは、作業機13及び走行装置12を操作するための装置である。操作装置25aは、運転室14に配置されている。操作装置25aは、作業機13及び走行装置12を駆動するためのオペレータによる操作を受け付け、操作に応じた操作信号を出力する。操作装置25aは、例えば、操作レバー、ペダル、スイッチ等を含む。
 例えば、走行用の操作装置25aは、前進位置と後進位置と中立位置とに操作可能である。作業機13用の操作装置25aは、上げ位置と下げ位置とに操作可能である。操作装置25aの位置を示す操作信号は、コントローラ26に出力される。コントローラ26は、操作装置25aの操作位置が前進位置であるときには、作業機械1が前進するように、走行装置12、或いは動力伝達装置24を制御する。操作装置25aの操作位置が後進位置であるときには、コントローラ26は、作業機械1が後進するように、走行装置12、或いは動力伝達装置24を制御する。
 入力装置25bは、例えばタッチパネル式の入力装置である。ただし、入力装置25bは、スイッチ等の他の入力装置であってもよい。オペレータは、入力装置25bを用いて、後述する自動制御の設定を入力することができる。
 コントローラ26は、取得したデータに基づいて作業機械1を制御するようにプログラムされている。コントローラ26は、記憶装置28とプロセッサ30とを含む。プロセッサ30は、例えばCPUを含む。記憶装置28は、例えばメモリと補助記憶装置とを含む。記憶装置28は、例えば、RAM、或いはROMなどであってもよい。記憶装置28は、半導体メモリ、或いはハードディスクなどであってもよい。記憶装置28は、非一時的な(non-transitory)コンピュータで読み取り可能な記録媒体の一例である。記憶装置28は、プロセッサ30によって実行可能であり作業機械1を制御するためのコンピュータ指令を記録している。
 コントローラ26は、操作装置25aから操作信号を取得する。コントローラ26は、操作信号に基づいて、制御弁27を制御する。制御弁27は、比例制御弁であり、コントローラ26からの指令信号によって制御される。制御弁27は、リフトシリンダ19などの油圧アクチュエータと、油圧ポンプ23との間に配置される。制御弁27は、油圧ポンプ23からリフトシリンダ19に供給される作動油の流量を制御する。コントローラ26は、上述した操作装置25aの操作に応じてブレード18が動作するように、制御弁27への指令信号を生成する。これにより、リフトシリンダ19が、操作装置25aの操作量に応じて、制御される。
 例えば、操作装置25aの操作位置が上げ位置であるときには、コントローラ26は、作業機13が上昇するように、制御弁27を制御する。操作装置25aの操作位置が下げ位置であるときには、コントローラ26は、作業機13が下降するように、制御弁27を制御する。なお、制御弁27は、圧力比例制御弁であってもよい。或いは、制御弁27は、電磁比例制御弁であってもよい。
 制御システム3は、ストロークセンサ29を備える。ストロークセンサ29は、リフトシリンダ19のストローク長さ(以下、「リフトシリンダ長」という。)を検出する。コントローラ26は、リフトシリンダ長に基づいてブレード18のリフト角θliftを算出する。図3は、作業機械1の構成を示す模式図である。
 図3では、作業機13の原点位置が二点鎖線で示されている。作業機13の原点位置は、水平な地面上でブレード18の刃先が地面に接触した状態でのブレード18の位置である。リフト角θliftは、作業機械1を側面視したときの、原点位置におけるブレード18の下端(刃先位置P0)と、軸線Xと、ブレードを上下に動作させたときのブレード18の下端(刃先位置P0)とのなす角度である。
 図2に示すように、制御システム3は、位置センサ31を備えている。位置センサ31は、作業機械1の位置を測定する。位置センサ31は、GNSS(Global Navigation Satellite System)レシーバ32と、IMU 33と、アンテナ35とを備える。GNSSレシーバ32は、例えばGPS(Global Positioning System)用の受信機である。GNSSレシーバ32は、衛星より測位信号を受信し、測位信号によりアンテナ35の位置を演算して車体位置データを生成する。コントローラ26は、GNSSレシーバ32から車体位置データを取得する。
 IMU 33は、慣性計測装置(Inertial Measurement Unit)である。IMU 33は、車体傾斜角データと車体加速度データを取得する。車体傾斜角データは、車両前後方向の水平に対する角度(ピッチ角)、および車両横方向の水平に対する角度(ロール角)を含む。車体加速度データは、作業機械1の加速度を含む。コントローラ26は、車体加速度データにより、作業機械1の進行方向と車速とを得る。コントローラ26は、IMU 33から車体傾斜角データ及び車体加速度データを取得する。
 コントローラ26は、リフトシリンダ長と、車体位置データと、車体傾斜角データとから、刃先位置P0を演算する。コントローラ26は、車体位置データに基づいて、アンテナ35のグローバル座標を算出する。コントローラ26は、リフトシリンダ長と車体寸法データとに基づいて、リフト角θliftを算出する。車体寸法データは、記憶装置28に記憶されており、軸線Xに対する作業機13の位置を示すデータを含む。コントローラ26は、リフト角θliftと車体寸法データに基づいて、アンテナ35に対する刃先位置P0のローカル座標を算出する。コントローラ26は、車体加速度データから作業機械1の進行方向と車速とを算出する。車体寸法データは、アンテナ35に対する作業機13の位置を示すデータを含む。コントローラ26は、アンテナ35のグローバル座標と刃先位置P0のローカル座標と車体傾斜角データとに基づいて、刃先位置P0のグローバル座標を算出する。コントローラ26は、刃先位置P0のグローバル座標を刃先位置データとして取得する。
 記憶装置28は、作業現場データと設計地形データとを記憶している。作業現場データは、作業現場の現況の地形を示す。作業現場データは、例えば、三次元データ形式の現況地形測量図である。作業現場データは、例えば、航空レーザ測量で得ることができる。または、作業現場データは、作業現場で稼働する作業機械の作業結果に基づいて取得されても良い。
 コントローラ26は、現況地形データを取得する。現況地形データは、作業現場の現況地形50を示す。現況地形データは、作業機械1の進行方向に位置する地形を示す情報である。現況地形データは、作業現場データから取得されてもよい。あるいは、現況地形データは、前回作業パスの作業結果に基づいて取得されても良い。現況地形データは、前回作業パス作業後の後退時の作業機械の位置データに基づいて取得されても良い。図4は、現況地形50の断面を示す。なお、図4において、縦軸は、地形の高さを示しており、横軸は、作業機械1の進行方向における現在位置からの距離を示している。
 現況地形データは、作業現場データと、上述の位置センサ31から得られる作業機械1の位置と、作業機械1の進行方向とからコントローラ26で演算され、取得される。なお、現況地形データは、作業現場データと、位置センサ31から得られる作業機械1の位置と、作業機械1の進行方向とから取得されたデータを平滑化処理したデータであっても良い。
 詳細には、現況地形データは、作業機械1の進行方向において、現在位置から所定の地形認識距離dnまでの複数の参照点での現況地形50の高さZ0~Znを含む。本実施形態において、現在位置は、作業機械1の現在の刃先位置P0に基づいて定められる位置である。ただし、現在位置は、作業機械1の他の部分の現在位置に基づいて定められてもよい。現在位置は、作業機械の走行に応じて順次更新されても良い。複数の参照点は、所定間隔、例えば1mごとに並んでいる。
 設計地形データは、最終設計地形60を示す。最終設計地形60は、作業現場の表面の最終的な目標形状である。設計地形データは、例えば、三次元データ形式の土木施工図から演算され、取得される。図4に示すように、設計地形データは、作業機械1の進行方向において、複数の参照点での最終設計地形60の高さZdesignを含む。複数の参照点は、作業機械1の進行方向に沿う所定間隔ごとの複数地点を示す。なお、図4では、現況地形50と最終設計地形60とは、水平方向に平行な平坦な形状であるが、これと異なる形状であってもよい。
 コントローラ26は、現況地形データと、設計地形データと、刃先位置データとに基づいて、作業機13を自動的に制御する。以下、コントローラ26によって実行される、掘削における作業機13の自動制御について説明する。図5は、掘削作業における作業機13の自動制御の処理を示すフローチャートである。なお、図5は、掘削作業における一の作業パスにおける処理を示している、一の作業パスは、作業機械1が、開始位置から前進を開始したときから、一連の掘削作業を行い、次の開始位置まで移動するために後進を開始するまでの工程を意味する。
 図5に示すように、ステップS101では、コントローラ26は、現在位置データを取得する。ここでは、コントローラ26は、上述したように、ブレード18の現在の刃先位置データを現在位置データとして取得する。ステップS102では、コントローラ26は、上述した設計地形データを取得する。ステップS103では、コントローラ26は、上述した現況地形データを取得する。
 ステップS104では、コントローラ26は、作業の開始位置を取得する。例えば、コントローラ26は、刃先位置P0が、現況地形50の高さZ0を最初に下回ったときの位置を開始位置として取得する。これにより、ブレード18の刃先が下げられて現況地形50を掘削し始めた位置が開始位置として取得される。例えば、オペレータが操作装置25aを操作することにより作業機13が下降したときに、作業の開始位置を取得してもよい。或いは、コントローラ26が作業機13を自動制御することにより作業機13が下降したときに、作業の開始位置を取得してもよい。ただし、コントローラ26は、他の方法によって、開始位置を取得してもよい。例えば、コントローラ26は、ボタン、或いは、タッチパネルによる画面操作などの操作に基づいて、開始位置を取得してもよい。
 ステップS105では、コントローラ26は、作業機械1の移動量を取得する。コントローラ26は、作業機械1が開始位置から現在位置まで進んだ距離を、移動量として取得する。作業機械1の移動量は、車体11の移動量であってもよい。或いは、作業機械1の移動量は、ブレード18の刃先位置P0の移動量であってもよい。
 ステップS106では、コントローラ26は、目標プロファイル70を決定する。図4に示すように、目標プロファイル70は、作業におけるブレード18の刃先の望まれる軌跡を示す。目標プロファイル70は、作業対象である地形の目標形状であり、掘削作業の結果として望まれる形状を示す。
 なお、コントローラ26は、最終設計地形60を下方に越えないように、目標プロファイル70を決定する。従って、コントローラ26は、掘削作業時には、最終設計地形60より上方、及び、最終設計地形60を含む範囲、且つ、現況地形50より下方に位置する目標プロファイル70を決定する。
 図4に示すように、コントローラ26は、現況地形50から、目標変位dz、下方に変位した目標プロファイル70を決定する。目標変位dzは、各参照点での鉛直方向における目標深さである。或いは、目標変位dzは、現況地形50の垂直方向における目標深さであっても良い。コントローラ26は、目標変位データCを参照して、作業機械1の移動量に応じて目標変位dzを決定する。目標変位データCは、記憶装置28に記憶されている。図6は、目標変位データCの一例を示す図である。目標変位データCは、作業機械1の水平方向の移動量nに対する目標変位dzを規定する。コントローラ26は、図6に示す目標変位データCを参照して、作業機械1の移動量nから、目標変位dzを決定する。
 目標変位データCは、開始時データC1と、掘削時データC2と、移行時データC3と、運土時データC4とを含む。開始時データC1は、掘削開始領域での移動量nと目標変位dzとの関係を規定する。掘削開始領域は、移動量nが0から値b1までの領域である。開始時データC1で示されるように、掘削開始領域では、移動量nの増大に応じて徐々に増大する目標変位dzが規定される。開始時データC1は、移動量nに対して、第1目標値a1まで、線形増加する目標変位dzを規定する。開始時データC1は、傾きA1を有する。傾きA1は、開始時データC1における移動量nの変化量に対する目標変位dzの変化量の割合である。掘削開始領域において、移動量nが0の位置、すなわち作業の開始位置での目標変位dzは、開始値a0である。
 掘削時データC2は、掘削領域での移動量nと目標変位dzとの関係を規定する。掘削領域は、移動量nが値b1から値b2までの領域である。掘削時データC2で示されるように、掘削時データC2は、移動量nに対して一定の目標変位dzを規定する。掘削領域での目標変位dzは、第1目標値a1で一定である。
 移行時データC3は、運土移行領域での移動量nと目標変位dzとの関係を規定する。運土移行領域は、移動量nが値b2から値b3までの領域である。移行時データC3で示されるように、運土移行領域では、移動量nの増大に応じて徐々に減少する目標変位dzが規定される。移行時データC3は、移動量nに対して、第2目標値a2まで、線形減少する目標変位dzを規定する。移行時データC3は、傾きA2を有する。傾きA2は、移行時データC3における移動量nの変化量に対する目標変位dzの変化量の割合である。
 運土時データC4は、運土領域での移動量nと目標変位dzとの関係を規定する。運土領域は、移動量nが値b3以上の領域である。運土時データC4に示されるように、運土領域では、目標変位dzは一定値に規定される。運土領域での目標変位dzは、第2目標値a2で一定である。第2目標値a2は、第1目標値a1よりも小さい。従って、掘削領域では運土領域よりも大きな目標変位dzが規定される。
 開始値a0、第1目標値a1、及び第2目標値a2は、定数であり、記憶装置28に記憶されている。開始値a0は、掘削開始時にブレード18への負荷が過剰に大きくならない程度に小さな値であることが好ましい。第1目標値a1は、作業機械1の性能に応じて、効率よく掘削を行うことができると共に、走行抵抗が過剰に大きくならない程度の値であることが好ましい。第2目標値a2は、運土作業に適した値に設定されることが好ましい。
 傾きA1, A2は、定数であり、記憶装置28に記憶されている。開始時データC1の傾きA1は、掘削開始から掘削作業に迅速に移行可能であると共に、ブレード18への負荷が過剰に大きくならない程度の値であることが好ましい。移行時データC3の傾きA2は、掘削作業から運土作業に迅速に移行可能であると共に、ブレード18への負荷が過剰に大きくならない程度の値であることが好ましい。
 掘削領域が始まるときの移動量nの値b1は、傾きA1、開始値a0、及び第1目標値a1から演算により求められる。掘削領域が終了するときの移動量nの値b2は、ブレード18の現在の保持土量が、所定の閾値を越えるときの移動量である。従って、ブレード18の現在の保持土量が、所定の閾値を越えたときに、コントローラ26は、目標変位dzを第1目標値a1から低減させる。所定の閾値は、例えばブレード18の最大容量に基づいて決定される。例えば、ブレード18の現在の保持土量は、ブレード18への負荷が測定され、当該負荷から演算により決定されてもよい。或いは、ブレード18の画像がカメラによって取得され、当該画像を分析することによって、ブレード18の現在の保持土量が算出されてもよい。なお、値b2として、所定の初期値が設定される。ブレード18の保持土量が、値b2到達前に、所定の閾値を越えた場合は、上記の初期値に替えて、ブレード18の保持土量が所定の閾値を越えた時の移動量に基づいた値に、値b2が更新される。保持土量が所定の閾値を越えた時の移動量が、更新後の値b2とされても良い。保持土量が所定の閾値を越えた時の移動量よりも小さい値が、更新後の値b2とされても良い。
 運土領域が始まるときの移動量nの値b3は、移行時データC3の傾きA2、第1目標値a1、及び第2目標値a2から演算により求められる。値b1, b2, b3は、定数として記憶装置28に記憶されてもよい。b3は、b2+定数で定義されてもよい。b2が更新された場合には、b2に連動してb3が更新されても良い。
 コントローラ26は、目標変位データCから、移動量nに応じた目標変位dzを決定する。そして、コントローラ26は、現況地形50の高さZと目標変位dzとから、図4に示す目標プロファイル70(太破線)の高さZを決定する。
 図7は、目標プロファイル70の一例を示す図である。図7の目標プロファイル70は、図6の目標変位データと、現況地形データ50とに基づいて決定された目標プロファイルの例である。図7に示す例では、作業機械1は、開始位置Ps1から作業を開始し、終了位置Pe1において作業を終了する。図7に示すように、目標プロファイル70は、第1目標面71と、第2目標面72と、第3目標面73と、第4目標面74とを含む。
 第1目標面71は、掘削開始領域における目標プロファイルである。コントローラは、開始時データC1を参照して、移動量から第1目標面71における目標変位dzを決定する。第1目標面71は、作業機械1の前方へ向かって下り勾配である。第2目標面72は、掘削領域における目標プロファイルである。コントローラは、掘削時データC2を参照して、移動量から第2目標面72における目標変位dzを決定する。第2目標面72は、現況地形50と平行である。本実施形態では、第2目標面72は、水平方向に延びている。
 第3目標面73は、運土移行領域における目標プロファイルである。コントローラは、移行時データC3を参照して、移動量から第3目標面73における目標変位dzを決定する。第3目標面73は、作業機械1の前方へ向かって上り勾配である。第4目標面74は、運土領域における目標プロファイルである。コントローラは、運土時データC4を参照して、移動量から第4目標面74における目標変位dzを決定する。第4目標面74は、現況地形50と平行である。本実施形態では、第4目標面74は、水平方向に延びている。
 図5に示すステップS107では、コントローラ26は、目標プロファイル70に従ってブレード18を制御する。ここでは、コントローラ26は、ステップS106で作成した目標プロファイル70に従ってブレード18の刃先位置P0が移動するように、作業機13への指令信号を生成する。生成された指令信号は、制御弁27に入力される。それにより、作業機13の刃先位置P0が目標プロファイル70に沿って移動する。
 図7に示すように、掘削領域では、現況地形50と目標プロファイル70との間の目標変位dzが、他の領域と比べて大きい。これにより、掘削領域では、現況地形50の掘削作業が行われる。運土領域では、現況地形50と目標プロファイル70との間の目標変位dzが他の領域と比べて小さい。これにより、運土領域では、地面の掘削が控えられ、ブレード18に保持されている土砂が運搬される。
 ステップS108では、コントローラ26は、作業現場データを更新する。コントローラ26は、刃先位置P0の最新の実際の軌跡を示す位置データを、現況地形データとして取得し、取得した現況地形データによって作業現場データを更新する。或いは、コントローラ26は、車体位置データと車体寸法データとから履帯16の底面の位置を算出し、履帯16の底面の実際の軌跡を示す位置データを現況地形データとして取得してもよい。この場合、作業地形データの更新は即時に行うことができる。
 或いは、現況地形データは、作業機械1の外部の測量装置によって計測された測量データから生成されてもよい。外部の測量装置として、例えば、航空レーザ測量を用いてよい。或いは、カメラによって現況地形50を撮影し、カメラによって得られた画像データから現況地形データが生成されてもよい。例えば、UAV(Unmanned Aerial Vehicle)による空撮測量を用いてよい。外部の測量装置又はカメラの場合、作業現場データの更新は、所定周期ごと、あるいは随時に行われてもよい。
 ステップS109では、コントローラ26は、今回の作業パスが完了したかを判定する。コントローラ26は、作業機械1が所定の作業終了位置に到達したときに、今回の作業パスが完了したと判定する。例えば、コントローラ26は、現在位置データに基づいて、刃先位置P0が終了位置Pe1に到達したと判断したときに、今回の作業パスが完了したと判定する。或いは、コントローラ26は、オペレータが操作装置25aを操作することにより作業機13が上昇したときに、今回の作業パスが完了したと判定してもよい。或いは、コントローラ26は、作業機械1が前進から後進に切り換えられたときに、今回の作業パスが完了したと判定してもよい。今回の作業パスが完了していないときには、処理はステップS105に戻る。
 今回の作業パスが完了すると、作業機械1は、次の開始位置へ移動するために直進経路を後進する。そして、作業機械1は、再び前進して、次の作業パスを開始する。なお、作業機械1の前進と後進との切換は、オペレータが操作装置25aを操作することで行われてもよい。或いは、作業機械1の前進と後進との切換は、コントローラ26による自動制御によって行われてもよい。コントローラ26は、次の作業パスに対しても、上記の処理を実行する。このような処理が繰り返されることにより、現況地形50が最終設計地形60に近づくように、掘削が行われる。
 2回目以降の作業パスは、前回の作業パスによる地形の影響を受けることがある。そのため、コントローラ26は、前回の作業パスの開始位置と今回の作業パスの開始位置との間の距離(以下、「作業間隔」と呼ぶ)に応じて、目標変位dzを修正する。詳細には、コントローラ26は、作業間隔に応じて目標変位データCを修正することで、作業機械1の移動量に応じた目標変位dzを修正する。図8は、目標変位データCを修正するための処理を示すフローチャートである。
 図8に示すように、ステップS201では、コントローラ26は、第1条件が満たされているかを判定する。第1条件は、今回の作業パスが前回の作業パスによる地形の影響を受けない、或いは影響が少ないことを示す。第1条件は、今回の作業パスが最初の作業パスであることを含む。また、第1条件は、作業間隔が掘削領域終端の移動量である値b2より大きいことを含む。
 第1条件が満たされているときには、処理は、ステップS202に進む。ステップS202では、コントローラ26は、デフォルト目標変位データCを用いる。すなわち、コントローラ26は、上述した目標変位データCを参照して、作業機械1の移動量nから目標変位dzを決定する。
 ステップS201において、第1条件が満たされていないときには、処理はステップS203に進む。ステップS203では、コントローラ26は、第2条件が満たされているかを判定する。第2条件は、今回の開始位置が前回の開始位置に近いことで、今回の作業パスが、前回の作業パスによる地形の影響を受けることを示す。第2条件は、作業間隔が第1閾値より小さいことを含む。第1閾値は、例えば掘削開始領域終端の移動量である値b1と同じである。ただし、第1閾値は、値b1と異なってもよい。
 第2条件が満たされているときには、処理はステップS204に進む。ステップS204では、コントローラ26は、第1の修正処理により、目標変位データCを修正する。図9は、第1の修正処理により目標変位データCから生成されたデータ(以下、「第1修正データC’」と呼ぶ)の一例を示す図である。図10は、第1修正データC’から生成された目標プロファイル70を示す図である。
 図10に示すように、現況地形50は、前回の作業パス(以下、「第1の作業パス」と呼ぶ)によって形成された地形である。なお、第1の作業パスは、現況地形50に対して最初に行われる作業パスに限らない。第1の作業パスは、現況地形50に対して2回目以降に行われる作業パスであってもよい。
 第1の作業パスでは、第1開始位置Ps1から作業が開始され、第1終了位置Pe1で作業が終了されている。第1の作業パスでは、コントローラ26は、図7と同様に、現況地形50を目標変位データCから決定された目標変位dzだけ鉛直方向に変位させることで目標プロファイル70を決定している。その後、作業機械1はオペレータによる操作、或いは自動制御によって後退し、第2開始位置Ps2から第2の作業パスを開始する。コントローラ26は、第2開始位置Ps2を取得し、第1開始位置Ps1と第2開始位置Ps2との間の作業間隔b0を算出する。作業間隔b0が第1閾値より小さいときには、コントローラ26は、目標変位データCを修正して図9に示す第1修正データC’を生成する。
 コントローラ26は、図9に示すように、第2開始位置Ps2からの移動量nが作業間隔b0である位置を、第2の作業パスにおける掘削開始領域の終端位置とするように、目標変位データCを修正する。コントローラ26は、傾きA1を変更せずに、第1目標値を値a1から値a1’に変更する。修正された第1目標値a1’は、修正前の第1目標値a1よりも小さい。
 図9に示すように、第1修正データC’において、掘削開始領域は、移動量nが0から作業間隔b0までの領域である。第1修正データC’の開始時データC1’は、0から作業間隔b0までの移動量nに対して、目標変位データCと同じ目標変位dzを規定する。すなわち、開始時データC1’では、目標変位dz は、0から作業間隔b0までの移動量nに対して、修正された第1目標値a1’まで、傾きA1で線形増加する。コントローラ26は、開始値a0と、傾きA1と、作業間隔b0とから、修正された第1目標値a1’を算出する。コントローラ26は、開始時データC1’によって、図10に示すように、第2開始位置Ps2から第1開始位置Ps1までの領域において、下方に向かって傾斜した第1目標面71を生成する。
 第1修正データC’において、掘削領域は、移動量nが作業間隔b0から値b2+xまでの領域である。第1修正データC’の掘削時データC2’は、掘削領域において、移動量nに対して一定の目標変位dzを規定する。掘削時データC2’において、掘削領域での目標変位dzは、修正された第1目標値a1’で一定である。コントローラ26は、掘削時データC2’によって、図10の太破線に示すように、掘削領域において、第2目標面72を生成する。第2目標面72は、第1部分72aと、第2部分72bと、第3部分72cとを含む。第1部分72aは、第1目標面71の前方に位置している。第1部分72aは、下方に向かって傾斜している。第1部分72aの傾斜角度は、第1目標面71の傾斜角度と同じである。第2部分72bは、水平方向に延びている。第3部分72cは、第2部分72bの前方に位置している。第3部分72cは、上方に向かって傾斜している。
 図10において、80は、修正されていない目標変位データCによって決定された第2作業パスにおける目標プロファイルを示している。第2開始位置Ps2が第1開始位置Ps1に近すぎる場合には、移動量nが作業間隔b0である地点で、目標プロファイル80の傾斜が急に大きくなってしまう。それに対して、本実施形態に係る作業機械1の制御システム3によれば、第2開始位置Ps2が第1開始位置Ps1に近すぎる場合には、コントローラ26は、第1修正データC’によって目標プロファイル70を決定する。それにより、コントローラ26は、一定角度で傾斜した第1目標面71と、第2目標面72の第1部分72aとを生成することができる。その結果、掘削領域での切込み角の増大の発生が抑制されることにより、ブレード18が受ける負荷の急な増加を抑制できる。
 第1修正データC’において、運土移行領域は、移動量nが値b2+xから値b3+yまでの領域である。第1修正データC’の移行時データC3’は、値b2+xから値b3+yまでの移動量nに対して、傾きA2で線形減少する目標変位dzを規定する。
 コントローラ26は、移行時データC3’によって、図10に示すように、運土移行領域において、上方へ向かって傾斜した第3目標面73を生成する。なお、コントローラ26は、第1修正データC’による掘削土量が、目標変位データCによる掘削土量と同じになるように、値xと値yとを決定する。第1修正データC’による掘削土量は、図9の第1修正データC’の面積で示される。目標変位データCによる掘削土量は、図9の目標変位データCの面積で示される。従って、コントローラ26は、図9に示す第1修正データC’の面積と目標変位データCの面積とが同じになるようにしたいときは、値xと値yとを決定する。すなわち、コントローラ26は、図9においてハッチングを付した部分の面積B1と面積B2とが同じになるように、値xと値yとを決定する。また、コントローラ26は、値yの最大値を作業間隔b0に制限する。それにより、作業機械1が、第1の作業パスの運土移行領域よりも前方を掘削することが防止される。
 第1修正データC’において、運土領域は、移動量nが値b3+y以上の領域である。第1修正データC’の運土時データC4’は、運土領域において、移動量nに対して一定の目標変位dzを規定する。運土時データC4’において、運土領域での目標変位dzは、第2目標値a2で一定である。コントローラ26は、運土時データC4’によって、図10に示すように、運土領域において、現況地形50と平行な第4目標面74を生成する。
 ステップS203において、第2条件が満たされていないと判定されたときには、処理はステップS205に進む。第2条件が満たされていないことは、今回の開始位置が前回の開始位置から遠いことで、今回の作業パスが、前回の作業パスによる地形の影響を受けることを示す。なお、コントローラ26は、第3条件が満たされているときに、ステップS205の処理を実行してもよい。第3条件は、作業間隔が第2閾値以上であることを含んでもよい。第2閾値は、第1閾値と同じであってもよい。第2閾値は、第1閾値より大きくてもよい。第2閾値は、掘削開始領域終端の移動量である値b1以上、且つ、掘削領域終端の移動量である値b2より小さくてもよい。
 ステップS205では、コントローラ26は、第2の修正処理により、目標変位データC(一点鎖線)を修正する。図11は、第2の修正処理により目標変位データCから生成されたデータ(以下、「第2修正データC”」と呼ぶ)の一例を示す図である。図12は、第2修正データC”から生成された目標プロファイル70(太破線)を示す図である。
 コントローラ26は、図12に示すように、第2開始位置Ps2から第1開始位置Ps1まで、目標変位dzが徐々に増大するように、第2の作業パスにおける目標変位データCを修正する。
 図11に示すように、第2修正データC”において、掘削開始領域は、移動量nが0から作業間隔b0までの領域である。第2修正データC”の開始時データC1”は、0から作業間隔b0までの移動量nに対して、徐々に増加する目標変位dzを規定する。すなわち、開始時データC1”では、目標変位dz は、0から作業間隔b0までの移動量nに対して、修正された傾きA1”で、第1目標値a1まで線形増加する。修正された傾きA1”は、傾きA1より小さい。コントローラ26は、開始値a0と、第1目標値a1と、作業間隔b0とから、修正された傾きA1”を算出する。コントローラ26は、開始時データC1”によって、図12に示すように、第2開始位置Ps2から第1開始位置Ps1までの領域において、下方に向かって傾斜した第1目標面71を生成する。一点鎖線80はデフォルト目標変位データCから生成した場合の目標プロファイルである。目標プロファイル80で示されているように、第2開始位置Ps2が第1開始位置Ps1から遠すぎる場合には、移動量nが作業間隔b0に到達する前に、掘削開始領域が終わり、掘削領域が始まる。そのため、目標プロファイル80に凹凸が生じてしまう。それに対して、本実施形態に係る作業機械1の制御システム3によれば、第2開始位置Ps2が第1開始位置Ps1から遠すぎる場合には、コントローラ26は、第2修正データC”によって目標プロファイル70を決定する。それにより、コントローラ26は、第1目標面71と、第2目標面72の第1部分72aとの間の傾斜角度の変動を小さくすることができる。その結果、凹凸の発生が抑制されることで、ブレード18が受ける負荷の急な増加を抑制できる。
 第2修正データC”において、掘削領域は、移動量nが作業間隔b0から値b2+xまでの領域である。第2修正データC”の掘削時データC2”は、掘削領域において、移動量nに対して一定の目標変位dzを規定する。掘削時データC2”において、掘削領域での目標変位dzは、第1目標値a1で一定である。コントローラ26は、掘削時データC2”によって、図12に示すように、掘削領域において、第2目標面72を生成する。第2目標面72は、第1部分72aと第2部分72bとを含む。第1部分72aは、第1目標面71の前方に位置する。第1部分72aは、下方に向かって傾斜している。第1部分72aの傾斜角度は、第1作業パスによって形成された現況地形50の傾きに応じた角度であり、第1目標面71の傾斜角度は傾きA1”に応じた角度である。ただし、第1目標面71と、第2目標面72の第1部分72aとは、間に水平部分が形成されることなく、連続的に接続されている。
 第2修正データC”において、運土移行領域は、移動量nが値b2+xから値b3+yまでの領域である。第2修正データC”の移行時データC3”は、値b2+xから値b3+yまでの移動量nに対して、徐々に減少する目標変位dzを規定する。移行時データC3”では、目標変位dz は、値b2+xから値b3+yまでの移動量nに対して、第2目標値a2まで、傾きA2で線形減少する。
 コントローラ26は、移行時データC3”によって、図12に示すように、運土移行領域において、上方へ向かって傾斜した第3目標面73を生成する。なお、コントローラ26は、第1修正データC’と同様に、第2修正データC”による掘削土量が、目標変位データCによる掘削土量と同じにしたいときは、値xと値yとを決定する。すなわち、コントローラ26は、図11においてハッチングを付した部分の面積B3と面積B4とが同じになるように、値xと値yとを決定する。
 第2修正データC”において、運土領域は、移動量nが値b3+y以上の領域である。第2修正データC”の運土時データC4”は、運土領域において、移動量nに対して一定の目標変位dzを規定する。運土時データC4”において、運土領域での目標変位dzは、第2目標値a2で一定である。コントローラ26は、運土時データC4”によって、図12に示すように、運土領域において、現況地形50と平行な第4目標面74を生成する。なお、図12の運土移行領域の終端以降には、凸凹が形成されている。運土移行領域以降での凸凹の形成は、ブレードが受ける負荷の急な増加に繋がらないため、本実施形態では成り行きとしているが、凸凹を解消するように、値yを決定しても良い。
 なお、第3の作業パスにおいても、上述した図8に示す処理が繰り返される。第3の作業パスでは、第3の作業パスの第3開始位置と上述した第2開始位置との間の距離が、作業間隔として用いられる。コントローラ26は、作業間隔に応じて目標変位データCを修正して、第1修正データC’又は第2修正データC”を生成する。コントローラ26は、第1修正データC’又は第2修正データC”を参照して、第3開始位置からの移動量に応じた目標変位dzを決定する。コントローラ26は、目標変位dzだけ現況地形50を鉛直方向下向きに変位させた地形を、第3の作業パスにおける目標プロファイル70として決定する。第4の作業パス以降についても、コントローラ26は、同様の処理を繰り返す。
 以上説明した、本実施形態に係る作業機械1の制御システム3によれば、第1の作業パスでは、デフォルト目標変位データCを参照して、移動量に応じた目標変位dz(第1目標変位)が決定される。そして、目標変位dzだけ現況地形50を鉛直方向下向きに変位させた地形が、第1の作業パスにおける目標プロファイル70として決定される。また、第1の作業パスと第2の作業パスとの作業間隔が値b2以下であるときには、作業間隔に応じて、デフォルト目標変位データCを修正した第1修正データC’又は第2修正データC”が生成される。修正データC’, C”を参照して、目標変位dz(第2目標変位)が決定される。そして、目標変位dzだけ現況地形50を鉛直方向下向きに変位させた地形が、第2の作業パスにおける目標プロファイル70として決定される。従って、第1の作業パスによる地形を考慮して、第2の作業パスにおける目標プロファイル70が決定される。それにより、前回の作業パスによる地形の影響を抑えて、作業の品質、或いは作業効率を向上させることができる。
 以上、本発明の一実施形態について説明したが、本発明は上記実施形態に限定されるものではなく、発明の要旨を逸脱しない範囲で種々の変更が可能である。
 作業機械1は、ブルドーザに限らず、ホイールローダ、モータグレーダ等の他の車両であってもよい。
 作業機械1は、遠隔操縦可能な車両であってもよい。その場合、制御システム3の一部は、作業機械1の外部に配置されてもよい。例えば、コントローラ26は、作業機械1の外部に配置されてもよい。コントローラ26は、作業現場から離れたコントロールセンタ内に配置されてもよい。
 コントローラ26は、互いに別体の複数のコントローラを有してもよい。例えば、図13に示すように、コントローラ26は、作業機械1の外部に配置されるリモートコントローラ261と、作業機械1に搭載される車載コントローラ262とを含んでもよい。リモートコントローラ261と車載コントローラ262とは通信装置38,39を介して無線により通信可能であってもよい。そして、上述したコントローラ26の機能の一部がリモートコントローラ261によって実行され、残りの機能が車載コントローラ262によって実行されてもよい。例えば、目標プロファイル70を決定する処理がリモートコントローラ261によって実行され、作業機13への指令信号を出力する処理が車載コントローラ262によって実行されてもよい。
 操作装置25a及び入力装置25bは、作業機械1の外部に配置されてもよい。その場合、運転室は、作業機械1から省略されてもよい。或いは、操作装置25a及び入力装置25bが作業機械1から省略されてもよい。操作装置25aによる操作無しで、コントローラ26による自動制御のみによって作業機械1が操作されてもよい。
 現況地形50は、上述した位置センサ31に限らず、他の装置によって取得されてもよい。例えば、図14に示すように、外部の装置からのデータを受け付けるインターフェ-ス装置37によって現況地形50が取得されてもよい。インターフェ-ス装置37は、外部の計測装置41が計測した現況地形データを無線によって受信してもよい。或いは、インターフェ-ス装置37は、記録媒体の読み取り装置であって、外部の計測装置41が計測した現況地形データを、記録媒体を介して受け付けてもよい。
 コントローラ26による処理は、上記の実施形態のものに限らず、変更されてもよい。上述した処理の一部が省略されてもよい。或いは、上述した処理の一部が変更されてもよい。例えば、目標プロファイル70を決定する処理が変更されてもよい。
 図15は、変形例に係る第1修正データCm’を示す図である。図15に示すように、変形例に係る第1修正データCm’において、掘削開始領域は、移動量nが0から作業間隔b0までの領域である。第1修正データCm’の開始時データCm1’は、0から作業間隔b0までの移動量nに対して、目標変位データCと同じ目標変位dzを規定する。すなわち、開始時データCm1’では、目標変位dz は、0から作業間隔b0までの移動量nに対して、修正された第1目標値a1’まで、傾きA1で線形増加する。
 第1修正データCm’において、掘削領域は、移動量nが作業間隔b0から値b2+xまでの領域である。第1修正データCm’の掘削時データCm2’は、作業間隔b0から値b1+b0までの移動量nに対して、修正された第1目標値a1’で一定の目標変位dzを規定する。また、掘削時データCm2’は、値b1+b0から値2b1までの移動量nに対して、第1目標値a1まで、傾きA1で線形増加する目標変位dzを規定する。掘削時データCm2’は、値2b1から値b2+xまでの移動量nに対して、第1目標値a1で一定の目標変位dzを規定する。コントローラ26は、開始時データCm1’によって、図16に示すように、第2開始位置Ps2から第1開始位置Ps1までの領域において、下方に向かって傾斜した第1目標面71を生成する。コントローラ26は、掘削時データCm2’によって、図16に示すように、掘削領域において、第2目標面72を生成する。第2目標面72は、第1部分72aと第2部分72bとを含む。第1部分72aは、第1目標面71の前方に位置している。第1部分72aは、下方に向かって傾斜している。第1部分72aの傾斜角度は、第1目標面71の傾斜角度と同じである。第2部分72bは、水平方向に延びている。
 第1修正データCm’において、運土移行領域は、移動量nが値b2+xから値b3+yまでの領域である。第1修正データCm’の移行時データCm3’は、値b2+xから値b3+yまでの移動量nに対して、傾きA2で線形減少する目標変位dzを規定する。
 コントローラ26は、移行時データCm3’によって、図16に示すように、運土移行領域において、上方へ向かって傾斜した第3目標面73を生成する。なお、コントローラ26は、第1修正データCm’による掘削土量が、目標変位データCによる掘削土量と同じになるように、値xと値yとを決定する。すなわち、コントローラ26は、図15においてハッチングを付した部分の面積B5と面積B6とが同じになるように、値xと値yとを決定する。
 第1修正データCm’において、運土領域は、移動量nが値b3+y以上の領域である。第1修正データCm’の運土時データCm4’は、運土領域において、移動量nに対して一定の目標変位dzを規定する。運土時データCm4’において、運土領域での目標変位dzは、第2目標値a2で一定である。コントローラ26は、運土時データCm4’によって、図16に示すように、運土領域において、現況地形50と平行な第4目標面74を生成する。
 図17は、変形例に係る第2修正データCm”を示す図である。図17に示すように、第2修正データCm”において、掘削開始領域は、移動量nが0から作業間隔b0までの領域である。第2修正データCm”の開始時データCm1”は、0から作業間隔b0までの移動量nに対して、徐々に増加する目標変位dzを規定する。すなわち、開始時データCm1”では、目標変位dz は、0から作業間隔b0までの移動量nに対して、修正された第1目標値a1”まで、傾きA1で線形増加する。
 修正された第1目標値a1”は、第1目標値a1より大きい。コントローラ26は、開始値a0と、傾きA1と、作業間隔b0とから、修正された第1目標値a1”を算出する。コントローラ26は、開始時データCm1”によって、図18に示すように、第2開始位置Ps2から第1開始位置Ps1までの領域において、下方に向かって傾斜した第1目標面71を生成する。
 第2修正データCm”において、掘削領域は、移動量nが値b0から値b2-xまでの領域である。第2修正データCm”の掘削時データCm2”は、掘削領域において、移動量nに対して一定の目標変位dzを規定する。掘削時データCm2”において、掘削領域での目標変位dzは、修正された第1目標値a1”で一定である。コントローラ26は、掘削時データCm2”によって、図18に示すように、掘削領域において、第2目標面72を生成する。第2目標面72は、第1部分72aと第2部分72bとを含む。第1部分72aは、第1目標面71の前方に位置する。第1部分72aは、下方に向かって傾斜している。第1部分72aの傾斜角度は、第1目標面71の傾斜角度と同じである。また、第1目標面71と、第2目標面72の第1部分72aとは、間に水平部分が形成されることなく、連続的に接続されている。
 第2修正データCm”において、運土移行領域は、移動量nが値b2-xから値b3-yまでの領域である。第2修正データCm”の移行時データCm3”は、値b2-xから値b3-yまでの移動量nに対して、徐々に減少する目標変位dzを規定する。移行時データCm3”では、目標変位dz は、値b2-xから値b3-yまでの移動量nに対して、傾きA2で線形減少する。
 コントローラ26は、移行時データCm3”によって、図18に示すように、運土移行領域において、上方へ向かって傾斜した第3目標面73を生成する。なお、コントローラ26は、第2修正データCm”による掘削土量が、目標変位データCによる掘削土量と同じになるように、値xと値yとを決定する。すなわち、コントローラ26は、図17においてハッチングを付した部分の面積B7と面積B8とが同じになるように、値xと値yとを決定する。
 第2修正データCm”において、運土領域は、移動量nが値b3-y以上の領域である。第2修正データCm”の運土時データCm4”は、運土領域において、移動量nに対して一定の目標変位dzを規定する。運土時データCm4”において、運土領域での目標変位dzは、第2目標値a2で一定である。コントローラ26は、運土時データCm4”によって、図18に示すように、運土領域において、現況地形50と平行な第4目標面74を生成する。
 値xと値yとを決定する方法は、上述したものと異なってもよい。第1修正データC’による掘削土量は、目標変位データCによる掘削土量と異なってもよい。第2修正データC”による掘削土量は、目標変位データCによる掘削土量と異なってもよい。目標変位データCの形状は、上記のものと異なってもよい。
 本開示によれば、前回の作業パスによる地形の影響を抑えて、作業の品質、或いは作業効率を向上させることができる。
1   作業機械
13  作業機
26  コントローラ
31  位置センサ
C   目標変位データ
dz  目標変位
Ps1 第1開始位置
Ps2 第2開始位置
 

Claims (16)

  1.  作業機を含む作業機械を制御するためのシステムであって、
     前記作業機械の現在位置を検出するセンサと、
     前記センサと通信するコントローラと、
    を備え、
     前記コントローラは、
      前記作業機械の現在位置を示す現在位置データを取得し、
      現況地形を示す現況地形データを取得し、
      前記作業機械の移動量に応じた目標変位を規定するデフォルト目標変位データを取得し、
      前記作業機械による作業の前回の開始位置と、前記前回の開始位置よりも後方に位置する今回の開始位置との間の距離を示す作業間隔を取得し、
      前記作業間隔に応じて前記デフォルト目標変位データを修正した修正データを生成し、
      前記修正データを参照して、前記今回の開始位置からの前記作業機械の移動量に応じた前記目標変位を決定し、
      前記現況地形データを、前記目標変位だけ鉛直方向下向きに変位させた地形データを、目標プロファイルとして決定し、
      前記目標プロファイルに従って前記作業機を動作させる、
    システム。
  2.  前記コントローラは、前記作業間隔が所定の閾値を超えているときに、前記修正データを生成する、
    請求項1に記載のシステム。
  3.  前記コントローラは、前記作業間隔が第1閾値より小さいときに、前記修正データを生成する、
    請求項2に記載のシステム。
  4.  前記コントローラは、前記作業間隔が第2閾値より大きいときに、前記修正データを生成する、
    請求項2に記載のシステム。
  5.  前記コントローラは、
      オペレータによる前記作業機の操作装置の操作を示す信号を受信し、
      前記操作装置の操作に基づいて、前記前回の開始位置及び前記今回の開始位置を決定する、
    請求項1に記載のシステム。
  6.  前記コントローラは、
      前記作業機械による作業の第1開始位置を、前記前回の開始位置として取得し、
      前記第1開始位置からの前記作業機械の移動量を前記現在位置データから取得し、
      前記デフォルト目標変位データを参照して、前記第1開始位置からの前記移動量に応じた前記目標変位を第1目標変位として決定し、
      前記現況地形データを、前記第1目標変位だけ鉛直方向下向きに変位させた地形データを、第1目標プロファイルとして決定し、
      前記第1目標プロファイルに従って前記作業機を動作させ
      前記第1開始位置よりも後方に位置する第2開始位置を、前記今回の開始位置として取得し、
      前記第1開始位置と前記第2開始位置との間の距離を示す第1作業間隔に応じて前記デフォルト目標変位データを修正した前記修正データを生成し、
      前記第2開始位置からの前記作業機械の移動量を前記現在位置データから取得し、
      前記修正データを参照して、前記第2開始位置からの前記作業機械の移動量に応じた前記目標変位を第2目標変位として決定し、
      前記現況地形データを、前記第2目標変位だけ鉛直方向下向きに変位させた地形データを、第2目標プロファイルとして決定し、
      前記第2目標プロファイルに従って前記作業機を動作させる、
    請求項1に記載のシステム。
  7.  前記デフォルト目標変位データは、
      前記移動量の増大に応じて増大する前記目標変位を規定する掘削開始領域と、
      前記掘削開始領域の前方に位置し、前記移動量の増大に対して一定の前記目標変位を規定する掘削領域と、
     を含む、
    請求項6に記載のシステム。
  8.  前記コントローラは、前記第2開始位置からの移動量が前記作業間隔である位置を、前記修正データにおける前記掘削開始領域の終端位置とするように、前記デフォルト目標変位データを修正する、
    請求項7に記載のシステム。
  9.  前記コントローラは、
      前記作業間隔が第1閾値より小さいときには、前記第2開始位置からの移動量が前記作業間隔である位置を、前記修正データにおける前記掘削開始領域の終端位置とするように、前記デフォルト目標変位データを修正する、
    請求項7に記載のシステム。
  10.  前記第1閾値は、前記デフォルト目標変位データにおける前記掘削開始領域の終端までの前記移動量に基づき決定される値である、
    請求項9に記載のシステム。
  11.  前記コントローラは、
      前記作業間隔が第2閾値より大きいときには、前記第2開始位置からの移動量が前記作業間隔である位置を、前記修正データにおける前記掘削開始領域の終端位置とするように、前記デフォルト目標変位データを修正する、
    請求項7に記載のシステム。
  12.  前記第2閾値は、前記デフォルト目標変位データにおける前記掘削開始領域の終端までの前記移動量に基づき決定される値である、
    請求項11に記載のシステム。
  13.  前記コントローラは、
      前記作業間隔が第3閾値より大きいときには、前記デフォルト目標変位データを参照して、前記第2開始位置からの前記移動量に応じた前記目標変位を第2目標変位として決定し、
     前記第3閾値は、前記掘削領域の終端までの前記移動量に基づき決定される値である、
    請求項7に記載のシステム。
  14.  前記コントローラは、前記修正データによる掘削土量が、前記デフォルト目標変位データによる掘削土量と同じになるように、前記デフォルト目標変位データを修正する、
    請求項6に記載のシステム。
  15.  作業機を含む作業機械を制御するための方法であって、
     前記作業機械の現在位置を示す現在位置データを取得することと、
     現況地形を示す現況地形データを取得することと、
     前記作業機械の移動量に応じた目標変位を規定するデフォルト目標変位データを取得することと、
     前記作業機械による作業の前回の開始位置と、前記前回の開始位置よりも後方に位置する今回の開始位置との間の距離を示す作業間隔を取得することと、
     前記作業間隔に応じて前記デフォルト目標変位データを修正した修正データを生成することと、
     前記修正データを参照して、前記今回の開始位置からの前記作業機械の移動量に応じた前記目標変位を決定することと、
     前記現況地形データを、前記目標変位だけ鉛直方向下向きに変位データさせた地形を、目標プロファイルとして決定することと、
     前記目標プロファイルに従って前記作業機を動作させること、
    を備える方法。
  16.  作業機と、
     作業機械の現在位置を検出するセンサと、
     前記センサと通信するコントローラと、
    を備え、
     前記コントローラは、
      前記作業機械の現在位置を示す現在位置データを取得し、
      現況地形を示す現況地形データを取得し、
      前記作業機械の移動量に応じた目標変位を規定するデフォルト目標変位データを取得し、
      前記作業機械による作業の前回の開始位置と、前記前回の開始位置よりも後方に位置する今回の開始位置との間の距離を示す作業間隔を取得し、
      前記作業間隔に応じて前記デフォルト目標変位データを修正した修正データを生成し、
      前記修正データを参照して、前記今回の開始位置からの前記作業機械の移動量に応じた前記目標変位を決定し、
      前記現況地形データを、前記目標変位だけ鉛直方向下向きに変位させた地形データを、目標プロファイルとして決定し、
      前記目標プロファイルに従って前記作業機を動作させる、
    作業機械。
     
PCT/JP2021/048372 2021-02-01 2021-12-24 作業機械を制御するためのシステム、方法、および作業機械 WO2022163272A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
US18/250,832 US20230383495A1 (en) 2021-02-01 2021-12-24 System and method for controlling work machine, and work machine
AU2021424823A AU2021424823B2 (en) 2021-02-01 2021-12-24 System and method for controlling work machine, and work machine
CA3200424A CA3200424A1 (en) 2021-02-01 2021-12-24 System and method for controlling work machine, and work machine

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2021-014571 2021-02-01
JP2021014571A JP7482806B2 (ja) 2021-02-01 2021-02-01 作業機械を制御するためのシステム、方法、および作業機械

Publications (1)

Publication Number Publication Date
WO2022163272A1 true WO2022163272A1 (ja) 2022-08-04

Family

ID=82654535

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2021/048372 WO2022163272A1 (ja) 2021-02-01 2021-12-24 作業機械を制御するためのシステム、方法、および作業機械

Country Status (5)

Country Link
US (1) US20230383495A1 (ja)
JP (1) JP7482806B2 (ja)
AU (1) AU2021424823B2 (ja)
CA (1) CA3200424A1 (ja)
WO (1) WO2022163272A1 (ja)

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20160076223A1 (en) * 2014-09-12 2016-03-17 Caterpillar Inc. System and Method for Controlling the Operation of a Machine
JP2019105120A (ja) * 2017-12-14 2019-06-27 株式会社小松製作所 作業機械の制御システム、方法、及び作業機械
JP2019173470A (ja) * 2018-03-29 2019-10-10 株式会社小松製作所 作業車両の制御システム、方法、及び作業車両
JP2019214868A (ja) * 2018-06-12 2019-12-19 株式会社小松製作所 作業車両の制御システム、方法、及び作業車両
JP2020033789A (ja) * 2018-08-31 2020-03-05 株式会社神戸製鋼所 作業機械のブレード制御装置

Family Cites Families (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US9783955B1 (en) * 2016-11-09 2017-10-10 Caterpillar Inc. System and method for moving material

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
US20160076223A1 (en) * 2014-09-12 2016-03-17 Caterpillar Inc. System and Method for Controlling the Operation of a Machine
JP2019105120A (ja) * 2017-12-14 2019-06-27 株式会社小松製作所 作業機械の制御システム、方法、及び作業機械
JP2019173470A (ja) * 2018-03-29 2019-10-10 株式会社小松製作所 作業車両の制御システム、方法、及び作業車両
JP2019214868A (ja) * 2018-06-12 2019-12-19 株式会社小松製作所 作業車両の制御システム、方法、及び作業車両
JP2020033789A (ja) * 2018-08-31 2020-03-05 株式会社神戸製鋼所 作業機械のブレード制御装置

Also Published As

Publication number Publication date
CA3200424A1 (en) 2022-08-04
AU2021424823B2 (en) 2023-12-14
JP7482806B2 (ja) 2024-05-14
US20230383495A1 (en) 2023-11-30
AU2021424823A1 (en) 2023-06-22
JP2022117841A (ja) 2022-08-12

Similar Documents

Publication Publication Date Title
JP6873059B2 (ja) 作業車両の制御システム、作業機の軌跡設定方法、及び作業車両
JP6934427B2 (ja) 作業車両の制御システム、及び作業機の軌跡設定方法
CN111094657B (zh) 作业车辆的控制系统、方法以及作业车辆
JP6878317B2 (ja) 作業車両の制御システム、及び作業機の軌跡設定方法
CN110637131B (zh) 作业车辆的控制系统、方法以及作业车辆
JP2018021346A (ja) 作業車両の制御システム、制御方法、及び作業車両
AU2019246073B2 (en) Control system for work vehicle, method, and work vehicle
AU2019246074B2 (en) Control system for work vehicle, method, and work vehicle
JP2019039280A (ja) 作業車両の制御システム、方法、及び作業車両
CN111051616B (zh) 作业车辆的控制系统、方法以及作业车辆
WO2019044785A1 (ja) 作業車両の制御システム、方法、及び作業車両
WO2019239646A1 (ja) 作業車両の制御システム、方法、及び作業車両
JP7379281B2 (ja) 作業機械を制御するためのシステム、方法、および作業機械
WO2022163272A1 (ja) 作業機械を制御するためのシステム、方法、および作業機械

Legal Events

Date Code Title Description
121 Ep: the epo has been informed by wipo that ep was designated in this application

Ref document number: 21923275

Country of ref document: EP

Kind code of ref document: A1

WWE Wipo information: entry into national phase

Ref document number: 18250832

Country of ref document: US

ENP Entry into the national phase

Ref document number: 3200424

Country of ref document: CA

WWE Wipo information: entry into national phase

Ref document number: 2021424823

Country of ref document: AU

ENP Entry into the national phase

Ref document number: 2021424823

Country of ref document: AU

Date of ref document: 20211224

Kind code of ref document: A

NENP Non-entry into the national phase

Ref country code: DE

122 Ep: pct application non-entry in european phase

Ref document number: 21923275

Country of ref document: EP

Kind code of ref document: A1