WO2020044842A1 - 制御装置、積込機械、および制御方法 - Google Patents

制御装置、積込機械、および制御方法 Download PDF

Info

Publication number
WO2020044842A1
WO2020044842A1 PCT/JP2019/028342 JP2019028342W WO2020044842A1 WO 2020044842 A1 WO2020044842 A1 WO 2020044842A1 JP 2019028342 W JP2019028342 W JP 2019028342W WO 2020044842 A1 WO2020044842 A1 WO 2020044842A1
Authority
WO
WIPO (PCT)
Prior art keywords
revolving
unit
loading
depth
posture
Prior art date
Application number
PCT/JP2019/028342
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 CN201980047660.6A priority Critical patent/CN112424430B/zh
Priority to US16/973,635 priority patent/US20210246625A1/en
Priority to DE112019003165.1T priority patent/DE112019003165T5/de
Publication of WO2020044842A1 publication Critical patent/WO2020044842A1/ja

Links

Images

Classifications

    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26—Indicating devices
    • E02F9/264—Sensors and their calibration for indicating the position of the work tool
    • E02F9/265—Sensors and their calibration for indicating the position of the work tool with follow-up actions (e.g. control signals sent to actuate the work tool)
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/431—Control of dipper or bucket position; Control of sequence of drive operations for bucket-arms, front-end loaders, dumpers or the like
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F3/00—Dredgers; Soil-shifting machines
    • E02F3/04—Dredgers; Soil-shifting machines mechanically-driven
    • E02F3/28—Dredgers; Soil-shifting machines mechanically-driven with digging tools mounted on a dipper- or bucket-arm, i.e. there is either one arm or a pair of arms, e.g. dippers, buckets
    • E02F3/36—Component parts
    • E02F3/42—Drives for dippers, buckets, dipper-arms or bucket-arms
    • E02F3/43—Control of dipper or bucket position; Control of sequence of drive operations
    • E02F3/435—Control of dipper or bucket position; Control of sequence of drive operations for dipper-arms, backhoes or the like
    • E02F3/439—Automatic repositioning of the implement, e.g. automatic dumping, auto-return
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26—Indicating devices
    • E—FIXED CONSTRUCTIONS
    • E02—HYDRAULIC ENGINEERING; FOUNDATIONS; SOIL SHIFTING
    • E02F—DREDGING; SOIL-SHIFTING
    • E02F9/00—Component parts of dredgers or soil-shifting machines, not restricted to one of the kinds covered by groups E02F3/00 - E02F7/00
    • E02F9/26—Indicating devices
    • E02F9/261—Surveying the work-site to be treated
    • E02F9/262—Surveying the work-site to be treated with follow-up actions to control the work tool, e.g. controller

Definitions

  • the present invention relates to a control device, a loading machine, and a control method.
  • Priority is claimed on Japanese Patent Application No. 2018-163416 filed on August 31, 2018, the content of which is incorporated herein by reference.
  • Patent Document 1 discloses an autonomous control system for a loading machine that uses a sensor provided in the loading machine to measure the depth of the environment. According to the technology disclosed in Patent Literature 1, an obstacle is detected by a sensor provided on the left side of the revolving unit scanning an area on the movement path during the revolving unit is turning. Further, according to the technology disclosed in Patent Document 1, a sensor provided on the right side of the revolving unit scans the area of the excavating surface during the revolving unit to specify the terrain of the excavated surface. Generate data for planning the excavated part.
  • An object of the present invention is to provide a control device, a loading machine, and a control method that can accurately determine a target direction in turning control.
  • the control device includes: a revolving unit that can revolve around a revolving center; a work implement provided on the revolving unit; a posture measuring device that measures a posture of the revolving unit; A control device for controlling a loading machine provided on a body and including a depth detection device that detects at least a part of the depth of the periphery of the revolving structure in a detection range, wherein the posture measured by the posture measurement device is A posture information acquisition unit for acquiring posture information indicating the position, a detection information acquisition unit for acquiring depth information indicating a depth detected by the depth detection device, and the posture acquired when the revolving unit stops turning. A target azimuth determining unit that determines a target azimuth in the turning control based on the information and the depth information; and an output unit that outputs a turning operation signal based on the target azimuth.
  • control device can accurately determine the target direction in the turning control.
  • FIG. 3 is a top view illustrating an installation position of the depth detection device in the work machine according to the first embodiment.
  • FIG. 2 is a schematic block diagram illustrating a configuration of a control device according to the first embodiment. It is a figure showing the example of the course of the bucket before unloading in automatic excavation loading control concerning a 1st embodiment. It is a figure showing an example of a course of a bucket after unloading in automatic excavation loading control concerning a 1st embodiment. It is a flowchart which shows the automatic excavation loading control which concerns on 1st Embodiment. It is a flowchart which shows the automatic excavation loading control which concerns on 1st Embodiment. It is a flowchart which shows the automatic excavation loading control which concerns on 1st Embodiment. It is a flowchart which shows the automatic excavation loading control which concerns on 1st Embodiment.
  • FIG. 1 is a schematic diagram illustrating the configuration of the loading machine according to the first embodiment.
  • the loading machine 100 is a working machine that loads earth and sand to a loading point such as a transport vehicle.
  • the loading machine 100 according to the first embodiment is a hydraulic shovel.
  • the loading machine 100 according to another embodiment may be a loading machine other than a hydraulic shovel.
  • the loading machine 100 shown in FIG. 1 is a backhoe shovel, but may be a face shovel or a rope shovel.
  • the loading machine 100 includes a traveling body 110, a revolving body 120 supported by the traveling body 110, and a working machine 130 that is operated by hydraulic pressure and supported by the revolving body 120.
  • the revolving superstructure 120 is supported so as to be pivotable about the pivot center.
  • the work machine 130 includes a boom 131, an arm 132, a bucket 133, a boom cylinder 134, an arm cylinder 135, a bucket cylinder 136, a boom stroke sensor 137, an arm stroke sensor 138, and a bucket stroke sensor 139.
  • the base end of the boom 131 is attached to the swing body 120 via a pin.
  • the arm 132 connects the boom 131 and the bucket 133.
  • the proximal end of the arm 132 is attached to the distal end of the boom 131 via a pin.
  • the bucket 133 includes a blade for excavating earth and sand and the like and a container for transporting the excavated earth and sand.
  • the proximal end of the bucket 133 is attached to the distal end of the arm 132 via a pin.
  • the boom cylinder 134 is a hydraulic cylinder for operating the boom 131.
  • the base end of the boom cylinder 134 is attached to the swing body 120.
  • the tip of the boom cylinder 134 is attached to the boom 131.
  • the arm cylinder 135 is a hydraulic cylinder for driving the arm 132.
  • the base end of the arm cylinder 135 is attached to the boom 131.
  • the tip of the arm cylinder 135 is attached to the arm 132.
  • the bucket cylinder 136 is a hydraulic cylinder for driving the bucket 133.
  • the base end of the bucket cylinder 136 is attached to the arm 132.
  • the tip of the bucket cylinder 136 is attached to a link mechanism for rotating the bucket 133.
  • the boom stroke sensor 137 measures the stroke amount of the boom cylinder 134.
  • the stroke amount of the boom cylinder 134 can be converted into an inclination angle of the boom 131 with respect to the rotating body 120.
  • the inclination angle with respect to the rotating body 120 is also referred to as an absolute angle. That is, the stroke amount of the boom cylinder 134 can be converted into the absolute angle of the boom 131.
  • the arm stroke sensor 138 measures a stroke amount of the arm cylinder 135.
  • the stroke amount of the arm cylinder 135 can be converted into a tilt angle of the arm 132 with respect to the boom 131.
  • the inclination angle of the arm 132 with respect to the boom 131 is also referred to as a relative angle of the arm 132.
  • the bucket stroke sensor 139 measures the stroke amount of the bucket cylinder 136.
  • the stroke amount of the bucket cylinder 136 can be converted into an inclination angle of the bucket 133 with respect to the arm 132.
  • the inclination angle of the bucket 133 with respect to the arm 132 is also referred to as a relative angle of the bucket 133.
  • the loading machine 100 includes an angle sensor that detects an inclination angle with respect to the ground plane or an inclination angle with respect to the revolving unit 120, instead of the boom stroke sensor 137, the arm stroke sensor 138, and the bucket stroke sensor 139. May be provided.
  • An operator cab 121 is provided on the revolving superstructure 120. Inside the operator's cab 121, an operator's seat 122 for an operator to sit down and an operation device 123 for operating the loading machine 100 are provided.
  • the operating device 123 responds to the operation of the operator by raising and lowering the boom 131, pushing and pulling the arm 132, dumping and excavating the bucket 133, and turning the swivel body 120. Is generated and output to the control device 128.
  • the operating device 123 also generates a digging / loading instruction signal for causing the work implement 130 to start automatic digging / loading control according to the operation of the operator, and outputs the signal to the control device 128.
  • the automatic excavation loading control is that the revolving body 120 is revolved to load the earth and sand contained in the bucket 133 onto the loading object 200 (for example, a transport vehicle or a hopper), and the revolving body 120 is revolved to move the work machine to the excavation point.
  • This is a control for automatically executing a series of operations for moving 130 to excavate earth and sand at an excavation point.
  • the operation device 123 includes, for example, a lever, a switch, and a pedal.
  • the excavation loading instruction signal is generated by operating an automatic control switch. For example, when the switch is turned on, an excavation loading instruction signal is output.
  • the operation device 123 is arranged near the driver's seat 122.
  • the operation device 123 is located within an operable range of the operator when the operator sits on the driver's seat 122.
  • the loading machine 100 according to the first embodiment operates according to the operation of the operator sitting in the driver's seat 122, but is not limited to this in other embodiments.
  • the loading machine 100 according to another embodiment may be operated by transmitting an operation signal or an excavation loading instruction signal by a remote operation of an operator operating outside the loading machine 100.
  • the loading machine 100 includes a depth detecting device 124, a position and orientation calculator 125, a tilt measuring device 126, a hydraulic device 127, and a control device 128 for detecting a three-dimensional position of an object existing in the detection direction.
  • FIG. 2 is a top view illustrating an installation position of the depth detection device in the work machine according to the first embodiment.
  • the depth detection device 124 detects a depth in the detection range R.
  • the depth detection device 124 is provided on both side surfaces of the revolving unit 120, and detects the depth of at least a part of an object including a digging target in a detection range R around an axis extending in the width direction of the revolving unit 120. .
  • the depth is a distance from the depth detection device 124 to the target. Accordingly, when the loading machine 100 is excavating the earth and sand by the work implement 130, the depth detection device 124 can detect the depth of the loading target 200 located on the side of the loading machine 100.
  • the depth detection device 124 can detect the depth of the excavation target. That is, since the direction of the depth detection device 124 changes by the turning operation of the loading machine 100 in the excavation loading operation, the depth detection device 124 can detect the periphery of the loading machine 100 over a wide range. As shown in FIG. 2, the depth detection device 124 is provided at a position where the work implement 130 does not interfere with the detection range R. Examples of the depth detection device 124 include, for example, a LiDAR device, a radar device, and a stereo camera. Note that the depth detection device 124 is preferably provided at a high position of the revolving superstructure 120. Further, it is preferable that the central axis of the detection range R of the depth detection device 124 is inclined downward from the horizontal direction.
  • the position and orientation calculator 125 calculates the position of the revolving superstructure 120 and the direction in which the revolving superstructure 120 faces.
  • the position and orientation calculator 125 includes two receivers that receive positioning signals from artificial satellites that make up the GNSS. The two receivers are installed at different positions on the revolving superstructure 120, respectively.
  • the position and orientation calculator 125 detects the position of the representative point (the origin of the shovel coordinate system) of the revolving unit 120 in the site coordinate system based on the positioning signal received by the receiver. Using the positioning signals received by the two receivers, the position / azimuth calculator 125 calculates the azimuth of the revolving unit 120 as the relationship between the installation position of one receiver and the installation position of the other receiver.
  • the azimuth that the revolving unit 120 faces is the front direction of the revolving unit 120 and is equal to the horizontal component of the straight line extending from the boom 131 of the work implement 130 to the bucket 133.
  • the azimuth of the revolving unit 120 is an example of posture information.
  • the position and orientation calculator 125 is an example of a posture measurement device.
  • the tilt measuring device 126 measures the acceleration and angular velocity of the revolving unit 120, and detects the attitude (for example, the roll angle and the pitch angle) of the revolving unit 120 based on the measurement result.
  • the inclination measuring device 126 is installed on the lower surface of the revolving unit 120, for example.
  • an inertial measurement device IMU: Inertial Measurement Unit
  • the inclination measuring device 126 is an example of a posture measuring device.
  • the hydraulic device 127 includes a hydraulic oil tank, a hydraulic pump, and a flow control valve.
  • the hydraulic pump is driven by the power of an engine (not shown), and a traveling hydraulic motor (not shown) for traveling the traveling body 110 via a flow control valve, a swing hydraulic motor (not shown) for rotating the swing body 120, a boom cylinder 134, and an arm cylinder 135. , And the bucket cylinder 136.
  • the flow control valve has a rod-shaped spool, and adjusts the flow rate of hydraulic oil supplied to the traveling hydraulic motor, the swing hydraulic motor, the boom cylinder 134, the arm cylinder 135, and the bucket cylinder 136 according to the position of the spool.
  • the spool is driven based on a control command received from the control device 128.
  • the amount of hydraulic oil supplied to the traveling hydraulic motor, the turning hydraulic motor, the boom cylinder 134, the arm cylinder 135, and the bucket cylinder 136 is controlled by the control device 128.
  • the traveling hydraulic motor, the turning hydraulic motor, the boom cylinder 134, the arm cylinder 135, and the bucket cylinder 136 are driven by hydraulic oil supplied from the common hydraulic device 127.
  • the control device 128 may adjust the rotation speed based on the tilt angle of the swash plate.
  • the control device 128 receives an operation signal from the operation device 123.
  • Control device 128 drives work implement 130, revolving unit 120, or traveling unit 110 based on the received operation signal.
  • FIG. 3 is a schematic block diagram illustrating a configuration of the control device according to the first embodiment.
  • the control device 128 is a computer including a processor 1100, a main memory 1200, a storage 1300, and an interface 1400.
  • the storage 1300 stores a program.
  • the processor 1100 reads the program from the storage 1300, expands the program in the main memory 1200, and executes processing according to the program.
  • Examples of the storage 1300 include an HDD, SSD, magnetic disk, magneto-optical disk, CD-ROM, DVD-ROM, and the like.
  • the storage 1300 may be an internal medium directly connected to the common communication line of the control device 128 or an external medium connected to the control device 128 via the interface 1400.
  • the storage 1300 is a non-transitory tangible storage medium.
  • the processor 1100 executes the vehicle information acquisition unit 1101, the detection information acquisition unit 1102, the operation signal input unit 1103, the bucket position identification unit 1104, the map generation unit 1105, the loading target identification unit 1106, the loading position identification unit by executing the program. 1107, an avoidance position specifying unit 1108, a digging target specifying unit 1109, a digging position specifying unit 1110, a movement processing unit 1111, and an operation signal output unit 1112.
  • the vehicle information acquisition unit 1101 acquires, for example, the turning speed, the position, and the orientation of the revolving unit 120, the inclination angles of the boom 131, the arm 132, and the bucket 133, and the posture of the revolving unit 120.
  • vehicle information information on the loading machine 100 acquired by the vehicle information acquisition unit 1101 is referred to as vehicle information.
  • vehicle information acquisition unit is an example of a posture information acquisition unit.
  • the detection information acquisition unit 1102 acquires the depth information from the depth detection device 124.
  • the depth information indicates a three-dimensional position of a plurality of points in the detection range R.
  • Examples of the depth information include a depth image composed of a plurality of pixels representing the depth, and point cloud data composed of a plurality of points represented in a rectangular coordinate system (x, y, z).
  • the operation signal input unit 1103 receives an operation signal input from the operation device 123.
  • the operation signals include a raising operation signal and a lowering operation signal of the boom 131, a pushing operation signal and a pulling operation signal of the arm 132, a dump operation signal and an excavation operation signal of the bucket 133, a turning operation signal of the revolving unit 120, and a traveling of the traveling unit 110.
  • An operation signal and an excavation loading instruction signal of the loading machine 100 are included.
  • FIG. 4 is a diagram illustrating an example of a path of a bucket before discharging in the automatic excavation loading control according to the first embodiment.
  • the bucket position identification unit 1104 determines the position P of the tip of the arm 132 in the shovel coordinate system and the height from the tip of the arm 132 to the lowest passing point of the bucket 133. Hb is specified.
  • the lowermost passing point of the bucket 133 refers to a point where the cutting edge is located when the distance between the cutting edge and the ground surface becomes shortest during the dumping operation of the bucket 133.
  • the bucket position specifying unit 1104 specifies the position P of the distal end of the arm 132 when receiving the input of the excavation loading instruction signal as the excavation completion position P10. Since the proximal end of the bucket 133 is connected to the distal end of the arm 132, the position P of the distal end of the arm 132 is equal to the position of the proximal end of the bucket 133.
  • the bucket position specifying unit 1104 specifies the position P of the tip of the arm 132 in the following procedure.
  • the bucket position specifying unit 1104 calculates the boom based on the absolute angle of the boom 131 obtained from the stroke amount of the boom cylinder 134 and the known length of the boom 131 (the distance from the pin at the base end to the pin at the tip end).
  • the position of the tip of 131 is determined.
  • the bucket position specifying unit 1104 calculates the absolute angle of the arm 132 based on the absolute angle of the boom 131 and the relative angle of the arm 132 obtained from the stroke amount of the arm cylinder 135.
  • the bucket position specifying unit 1104 determines the position of the distal end of the boom 131, the absolute angle of the arm 132, and the known length of the arm 132 (the distance from the pin at the proximal end to the pin at the distal end). The position P of the tip of the arm 132 is obtained.
  • the map generation unit 1105 determines the on-site coordinates based on the position, orientation, and attitude of the revolving unit 120 acquired by the vehicle information acquisition unit 1101 when the revolving unit 120 is not turning, and the depth information acquired by the detection information acquisition unit 1102.
  • the system generates a three-dimensional map representing the shape of at least a part of the periphery of the loading machine 100.
  • the non-turning time is, specifically, a time when the loading machine 100 is performing an excavating operation or performing an unloading operation, and is not in a state where the turning speed is completely zero. And may move slightly in the turning direction.
  • the map generation unit 1105 may generate a three-dimensional map related to the shovel coordinate system based on the swing body 120.
  • the loading target specifying unit 1106 specifies the position and shape of the loading target 200 and the position of the loading point P21 based on the three-dimensional map generated by the map generating unit 1105.
  • the loading point P21 is, for example, a point on the vessel of the dump truck.
  • the loading target specifying unit 1106 specifies the position and the shape of the loading target 200 and the loading point P21 by matching the three-dimensional shape indicated by the three-dimensional map with the known shape of the loading target 200. I do.
  • the loading position specifying unit 1107 specifies the loading position P13 based on the loading point P21 specified by the loading target specifying unit 1106 when the excavation loading instruction signal is input to the operation signal input unit 1103. . Specifically, the loading position specifying unit 1107 specifies the loading position P13 as described below.
  • the loading position specifying unit 1107 specifies the specified loading point P21 as the plane position of the loading position P13. That is, when the tip of the arm 132 is located at the loading position P13, the tip of the arm 132 is located above the loading point P21. Examples of the loading point P21 include the center point of the vessel when the loading target 200 is a dump truck, and the center point of the opening when the loading target 200 is a hopper.
  • the loading position specifying unit 1107 includes, at the height Ht of the loading target 200, the height Hb from the tip of the arm 132 specified by the bucket position specifying unit 1104 to the lowest passing point of the bucket 133, and the control margin of the bucket 133. And the height of the loading position P13 is specified. In another embodiment, the loading position specifying unit 1107 may specify the loading position P13 without adding the height of the control margin. That is, the loading position specifying unit 1107 may specify the height of the loading position P13 by adding the height Hb to the height Ht.
  • the height Ht according to the first embodiment is a height from the ground to the upper surface of the vessel. That is, the loading position specifying unit 1107 determines the target orientation of the revolving unit 120 in the turning control by specifying the loading position P13.
  • the loading position specifying unit 1107 is an example of a target direction determining unit.
  • the avoidance position specifying unit 1108 includes the loading position P13 specified by the loading position specifying unit 1107, the position of the loading machine 100 obtained by the vehicle information obtaining unit 1101, and the loading target specified by the loading target specifying unit 1106. Based on the position and shape of 200, an interference avoiding position P12 at which work implement 130 and loading object 200 do not interfere in plan view from above is specified.
  • the interference avoiding position P12 has the same height as the loading position P13, and the distance from the turning center of the revolving unit 120 is equal to the distance from the turning center to the loading position P13, and the loading target is located below. 200 is a non-existent position.
  • the avoidance position specifying unit 1108 specifies, for example, a circle centered on the center of rotation of the revolving unit 120 and having a radius equal to the distance between the center of rotation and the loading position P13. A position where the outer shape does not interfere with the loading target 200 in plan view from above and is closest to the loading position P13 is specified as an interference avoidance position P12.
  • the avoidance position identification unit 1108 can determine whether or not the loading target 200 and the bucket 133 interfere with each other based on the position and shape of the loading target 200 and the known shape of the bucket 133.
  • “same height” and “distance is equal” are not necessarily limited to those in which the heights or distances are completely identical, and some errors and margins are allowed.
  • the excavation target specifying unit 1109 specifies the position of the excavation point P22 to be excavated based on the three-dimensional map generated by the map generation unit 1105.
  • the excavation point P22 is a point at which an amount of earth and sand equivalent to the maximum capacity of the bucket 133 can be excavated by moving the cutting edge of the bucket 133 from that point in the excavation direction of the arm 132 and the bucket 133, for example.
  • the excavation target specifying unit 1109 specifies the distribution of the earth and sand to be excavated from the three-dimensional shape indicated by the three-dimensional map, and specifies the excavation point P22 based on the distribution.
  • FIG. 5 is a diagram illustrating an example of a bucket path after discharging in the automatic excavation loading control according to the first embodiment.
  • the digging position specifying unit 1110 specifies, as the digging position P19, a point separated from the digging point P22 specified by the digging target specifying unit 1109 by a distance from the base end of the bucket 133 to the cutting edge. That is, when the bucket 133 is in a predetermined digging posture with the cutting edge directed in the dumping direction, and when the cutting edge of the bucket 133 is located at the digging point P22, the tip of the arm 132 is located at the digging position P19. Become. That is, the digging position specifying unit 1110 determines the target azimuth of the revolving unit 120 in the turning control by specifying the digging position P19.
  • the excavation position identification unit 1110 is an example of a target direction determination unit.
  • the movement processing unit 1111 When the operation signal input unit 1103 receives the input of the excavation loading instruction signal, the movement processing unit 1111 performs the loading position P13 specified by the loading position specifying unit 1107 and the interference avoiding position specified by the avoiding position specifying unit 1108. Based on P12, a rotation operation signal for moving the bucket 133 to the loading position P13 is generated. That is, the movement processing unit 1111 generates a rotation operation signal so as to reach the loading position P13 from the excavation completion position P10 via the turning start position P11 and the interference avoidance position P12. Further, the movement processing unit 1111 generates a rotation operation signal of the bucket 133 so that the ground angle of the bucket 133 does not change even when the boom 131 and the arm 132 are driven.
  • the movement processing unit 1111 When the bucket 133 reaches the loading position P13, the movement processing unit 1111 generates a dump operation signal for rotating the bucket 133 in the dump direction.
  • the movement processing unit 1111 outputs a rotation operation signal for moving the bucket 133 to the digging position P19 based on the digging position P19 specified by the digging position specifying unit 1110 and the interference avoiding position P12 specified by the avoiding position specifying unit 1108.
  • the movement processing unit 1111 generates a rotation operation signal so as to reach the excavation position P19 from the loading position P13 via the interference avoiding position P12 and the turning end position P18.
  • the movement processing unit 1111 generates a bucket rotation operation signal so that the bucket is in the digging posture.
  • the operation signal generated by the movement processing unit 1111 is a signal that instructs driving with a drive amount related to the operation signal input to the operation signal input unit 1103 when the lever or pedal of the operation device 123 is operated with the maximum operation amount. It is.
  • the drive amount is, for example, the amount of hydraulic oil or the opening of the spool.
  • the operation signal generated by the movement processing unit 1111 may be a signal instructing driving with a driving amount larger than the driving amount related to the maximum operation amount. This is because, in the loading machine 100 related to manned driving, the maximum operation amount of the operating device 123 is limited due to the ride comfort of the operator, whereas the loading machine 100 related to the remote operation is limited due to the ride comfort of the operator. Because there is no.
  • the operation signal output unit 1112 outputs the operation signal input to the operation signal input unit 1103 or the operation signal generated by the movement processing unit 1111. Specifically, the operation signal output unit 1112 outputs an operation signal related to the automatic control generated by the movement processing unit 1111 when the automatic digging and loading control is being performed, and when the automatic digging and loading control is not being performed, An operation signal related to the manual operation of the operator input to the operation signal input unit 1103 is output.
  • FIGS. 6 to 8 are flowcharts showing the automatic excavation loading control according to the first embodiment.
  • control device 128 executes the automatic excavation loading control shown in FIGS. 6 to 8.
  • the cutting edge of the bucket 133 is located at the excavation point, and the loading target 200 is located on the side of the revolving unit 120.
  • the vehicle information acquisition unit 1101 acquires the position and orientation of the swing body 120, the inclination angles of the boom 131, the arm 132, and the bucket 133, and the attitude of the swing body 120 (Step S1).
  • the vehicle information acquisition unit 1101 specifies the position of the center of rotation of the revolving unit 120 based on the acquired position and orientation of the revolving unit 120 (step S2).
  • the detection information acquisition unit 1102 acquires depth information indicating the depth around the loading machine 100 from the depth detection device 124 (Step S3).
  • the depth detection device 124 is provided on the side surface of the revolving superstructure 120, and the loading target 200 is located on the side of the revolving superstructure 120. Therefore, the detection range R of the depth detection device 124 includes the loading target 200.
  • the map generation unit 1105 uses the site coordinate system of the loading machine 100 based on the position, orientation, and orientation of the revolving unit 120 acquired by the vehicle information acquisition unit 1101 and the depth information acquired by the detection information acquisition unit 1102. A three-dimensional map representing at least a part of the surroundings is generated (Step S4).
  • the loading target specifying unit 1106 specifies the position and shape of the loading target 200 and the loading point P21 based on the generated map information (Step S5).
  • the bucket position identification unit 1104 determines the position P of the tip of the arm 132 when the excavation loading instruction signal is input, and the bottom of the bucket 133 from the tip of the arm 132.
  • the height Hb up to the passing point is specified (step S6).
  • the bucket position specifying unit 1104 specifies the position P as the excavation completion position P10.
  • the loading position specifying unit 1107 specifies the plane position of the loading position P13 based on the position of the loading point P21 specified by the loading target specifying unit 1106 (Step S7). At this time, the loading position specifying unit 1107 controls the height Ht of the loading target 200, the height Hb from the tip of the arm 132 specified in step S5 to the lowest passing point of the bucket 133, and the control of the bucket 133. The height of the loading position P13 is specified by adding the extra height (step S8).
  • the avoidance position specifying unit 1108 specifies a plane distance from the turning center of the revolving unit 120 to the loading position (step S9).
  • the avoidance position specifying unit 1108 is a position that is separated from the turning center by the specified plane distance, and the outer shape of the bucket 133 does not interfere with the loading target 200 in plan view, and the position closest to the loading position P13 is It is specified as the interference avoidance position P12 (step S10).
  • the revolving superstructure 120 is not revolving from step S1 to step S9.
  • the movement processing unit 1111 determines whether the position P of the tip of the arm 132 has reached the loading position P13 (Step S11). If the position P of the tip of the arm 132 has not reached the loading position P13 (step S11: NO), the movement processing unit 1111 determines whether the position P of the tip of the arm 132 is near the interference avoidance position P12. Is determined (step S12). For example, the movement processing unit 1111 determines that the difference between the height of the tip of the arm 132 and the height of the interference avoidance position P12 is less than a predetermined threshold value, or the plane distance from the center of rotation of the revolving unit 120 to the tip of the arm 132 and the rotation.
  • step S12 It is determined whether or not the difference from the plane distance from the center to the interference avoidance position P12 is smaller than a predetermined threshold (step S12). If the position P of the tip of the arm 132 is not near the interference avoiding position P12 (step S12: NO), the movement processing unit 1111 generates an operation signal for raising the boom 131 and the arm 132 to the height of the interference avoiding position P12. (Step S13). At this time, the movement processing unit 1111 generates an operation signal based on the positions and speeds of the boom 131 and the arm 132.
  • the movement processing unit 1111 calculates the sum of the angular velocities of the boom 131 and the arm 132 based on the generated operation signals of the boom 131 and the arm 132, and outputs an operation signal for rotating the bucket 133 at the same speed as the sum of the angular velocities. It is generated (step S14). Thereby, the movement processing unit 1111 can generate an operation signal that holds the ground angle of the bucket 133. In another embodiment, the movement processing unit 1111 determines that the ground angle of the bucket 133 calculated from the detection values of the boom stroke sensor 137, the arm stroke sensor 138, and the bucket stroke sensor 139 is the ground angle at the start of the automatic control. An operation signal for rotating the bucket 133 so as to be equal to may be generated.
  • step S12 If the position P of the tip of the arm 132 is near the interference avoiding position P12 (step S12: YES), the movement processing unit 1111 does not generate operation signals for the boom 131, the arm 132, and the bucket 133. That is, when the position P of the distal end of the arm 132 is near the interference avoidance position P12, the movement processing unit 1111 prohibits the output of the operation signal of the work implement 130 for moving the work implement 130 to the loading point. .
  • the movement processing unit 1111 determines whether or not the turning speed of the revolving unit 120 is lower than a predetermined speed based on the vehicle information acquired by the vehicle information acquiring unit 1101 (Step S15). That is, the movement processing unit 1111 determines whether or not the rotating body 120 is rotating. When the swing speed of the swing body 120 is lower than the predetermined speed (step S15: YES), the movement processing unit 1111 moves the height of the bucket 133 from the height of the excavation completion position P10 to the height of the interference avoidance position P12. Is specified (step S16).
  • the movement processing unit 1111 When outputting the turning operation signal from the current time based on the rising time of the bucket 133, the movement processing unit 1111 passes the tip of the arm 132 through the interference avoiding position P12 or a point higher than the interference avoiding position P12. It is determined whether or not (step S17).
  • the turning operation signal is output from the current time, when the tip of the arm 132 passes through the interference avoiding position P12 or a point higher than the interference avoiding position P12 (Step S17: YES), the movement processing unit 1111 turns. An operation signal is generated (Step S18).
  • step S17 NO
  • the movement processing unit 1111 does not generate the turning operation signal. . That is, when the tip of the arm 132 passes through a point lower than the interference avoidance position P12, the movement processing unit 1111 prohibits the output of the turning operation signal.
  • step S15 When the swing speed of the swing body 120 is equal to or higher than the predetermined speed (step S15: NO), the movement processing unit 1111 moves the tip of the arm 132 to the loading position P13 when the output of the swing operation signal is stopped from the current time. It is determined whether or not to reach (step S19). After the output of the swing operation signal is stopped, the swing body 120 continues to swing by inertia while decelerating, and then stops. When the output of the turning operation signal is stopped from the current time and the tip of the arm 132 reaches the loading position P13 (Step S19: YES), the movement processing unit 1111 does not generate the turning operation signal.
  • step S19 when the output of the turning operation signal is stopped from the current time and the tip of the arm 132 reaches the loading position P13, the movement processing unit 1111 prohibits the output of the turning operation signal. Thereby, the revolving superstructure 120 starts to decelerate.
  • step S19: NO when the output of the turning operation signal is stopped from the current time and the tip of the arm 132 stops before the loading position P13 (step S19: NO), the movement processing unit 1111 outputs the turning operation signal. Is generated (step S20).
  • the operation signal output unit 1112 When at least one of the rotation operation signal of the boom 131, the arm 132, and the bucket 133 and the rotation operation signal of the revolving unit 120 is generated in the processing from step S11 to step S20, the operation signal output unit 1112 outputs the generated operation. A signal is output to the hydraulic device 127 (Step S21).
  • Step S22 vehicle information acquisition unit 1101 acquires vehicle information.
  • vehicle information acquisition section 1101 can acquire the vehicle information after the operation based on the output operation signal.
  • Control device 128 returns the process to step S11, and repeatedly executes the generation of the operation signal.
  • step S11 when the position P of the distal end of the arm 132 reaches the loading position P13 (step S11: YES), the movement processing unit 1111 generates a dump operation signal, and the operation signal output unit 1112 Then, a dump operation signal is output to the hydraulic device 127 (Step S23).
  • the earth and sand stored in the bucket 133 is loaded on the loading target 200.
  • the position P of the distal end of the arm 132 reaches the loading position P13, the swing of the swing body 120 has stopped. Further, the bucket 133 takes a predetermined excavation posture by rotating in the dumping direction.
  • the vehicle information acquisition unit 1101 acquires the position and orientation of the revolving unit 120, the inclination angles of the boom 131, the arm 132, and the bucket 133, and the posture of the revolving unit 120 (Step S24).
  • the detection information acquisition unit 1102 acquires, from the depth detection device 124, depth information indicating at least a part of the depth around the loading machine 100 (Step S25). Since the depth detection device 124 is provided on the side surface of the revolving unit 120 and the excavation target is located on the side of the revolving unit 120, the detection range R of the depth detection device 124 includes the excavation target.
  • the map generation unit 1105 uses the site coordinate system of the loading machine 100 based on the position, orientation, and orientation of the revolving unit 120 acquired by the vehicle information acquisition unit 1101 and the depth information acquired by the detection information acquisition unit 1102.
  • a three-dimensional map representing at least a part of the shape of the surroundings is generated (Step S26).
  • the digging target specifying unit 1109 specifies the digging point P22 based on the generated three-dimensional map (Step S25).
  • the digging position specifying unit 1110 specifies the digging position P19 based on the position of the digging point P22 specified by the digging target specifying unit 1109 (Step S28).
  • the movement processing unit 1111 determines whether the position P of the tip of the arm 132 has reached the excavation position P19 (step S29). When the position P of the tip of the arm 132 has not reached the excavation position P19 (step S29: NO), the movement processing unit 1111 determines whether the position P of the tip of the arm 132 has passed the interference avoidance position P12. (Step S30). When the position P of the tip of the arm 132 does not pass through the interference avoiding position P12 (step S30: NO), the movement processing unit 1111 does not generate operation signals for the boom 131, the arm 132, and the bucket 133. That is, when the position P of the distal end portion of the arm 132 does not pass through the interference avoidance position P12, the movement processing unit 1111 prohibits the output of the operation signal of the work machine 130 for moving the work machine 130 to the excavation point. .
  • step S30 when the position P of the tip of the arm 132 has passed the interference avoiding position P12 (step S30: YES), the movement processing unit 1111 moves the boom 131 and the arm 132 to lower the position P of the tip of the arm 132. Is generated (step S31).
  • the movement processing unit 1111 determines whether the plane position of the tip of the arm 132 reaches the excavation position P19 (step S32).
  • the movement processing unit 1111 generates a turning operation signal (Step S32). S33).
  • step S32 when the output of the turning operation signal is stopped from the current time and the plane position of the tip of the arm 132 reaches the excavation position P19 (step S32: YES), the movement processing unit 1111 does not generate the turning operation signal. . That is, when the output of the turning operation signal is stopped from the current time and the plane position of the tip of the arm 132 reaches the excavation position P19, the movement processing unit 1111 prohibits the output of the turning operation signal. Thereby, the revolving superstructure 120 starts to decelerate.
  • the operation signal output unit 1112 outputs the generated operation signal to the hydraulic device 127. (Step S34).
  • Step S35 vehicle information acquisition section 1101 can acquire the vehicle information after the operation based on the output operation signal.
  • Control device 128 returns the process to step S29, and repeatedly executes the generation of the operation signal.
  • step S29 YES
  • the movement processing unit 1111 generates an excavation operation signal
  • the operation signal output unit 1112 outputs An excavation operation signal is output to the hydraulic device 127 (Step S36).
  • the cutting edge of the bucket 133 moves to the excavation completion position P10, and the bucket 133 stores the earth and sand.
  • the control device 128 ends the automatic excavation loading control.
  • the control device 128 returns the process to step S11, and repeatedly executes automatic loading and automatic excavation within a range where the loading amount of the loading target 200 does not exceed the maximum loading amount.
  • the loading machine 100 can load the earth and the sand scooped by the bucket 133 into the loading target 200 and further scoop the next earth and sand.
  • the operator repeatedly executes the automatic digging and loading control based on the input of the digging and loading instruction signal so that the loading amount of the loading target 200 does not exceed the maximum loading amount.
  • the control device 128 of the loading machine 100 determines the target azimuth based on the posture information and the depth information acquired when the swing body 120 is not turning. By acquiring the posture information and the depth information when the revolving superstructure 120 is not turning, it is possible to suppress an error in the posture information when acquiring the depth information. Therefore, the control device 128 according to the first embodiment can accurately determine the target direction in the turning control.
  • the target azimuth according to the first embodiment is a azimuth facing the loading position P13, which is the target azimuth in the cargo turn, and a azimuth facing the excavation position P19, which is the target azimuth in the empty turn.
  • the control device 128 according to another embodiment may determine one of the target direction in the cargo turn and the target direction in the empty turn. In this case, the depth detection device 124 may be provided on only one of the two side portions of the revolving unit 120.
  • the working machine 130 according to the first embodiment is provided at a front part of the revolving unit 120, and the depth detection device 124 is provided at a side part of the revolving unit 120.
  • the depth detection device 124 can measure the depth of the excavation target.
  • the depth detection device 124 can measure the depth of the loading target 200.
  • the depth detection device 124 according to the first embodiment is installed so that the work implement 130 is not included in the detection range R. Thereby, the control device 128 can specify the loading point P21 and the excavation point P22 without performing a process of excluding the range including the work implement 130 from the depth information.
  • the control device 128 according to the first embodiment specifies the loading point P21 and the excavation point P22 using the depth information, but is not limited thereto.
  • the control device 128 according to another embodiment may specify only one of the loading point P21 and the excavation point P22 using the depth information. That is, the control device 128 according to the first embodiment performs automatic excavation loading control, but is not limited thereto.
  • the control device 128 according to another embodiment performs automatic loading control, and the excavation operation may be performed by a manual operation of an operator.
  • control device 128 may perform automatic excavation control, and the loading operation may be performed by a manual operation of an operator. Further, the control device 128 according to the first embodiment specifies the excavation point P22 and executes the excavation operation after the turning operation to the excavation point P22, but is not limited thereto. The operation up to the operation may be executed to end the automatic excavation loading control.
  • the control device 128 specifies the loading point P21 by using the posture information and the depth information acquired after the excavation operation and before the turn of the load, but is not limited thereto.
  • the control device 128 determines the loading point P21 using the posture information and the depth information acquired after the unloading operation and before the excavation operation, or the posture information and the depth information acquired during the excavation operation. It may be specified. In any case, the posture information and the depth information are obtained when the revolving body 120 is not turning, or even if it is turning slightly.
  • the control device 128 specifies the excavation point P22 using the posture information and the depth information acquired after the dump operation and before the unloading turn, but is not limited thereto.
  • the control device 128 according to another embodiment may specify the excavation point P22 by using the attitude information and the depth information acquired after the load is turned and before the dump operation or after the load is turned and during the dump operation.
  • the posture information and the depth information are obtained when the revolving body 120 is not turning, or even if it is turning slightly.
  • the detection range R of the depth detection device 124 is centered on an axis extending in the width direction of the revolving unit 120, but is not limited thereto.
  • the depth detection device 124 may be provided so that the angle formed by the front direction of the revolving unit 120 and the central axis of the detection range R substantially matches the average turning angle or the target turning angle in the excavation loading cycle. .
  • the loading machine 100 includes the bucket 133, but is not limited thereto.
  • the loading machine 100 according to another embodiment may include a clam bucket having a backall and a clamshell that can be opened and closed.
  • the loading machine 100 according to the first embodiment is a manned vehicle that is operated by an operator on board, but is not limited thereto.
  • the loading machine 100 according to another embodiment is a remotely driven vehicle that is operated by an operation signal obtained by communication from a remote operation device operated by an operator at a remote office while looking at the screen of a monitor. Is also good.
  • some functions of the control device 128 may be provided in the remote control device.
  • the control device can accurately determine the target direction in the turning control.

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)
  • Component Parts Of Construction Machinery (AREA)

Abstract

本発明に係る制御装置において、姿勢情報取得部は、姿勢計測装置が計測した姿勢を示す姿勢情報を取得する。検出情報取得部は、深度検出装置が検出した深度を示す深度情報を取得する。目標方位決定部は、旋回体が旋回していないときに取得された姿勢情報および深度情報に基づいて、旋回制御における目標方位を決定する。出力部は、目標方位に基づいて旋回操作信号を出力する。

Description

制御装置、積込機械、および制御方法
　本発明は、制御装置、積込機械、および制御方法に関する。
　本願は、２０１８年８月３１日に日本に出願された特願２０１８－１６３４１６号について優先権を主張し、その内容をここに援用する。
　特許文献１には、積込機械に設けられた環境の深度を計測するセンサを用いた積込機械の自律制御システムが開示されている。特許文献１に開示された技術によれば、旋回体の旋回中に、旋回体の左側に設けられたセンサが移動経路上の領域を走査することで、障害物を検出する。また特許文献１に開示された技術によれば、旋回体の旋回中に、旋回体の右側に設けられたセンサが掘削面の領域を走査することで、掘削面の地形を特定し、次の掘削部分を計画するためのデータを生成する。
特開２０００－１３６５４９号公報
　ところで、センサによって計測された深度データを用いて地形を特定するためには、積込機械の位置情報および旋回角度などの計測データを用いて、データを変換する必要がある。しかしながら、旋回体の旋回中は、計測データを得るための計測装置の位置および方位が変化するため、計測データに含まれる誤差が大きく、地形を精度よく検出することができない可能性がある。地形を精度よく検出することができない場合、旋回制御における目標方位を精度よく決定することができない。
　本発明の目的は、旋回制御における目標方位を精度よく決定することができる制御装置、積込機械、および制御方法を提供することにある。
　本発明の一態様によれば、制御装置は、旋回中心回りに旋回可能な旋回体と、前記旋回体に設けられた作業機と、前記旋回体の姿勢を計測する姿勢計測装置と、前記旋回体に設けられ、検出範囲における前記旋回体の周囲のうち少なくとも一部の深度を検出する深度検出装置とを備える積込機械を制御する制御装置であって、前記姿勢計測装置が計測した姿勢を示す姿勢情報を取得する姿勢情報取得部と、前記深度検出装置が検出した深度を示す深度情報を取得する検出情報取得部と、前記旋回体が旋回を停止しているときに取得された前記姿勢情報および前記深度情報に基づいて、旋回制御における目標方位を決定する目標方位決定部と、前記目標方位に基づいて旋回操作信号を出力する出力部とを備える。
　上記態様によれば、制御装置は、旋回制御における目標方位を精度よく決定することができる。
第１の実施形態に係る積込機械の構成を示す概略図である。 第１の実施形態に係る作業機械における深度検出装置の設置位置を示す上面図である。 第１の実施形態に係る制御装置の構成を示す概略ブロック図である。 第１の実施形態に係る自動掘削積込制御における排土前のバケットの経路の例を示す図である。 第１の実施形態に係る自動掘削積込制御における排土後のバケットの経路の例を示す図である。 第１の実施形態に係る自動掘削積込制御を示すフローチャートである。 第１の実施形態に係る自動掘削積込制御を示すフローチャートである。 第１の実施形態に係る自動掘削積込制御を示すフローチャートである。
　以下、図面を参照しながら実施形態について詳しく説明する。
〈第１の実施形態〉
《積込機械の構成》
　図１は、第１の実施形態に係る積込機械の構成を示す概略図である。
　積込機械１００は、土砂を運搬車両などの積込点へ積込を行う作業機械である。第１の実施形態に係る積込機械１００は、油圧ショベルである。なお、他の実施形態に係る積込機械１００は、油圧ショベル以外の積込機械であってもよい。また図１に示す積込機械１００はバックホウショベルであるが、フェイスショベルやロープショベルであってもよい。
　積込機械１００は、走行体１１０と、走行体１１０に支持される旋回体１２０と、油圧により作動し旋回体１２０に支持される作業機１３０とを備える。旋回体１２０は、旋回中心回りに旋回自在に支持される。
　作業機１３０は、ブーム１３１と、アーム１３２と、バケット１３３と、ブームシリンダ１３４と、アームシリンダ１３５と、バケットシリンダ１３６と、ブームストロークセンサ１３７と、アームストロークセンサ１３８と、バケットストロークセンサ１３９とを備える。
　ブーム１３１の基端部は、旋回体１２０にピンを介して取り付けられる。
　アーム１３２は、ブーム１３１とバケット１３３とを連結する。アーム１３２の基端部は、ブーム１３１の先端部にピンを介して取り付けられる。
　バケット１３３は、土砂などを掘削するための刃と掘削した土砂を搬送するための容器とを備える。バケット１３３の基端部は、アーム１３２の先端部にピンを介して取り付けられる。
　ブームシリンダ１３４は、ブーム１３１を作動させるための油圧シリンダである。ブームシリンダ１３４の基端部は、旋回体１２０に取り付けられる。ブームシリンダ１３４の先端部は、ブーム１３１に取り付けられる。
　アームシリンダ１３５は、アーム１３２を駆動するための油圧シリンダである。アームシリンダ１３５の基端部は、ブーム１３１に取り付けられる。アームシリンダ１３５の先端部は、アーム１３２に取り付けられる。
　バケットシリンダ１３６は、バケット１３３を駆動するための油圧シリンダである。バケットシリンダ１３６の基端部は、アーム１３２に取り付けられる。バケットシリンダ１３６の先端部は、バケット１３３を回動させるリンク機構に取り付けられる。
　ブームストロークセンサ１３７は、ブームシリンダ１３４のストローク量を計測する。ブームシリンダ１３４のストローク量は、旋回体１２０に対するブーム１３１の傾斜角に換算可能である。以下、旋回体１２０に対する傾斜角を、絶対角度ともいう。つまり、ブームシリンダ１３４のストローク量は、ブーム１３１の絶対角度に換算可能である。
　アームストロークセンサ１３８は、アームシリンダ１３５のストローク量を計測する。アームシリンダ１３５のストローク量は、ブーム１３１に対するアーム１３２の傾斜角に換算可能である。以下、ブーム１３１に対するアーム１３２の傾斜角を、アーム１３２の相対角度ともいう。
　バケットストロークセンサ１３９は、バケットシリンダ１３６のストローク量を計測する。バケットシリンダ１３６のストローク量は、アーム１３２に対するバケット１３３の傾斜角に換算可能である。以下、アーム１３２に対するバケット１３３の傾斜角をバケット１３３の相対角度ともいう。
　なお、他の実施形態に係る積込機械１００は、ブームストロークセンサ１３７、アームストロークセンサ１３８、およびバケットストロークセンサ１３９に代えて、地平面に対する傾斜角または旋回体１２０に対する傾斜角を検出する角度センサを備えてもよい。
　旋回体１２０には、運転室１２１が設けられる。運転室１２１の内部には、オペレータが着座するための運転席１２２、積込機械１００を操作するための操作装置１２３が設けられる。操作装置１２３は、オペレータの操作に応じて、ブーム１３１の上げ操作信号および下げ操作信号、アーム１３２の押し操作信号および引き操作信号、バケット１３３のダンプ操作信号および掘削操作信号、旋回体１２０の左右への旋回操作信号を生成し、制御装置１２８に出力する。また操作装置１２３は、オペレータの操作に応じて作業機１３０に自動掘削積込制御を開始させるための掘削積込指示信号を生成し、制御装置１２８に出力する。自動掘削積込制御とは、旋回体１２０を旋回させてバケット１３３に収容された土砂を積込対象２００（例えば、運搬車両やホッパ）へ積み込み、旋回体１２０を旋回させて掘削点へ作業機１３０を移動させ、掘削点の土砂を掘削する一連の動作を自動的に実行する制御である。
　操作装置１２３は、例えばレバー、スイッチおよびペダルにより構成される。掘削積込指示信号は自動制御用のスイッチの操作により生成される。例えば、スイッチがＯＮになったときに、掘削積込指示信号が出力される。操作装置１２３は、運転席１２２の近傍に配置される。操作装置１２３は、オペレータが運転席１２２に座ったときにオペレータの操作可能な範囲内に位置する。
　なお、第１の実施形態に係る積込機械１００は、運転席１２２に着座するオペレータの操作に従って動作するが、他の実施形態においてはこれに限られない。例えば、他の実施形態に係る積込機械１００は、積込機械１００の外部で操作するオペレータの遠隔操作によって操作信号や掘削積込指示信号が送信され動作するものであってもよい。
　積込機械１００は、検出方向に存在する対象物の３次元位置を検出するための深度検出装置１２４、位置方位演算器１２５、傾斜計測器１２６、油圧装置１２７、制御装置１２８を備える。
　図２は、第１の実施形態に係る作業機械における深度検出装置の設置位置を示す上面図である。
　深度検出装置１２４は、検出範囲Ｒにおける深度を検出する。深度検出装置１２４は、旋回体１２０の両側面に設けられ、旋回体１２０の幅方向に伸びる軸を中心とする検出範囲Ｒにおいて掘削対象を含む周囲のうち少なくとも一部の物体の深度を検出する。深度とは、深度検出装置１２４から対象までの距離である。これにより、積込機械１００が作業機１３０によって土砂を掘削しているときに、深度検出装置１２４は、積込機械１００の側方に位置する積込対象２００の深度を検出することができる。また、積込機械１００が旋回動作により旋回体１２０の向く方位を変えて、土砂を積込対象２００に積み込んでいるときに、深度検出装置１２４は、掘削対象の深度を検出することができる。つまり、掘削積込作業において積込機械１００が旋回動作することにより、深度検出装置１２４の向きが変化するため、深度検出装置１２４は、積込機械１００の周囲を広範囲にわたって検出することができる。
　図２に示すように、深度検出装置１２４は、その検出範囲Ｒに作業機１３０が干渉しない位置に設けられる。深度検出装置１２４の例としては、例えば、ＬｉＤＡＲ装置、レーダ装置、ステレオカメラなどが挙げられる。なお、深度検出装置１２４は、旋回体１２０の高い位置に設けられることが好ましい。また深度検出装置１２４の検出範囲Ｒの中心軸は、水平方向より下方に傾いていることが好ましい。
　位置方位演算器１２５は、旋回体１２０の位置および旋回体１２０が向く方位を演算する。位置方位演算器１２５は、ＧＮＳＳを構成する人工衛星から測位信号を受信する２つの受信器を備える。２つの受信器は、それぞれ旋回体１２０の異なる位置に設置される。位置方位演算器１２５は、受信器が受信した測位信号に基づいて、現場座標系における旋回体１２０の代表点（ショベル座標系の原点）の位置を検出する。
　位置方位演算器１２５は、２つの受信器が受信した各測位信号を用いて、一方の受信器の設置位置に対する他方の受信器の設置位置の関係として、旋回体１２０の向く方位を演算する。旋回体１２０が向く方位とは、旋回体１２０の正面方向であって、作業機１３０のブーム１３１からバケット１３３へ伸びる直線の延在方向の水平成分に等しい。旋回体１２０の方位は、姿勢情報の一例である。位置方位演算器１２５は、姿勢計測装置の一例である。
　傾斜計測器１２６は、旋回体１２０の加速度および角速度を計測し、計測結果に基づいて旋回体１２０の姿勢（例えば、ロール角およびピッチ角）を検出する。傾斜計測器１２６は、例えば旋回体１２０の下面に設置される。傾斜計測器１２６は、例えば、慣性計測装置（ＩＭＵ：Inertial Measurement Unit）を用いることができる。傾斜計測器１２６は、姿勢計測装置の一例である。
　油圧装置１２７は、作動油タンク、油圧ポンプ、および流量制御弁を備える。油圧ポンプは、図示しないエンジンの動力で駆動し、流量制御弁を介して走行体１１０を走行させる図示しない走行油圧モータ、旋回体１２０を旋回させる図示しない旋回油圧モータ、ブームシリンダ１３４、アームシリンダ１３５、およびバケットシリンダ１３６に作動油を供給する。流量制御弁はロッド状のスプールを有し、スプールの位置によって走行油圧モータ、旋回油圧モータ、ブームシリンダ１３４、アームシリンダ１３５、およびバケットシリンダ１３６に供給する作動油の流量を調整する。スプールは、制御装置１２８から受信する制御指令に基づいて駆動される。つまり、走行油圧モータ、旋回油圧モータ、ブームシリンダ１３４、アームシリンダ１３５、およびバケットシリンダ１３６に供給される作動油の量は、制御装置１２８によって制御される。上記のとおり、走行油圧モータ、旋回油圧モータ、ブームシリンダ１３４、アームシリンダ１３５、およびバケットシリンダ１３６は共通の油圧装置１２７から供給される作動油によって駆動する。なお、走行油圧モータまたは旋回油圧モータが斜板式可変容量モータである場合、制御装置１２８は斜板の傾転角により回転速度を調整してもよい。
　制御装置１２８は、操作装置１２３から操作信号を受信する。制御装置１２８は、受信した操作信号に基づいて、作業機１３０、旋回体１２０、または走行体１１０を駆動させる。
《制御装置の構成》
　図３は、第１の実施形態に係る制御装置の構成を示す概略ブロック図である。
　制御装置１２８は、プロセッサ１１００、メインメモリ１２００、ストレージ１３００、インタフェース１４００を備えるコンピュータである。ストレージ１３００は、プログラムを記憶する。プロセッサ１１００は、プログラムをストレージ１３００から読み出してメインメモリ１２００に展開し、プログラムに従った処理を実行する。
　ストレージ１３００の例としては、ＨＤＤ、ＳＳＤ、磁気ディスク、光磁気ディスク、ＣＤ－ＲＯＭ、ＤＶＤ－ＲＯＭ等が挙げられる。ストレージ１３００は、制御装置１２８の共通通信線に直接接続された内部メディアであってもよいし、インタフェース１４００を介して制御装置１２８に接続される外部メディアであってもよい。ストレージ１３００は、一時的でない有形の記憶媒体である。
　プロセッサ１１００は、プログラムの実行により、車両情報取得部１１０１、検出情報取得部１１０２、操作信号入力部１１０３、バケット位置特定部１１０４、マップ生成部１１０５、積込対象特定部１１０６、積込位置特定部１１０７、回避位置特定部１１０８、掘削対象特定部１１０９、掘削位置特定部１１１０、移動処理部１１１１、操作信号出力部１１１２を備える。
　車両情報取得部１１０１は、例えば旋回体１２０の旋回速度、位置および方位、ブーム１３１、アーム１３２およびバケット１３３の傾斜角、ならびに旋回体１２０の姿勢を取得する。以下、車両情報取得部１１０１が取得する積込機械１００に係る情報を車両情報とよぶ。車両情報取得部は、姿勢情報取得部の一例である。
　検出情報取得部１１０２は、深度検出装置１２４から深度情報を取得する。深度情報は、検出範囲Ｒ内の複数の点の三次元位置を示す。深度情報の例としては、深度を表す複数の画素からなる深度画像や、直交座標系（ｘ，ｙ，ｚ）で表現される複数の点からなる点群データが挙げられる。
　操作信号入力部１１０３は、操作装置１２３から操作信号の入力を受け付ける。操作信号にはブーム１３１の上げ操作信号および下げ操作信号、アーム１３２の押し操作信号および引き操作信号、バケット１３３のダンプ操作信号および掘削操作信号、旋回体１２０の旋回操作信号、走行体１１０の走行操作信号、ならびに積込機械１００の掘削積込指示信号が含まれる。
　図４は、第１の実施形態に係る自動掘削積込制御における排土前のバケットの経路の例を示す図である。
　バケット位置特定部１１０４は、車両情報取得部１１０１が取得した車両情報に基づいて、ショベル座標系におけるアーム１３２の先端部の位置Ｐおよびアーム１３２の先端からバケット１３３の最下通過点までの高さＨｂを特定する。バケット１３３の最下通過点とは、バケット１３３のダンプ操作の間に刃先と地表面との距離が最も短くなるときに刃先が位置する点をいう。すなわち、アーム１３２の先端からバケット１３３の最下通過点までの高さＨｂは、バケット１３３の基端部のピンから刃先までの長さと一致する。
　また、バケット位置特定部１１０４は、掘削積込指示信号の入力を受け付けたときのアーム１３２の先端部の位置Ｐを掘削完了位置Ｐ１０として特定する。バケット１３３の基端部はアーム１３２の先端部に接続されているため、アーム１３２の先端部の位置Ｐは、バケット１３３の基端部の位置に等しい。
　具体的には、バケット位置特定部１１０４は、以下の手順でアーム１３２の先端部の位置Ｐを特定する。バケット位置特定部１１０４は、ブームシリンダ１３４のストローク量から求められるブーム１３１の絶対角度と既知のブーム１３１の長さ（基端部のピンから先端部のピンまでの距離）とに基づいて、ブーム１３１の先端部の位置を求める。バケット位置特定部１１０４は、ブーム１３１の絶対角度と、アームシリンダ１３５のストローク量から求められるアーム１３２の相対角度とに基づいて、アーム１３２の絶対角度を求める。バケット位置特定部１１０４は、ブーム１３１の先端部の位置と、アーム１３２の絶対角度と、既知のアーム１３２の長さ（基端部のピンから先端部のピンまでの距離）とに基づいて、アーム１３２の先端部の位置Ｐを求める。
　マップ生成部１１０５は、旋回体１２０の非旋回時に車両情報取得部１１０１が取得した旋回体１２０の位置、方位、および姿勢と、検出情報取得部１１０２が取得した深度情報とに基づいて、現場座標系によって積込機械１００の周囲のうち少なくとも一部の形状を表す三次元マップを生成する。非旋回時とは、具体的には、積込機械１００が掘削動作をしている時や、排土動作をしている時であり、完全に旋回速度が０になっている状態でなくてもよく、わずかに旋回方向に動いていてもよい。なお、他の実施形態においては、マップ生成部１１０５は、旋回体１２０を基準としたショベル座標系に係る三次元マップを生成してもよい。
　積込対象特定部１１０６は、マップ生成部１１０５が生成した三次元マップに基づいて、積込対象２００の位置および形状、ならびに積込点Ｐ２１の位置を特定する。積込点Ｐ２１は、例えばダンプトラックのベッセル上の点である。例えば、積込対象特定部１１０６は、三次元マップが示す三次元形状と積込対象２００の既知の形状とをマッチングすることで、積込対象２００の位置および形状、ならびに積込点Ｐ２１を特定する。
　積込位置特定部１１０７は、操作信号入力部１１０３に掘削積込指示信号が入力された場合に、積込対象特定部１１０６が特定した積込点Ｐ２１に基づいて、積込位置Ｐ１３を特定する。具体的には、積込位置特定部１１０７は、以下のように積込位置Ｐ１３を特定する。
　積込位置特定部１１０７は、特定した積込点Ｐ２１を、積込位置Ｐ１３の平面位置として特定する。つまり、アーム１３２の先端が積込位置Ｐ１３に位置するとき、アーム１３２の先端は積込点Ｐ２１の上方に位置することとなる。積込点Ｐ２１の例としては、積込対象２００がダンプトラックの場合におけるベッセルの中心点、および積込対象２００がホッパの場合における開口の中心点が挙げられる。積込位置特定部１１０７は、積込対象２００の高さＨｔに、バケット位置特定部１１０４が特定したアーム１３２の先端からバケット１３３最下通過点までの高さＨｂと、バケット１３３の制御余裕分の高さとを加算することで、積込位置Ｐ１３の高さを特定する。なお、他の実施形態においては、積込位置特定部１１０７は、制御余裕分の高さを加算せずに積込位置Ｐ１３を特定してもよい。すなわち、積込位置特定部１１０７は、高さＨｔに高さＨｂを加算することで、積込位置Ｐ１３の高さを特定してもよい。なお、第１の実施形態に係る高さＨｔは、地面からベッセルの上面までの高さである。
　つまり、積込位置特定部１１０７は、積込位置Ｐ１３を特定することで、旋回制御における旋回体１２０の目標方位を決定する。積込位置特定部１１０７は、目標方位決定部の一例である。
　回避位置特定部１１０８は、積込位置特定部１１０７が特定した積込位置Ｐ１３と、車両情報取得部１１０１が取得した積込機械１００の位置と、積込対象特定部１１０６が特定した積込対象２００の位置および形状に基づいて、作業機１３０と積込対象２００とが上方からの平面視において干渉しない点である干渉回避位置Ｐ１２を特定する。干渉回避位置Ｐ１２は、積込位置Ｐ１３と同じ高さを有し、かつ旋回体１２０の旋回中心からの距離が、当該旋回中心から積込位置Ｐ１３までの距離と等しく、かつ下方に積込対象２００が存在しない位置である。回避位置特定部１１０８は、例えば、旋回体１２０の旋回中心を中心とし、当該旋回中心と積込位置Ｐ１３との距離を半径とする円を特定し、当該円上の位置のうち、バケット１３３の外形が上方からの平面視で積込対象２００と干渉せず、かつ積込位置Ｐ１３に最も近い位置を、干渉回避位置Ｐ１２と特定する。回避位置特定部１１０８は、積込対象２００の位置および形状、ならびにバケット１３３の既知の形状に基づいて、積込対象２００とバケット１３３とが干渉するか否かを判定することができる。ここで、「同じ高さ」、「距離が等しい」とは、必ずしも高さまたは距離が完全に一致するものに限られず、多少の誤差やマージンが許容されるものとする。
　掘削対象特定部１１０９は、マップ生成部１１０５が生成した三次元マップに基づいて、掘削対象の掘削点Ｐ２２の位置を特定する。掘削点Ｐ２２は、例えばバケット１３３の刃先をその点からアーム１３２およびバケット１３３を掘削方向へ移動させることで、バケット１３３の最大容量に相当する量の土砂を掘削できる点である。例えば、掘削対象特定部１１０９は、三次元マップが示す三次元形状から掘削対象の土砂の分布を特定し、当該分布に基づいて掘削点Ｐ２２を特定する。図５は、第１の実施形態に係る自動掘削積込制御における排土後のバケットの経路の例を示す図である。
　掘削位置特定部１１１０は、掘削対象特定部１１０９が特定した掘削点Ｐ２２から、バケット１３３の基端部から刃先までの距離だけ離れた点を、掘削位置Ｐ１９として特定する。つまり、バケット１３３は、ダンプ方向に刃先を向けた所定の掘削姿勢をとっている場合において、バケット１３３の刃先が掘削点Ｐ２２に位置するとき、アーム１３２の先端は掘削位置Ｐ１９に位置することとなる。
　つまり、掘削位置特定部１１１０は、掘削位置Ｐ１９を特定することで、旋回制御における旋回体１２０の目標方位を決定する。掘削位置特定部１１１０は、目標方位決定部の一例である。
　移動処理部１１１１は、操作信号入力部１１０３が掘削積込指示信号の入力を受け付けた場合に、積込位置特定部１１０７が特定した積込位置Ｐ１３、回避位置特定部１１０８が特定した干渉回避位置Ｐ１２に基づいて、バケット１３３を積込位置Ｐ１３まで移動させるための回動操作信号を生成する。すなわち、移動処理部１１１１は、掘削完了位置Ｐ１０から、旋回開始位置Ｐ１１および干渉回避位置Ｐ１２を経由して、積込位置Ｐ１３に到達するように、回動操作信号を生成する。また、移動処理部１１１１は、ブーム１３１およびアーム１３２が駆動してもバケット１３３の対地角度が変化しないように、バケット１３３の回動操作信号を生成する。
　移動処理部１１１１は、バケット１３３が積込位置Ｐ１３に到達すると、バケット１３３をダンプ方向へ回転させるためのダンプ操作信号を生成する。移動処理部１１１１は、掘削位置特定部１１１０が特定した掘削位置Ｐ１９、回避位置特定部１１０８が特定した干渉回避位置Ｐ１２に基づいて、バケット１３３を掘削位置Ｐ１９まで移動させるための回動操作信号を生成する。すなわち、移動処理部１１１１は、積込位置Ｐ１３から、干渉回避位置Ｐ１２および旋回終了位置Ｐ１８を経由して、掘削位置Ｐ１９に到達するように、回動操作信号を生成する。移動処理部１１１１はバケットが掘削姿勢となるように、バケットの回動操作信号を生成する。移動処理部１１１１が生成する操作信号は、最大の操作量で操作装置１２３のレバーまたはペダルを操作したときに操作信号入力部１１０３に入力される操作信号に係る駆動量での駆動を指示する信号である。駆動量は、例えば作動油の油量またはスプールの開度である。
　なお、積込機械１００が遠隔操作によって駆動する場合、移動処理部１１１１が生成する操作信号は、最大の操作量に係る駆動量より大きい駆動量での駆動を指示する信号であってよい。これは、有人運転に係る積込機械１００は、オペレータの乗り心地のために操作装置１２３の最大操作量が制限されるところ、遠隔操作に係る積込機械１００は、オペレータの乗り心地による制限がないためである。
　操作信号出力部１１１２は、操作信号入力部１１０３に入力された操作信号、または移動処理部１１１１が生成した操作信号を出力する。具体的には、操作信号出力部１１１２は、自動掘削積込制御中である場合に、移動処理部１１１１が生成した自動制御に係る操作信号を出力し、自動掘削積込制御中でない場合に、操作信号入力部１１０３に入力されたオペレータの手動操作に係る操作信号を出力する。
《自動掘削積込制御》
　積込機械１００のオペレータは、積込機械１００と積込対象２００とが積込処理可能な位置関係にあると判断すると、操作装置１２３の自動制御用のスイッチをＯＮにする。これにより、操作装置１２３は、掘削積込指示信号を生成し出力する。
　図６－図８は、第１の実施形態に係る自動掘削積込制御を示すフローチャートである。制御装置１２８は、オペレータから掘削積込指示信号の入力を受け付けると、図６－図８に示す自動掘削積込制御を実行する。なお、自動掘削積込制御の開始時には、バケット１３３の刃先は掘削点に位置し、積込対象２００は旋回体１２０の側方に位置する。
　車両情報取得部１１０１は、旋回体１２０の位置および方位、ブーム１３１、アーム１３２およびバケット１３３の傾斜角、ならびに旋回体１２０の姿勢を取得する（ステップＳ１）。車両情報取得部１１０１は、取得した旋回体１２０の位置および方位に基づいて、旋回体１２０の旋回中心の位置を特定する（ステップＳ２）。
　検出情報取得部１１０２は、深度検出装置１２４から、積込機械１００の周囲の深度を示す深度情報を取得する（ステップＳ３）。深度検出装置１２４は旋回体１２０の側面に設けられ、積込対象２００は旋回体１２０の側方に位置するため、深度検出装置１２４の検出範囲Ｒには、積込対象２００が含まれる。マップ生成部１１０５は、車両情報取得部１１０１が取得した旋回体１２０の位置、方位、および姿勢と、検出情報取得部１１０２が取得した深度情報とに基づいて、現場座標系によって積込機械１００の周囲のうち少なくとも一部の形状を表す三次元マップを生成する（ステップＳ４）。積込対象特定部１１０６は、生成したマップ情報に基づいて、積込対象２００の位置および形状、ならびに積込点Ｐ２１を特定する（ステップＳ５）。
　バケット位置特定部１１０４は、車両情報取得部１１０１が取得した車両情報に基づいて、掘削積込指示信号の入力時のアーム１３２の先端部の位置Ｐ、およびアーム１３２の先端からバケット１３３の最下通過点までの高さＨｂを特定する（ステップＳ６）。バケット位置特定部１１０４は、当該位置Ｐを掘削完了位置Ｐ１０と特定する。
　積込位置特定部１１０７は、積込対象特定部１１０６が特定した積込点Ｐ２１の位置に基づいて、積込位置Ｐ１３の平面位置を特定する（ステップＳ７）。このとき、積込位置特定部１１０７は、積込対象２００の高さＨｔに、ステップＳ５で特定したアーム１３２の先端部からバケット１３３の最下通過点までの高さＨｂと、バケット１３３の制御余裕分の高さとを加算することで、積込位置Ｐ１３の高さを特定する（ステップＳ８）。
　回避位置特定部１１０８は、旋回体１２０の旋回中心から積込位置までの平面距離を特定する（ステップＳ９）。回避位置特定部１１０８は、旋回中心から特定した平面距離だけ離れた位置であって、バケット１３３の外形が平面視で積込対象２００と干渉せず、かつ積込位置Ｐ１３から最も近い位置を、干渉回避位置Ｐ１２として特定する（ステップＳ１０）。
　なお、ステップＳ１からステップＳ９までの間、旋回体１２０は旋回していない。
　移動処理部１１１１は、アーム１３２の先端部の位置Ｐが積込位置Ｐ１３に至ったか否かを判定する（ステップＳ１１）。アーム１３２の先端部の位置Ｐが積込位置Ｐ１３に至っていない場合（ステップＳ１１：ＮＯ）、移動処理部１１１１は、アーム１３２の先端部の位置Ｐが干渉回避位置Ｐ１２の近傍にあるか否かを判定する（ステップＳ１２）。例えば、移動処理部１１１１は、アーム１３２の先端の高さと干渉回避位置Ｐ１２の高さとの差が所定の閾値未満であり、または旋回体１２０の旋回中心からアーム１３２の先端までの平面距離と旋回中心から干渉回避位置Ｐ１２までの平面距離との差が所定の閾値未満であるか否かを判定する（ステップＳ１２）。アーム１３２の先端部の位置Ｐが干渉回避位置Ｐ１２の近傍にない場合（ステップＳ１２：ＮＯ）、移動処理部１１１１は、ブーム１３１およびアーム１３２を干渉回避位置Ｐ１２の高さまで上昇させる操作信号を生成する（ステップＳ１３）。このとき、移動処理部１１１１は、ブーム１３１およびアーム１３２の位置および速度に基づいて、操作信号を生成する。
　また移動処理部１１１１は、生成したブーム１３１およびアーム１３２の操作信号に基づいてブーム１３１およびアーム１３２の角速度の和を算出し、当該角速度の和と同じ速度でバケット１３３を回動させる操作信号を生成する（ステップＳ１４）。これにより、移動処理部１１１１は、バケット１３３の対地角を保持する操作信号を生成することができる。なお、他の実施形態においては、移動処理部１１１１は、ブームストロークセンサ１３７、アームストロークセンサ１３８およびバケットストロークセンサ１３９の検出値より算出されるバケット１３３の対地角度が、自動制御開始時の対地角度と等しくなるようにバケット１３３を回動させる操作信号を生成してもよい。
　アーム１３２の先端部の位置Ｐが干渉回避位置Ｐ１２の近傍にある場合（ステップＳ１２：ＹＥＳ）、移動処理部１１１１は、ブーム１３１、アーム１３２およびバケット１３３の操作信号を生成しない。つまり、アーム１３２の先端部の位置Ｐが干渉回避位置Ｐ１２の近傍にある場合、移動処理部１１１１は、作業機１３０を積込点へ移動させるための作業機１３０の操作信号の出力を禁止する。
　移動処理部１１１１は、車両情報取得部１１０１が取得した車両情報に基づいて、旋回体１２０の旋回速度が所定速度未満であるか否かを判定する（ステップＳ１５）。すなわち、移動処理部１１１１は、旋回体１２０が旋回中であるか否かを判定する。
　旋回体１２０の旋回速度が所定速度未満である場合（ステップＳ１５：ＹＥＳ）、移動処理部１１１１は、バケット１３３の高さが掘削完了位置Ｐ１０の高さから干渉回避位置Ｐ１２の高さに至るまでの時間である上昇時間を特定する（ステップＳ１６）。移動処理部１１１１は、バケット１３３の上昇時間に基づいて、現在時刻から旋回操作信号を出力した場合に、アーム１３２の先端が干渉回避位置Ｐ１２または干渉回避位置Ｐ１２より高い点を通過することになるか否かを判定する（ステップＳ１７）。現在時刻から旋回操作信号を出力した場合に、アーム１３２の先端が干渉回避位置Ｐ１２または干渉回避位置Ｐ１２より高い点を通過することになる場合（ステップＳ１７：ＹＥＳ）、移動処理部１１１１は、旋回操作信号を生成する（ステップＳ１８）。
　現在時刻から旋回操作信号を出力した場合に、アーム１３２の先端が干渉回避位置Ｐ１２より低い点を通過することになる場合（ステップＳ１７：ＮＯ）、移動処理部１１１１は、旋回操作信号を生成しない。つまり、アーム１３２の先端が干渉回避位置Ｐ１２より低い点を通過することになる場合、移動処理部１１１１は、旋回操作信号の出力を禁止する。
　旋回体１２０の旋回速度が所定速度以上である場合（ステップＳ１５：ＮＯ）、移動処理部１１１１は、現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端が積込位置Ｐ１３に到達するか否かを判定する（ステップＳ１９）。なお、旋回体１２０は、旋回操作信号の出力の停止後、減速しながらも慣性により旋回し続け、その後停止する。現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端が積込位置Ｐ１３に到達する場合（ステップＳ１９：ＹＥＳ）、移動処理部１１１１は、旋回操作信号を生成しない。つまり、現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端が積込位置Ｐ１３に到達する場合、移動処理部１１１１は、旋回操作信号の出力を禁止する。これにより、旋回体１２０は減速を始める。
　他方、現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端が積込位置Ｐ１３より手前で停止することになる場合（ステップＳ１９：ＮＯ）、移動処理部１１１１は、旋回操作信号を生成する（ステップＳ２０）。
　ステップＳ１１からステップＳ２０の処理でブーム１３１、アーム１３２およびバケット１３３の回動操作信号、並びに旋回体１２０の旋回操作信号の少なくともいずれか１つを生成すると、操作信号出力部１１１２は、生成した操作信号を油圧装置１２７に出力する（ステップＳ２１）。
　そして、車両情報取得部１１０１は、車両情報を取得する（ステップＳ２２）。これにより、車両情報取得部１１０１は、出力した操作信号によって作動した後の車両情報を取得することができる。制御装置１２８は、処理をステップＳ１１に戻し、操作信号の生成を繰り返し実行する。
　他方、ステップＳ１１にて、アーム１３２の先端部の位置Ｐが積込位置Ｐ１３に至った場合（ステップＳ１１：ＹＥＳ）、移動処理部１１１１は、ダンプ操作信号を生成し、操作信号出力部１１１２は、ダンプ操作信号を油圧装置１２７に出力する（ステップＳ２３）。これにより、バケット１３３に収容された土砂は、積込対象２００に積み込まれる。なお、アーム１３２の先端部の位置Ｐが積込位置Ｐ１３に至ったとき、旋回体１２０の旋回は停止している。また、バケット１３３は、ダンプ方向に回動することで、所定の掘削姿勢をとる。
　車両情報取得部１１０１は、旋回体１２０の位置および方位、ブーム１３１、アーム１３２およびバケット１３３の傾斜角、ならびに旋回体１２０の姿勢を取得する（ステップＳ２４）。検出情報取得部１１０２は、深度検出装置１２４から、積込機械１００の周囲のうち少なくとも一部の深度を示す深度情報を取得する（ステップＳ２５）。深度検出装置１２４は旋回体１２０の側面に設けられ、掘削対象は旋回体１２０の側方に位置するため、深度検出装置１２４の検出範囲Ｒには、掘削対象が含まれる。マップ生成部１１０５は、車両情報取得部１１０１が取得した旋回体１２０の位置、方位、および姿勢と、検出情報取得部１１０２が取得した深度情報とに基づいて、現場座標系によって積込機械１００の周囲のうち少なくとも一部の形状を表す三次元マップを生成する（ステップＳ２６）。掘削対象特定部１１０９は、生成した三次元マップに基づいて掘削点Ｐ２２を特定する（ステップＳ２５）。掘削位置特定部１１１０は、掘削対象特定部１１０９が特定した掘削点Ｐ２２の位置に基づいて、掘削位置Ｐ１９を特定する（ステップＳ２８）。
　移動処理部１１１１は、アーム１３２の先端部の位置Ｐが掘削位置Ｐ１９に至ったか否かを判定する（ステップＳ２９）。アーム１３２の先端部の位置Ｐが掘削位置Ｐ１９に至っていない場合（ステップＳ２９：ＮＯ）、移動処理部１１１１は、アーム１３２の先端部の位置Ｐが干渉回避位置Ｐ１２を通過したか否かを判定する（ステップＳ３０）。アーム１３２の先端部の位置Ｐが干渉回避位置Ｐ１２を通過していない場合（ステップＳ３０：ＮＯ）、移動処理部１１１１は、ブーム１３１、アーム１３２およびバケット１３３の操作信号を生成しない。つまり、アーム１３２の先端部の位置Ｐが干渉回避位置Ｐ１２を通過していない場合、移動処理部１１１１は、作業機１３０を掘削点へ移動させるための作業機１３０の操作信号の出力を禁止する。
　他方、アーム１３２の先端部の位置Ｐが干渉回避位置Ｐ１２を通過した場合（ステップＳ３０：ＹＥＳ）、移動処理部１１１１は、アーム１３２の先端部の位置Ｐを降下させるためのブーム１３１およびアーム１３２の操作信号を生成する（ステップＳ３１）。
　次に、移動処理部１１１１は、現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端の平面位置が掘削位置Ｐ１９に到達するか否かを判定する（ステップＳ３２）。現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端の平面位置が掘削位置Ｐ１９に到達しない場合（ステップＳ３２：ＮＯ）、移動処理部１１１１は、旋回操作信号を生成する（ステップＳ３３）。
　他方、現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端の平面位置が掘削位置Ｐ１９に到達する場合（ステップＳ３２：ＹＥＳ）、移動処理部１１１１は、旋回操作信号を生成しない。つまり、現在時刻から旋回操作信号の出力を停止した場合に、アーム１３２の先端の平面位置が掘削位置Ｐ１９に到達する場合、移動処理部１１１１は、旋回操作信号の出力を禁止する。これにより、旋回体１２０は減速を始める。
　ステップＳ３０からステップＳ３３の処理でブーム１３１およびアーム１３２の操作信号、並びに旋回体１２０の旋回操作信号の少なくともいずれか１つを生成すると、操作信号出力部１１１２は、生成した操作信号を油圧装置１２７に出力する（ステップＳ３４）。
　そして、車両情報取得部１１０１は、車両情報を取得する（ステップＳ３５）。これにより、車両情報取得部１１０１は、出力した操作信号によって作動した後の車両情報を取得することができる。制御装置１２８は、処理をステップＳ２９に戻し、操作信号の生成を繰り返し実行する。
　他方、ステップＳ２９にて、アーム１３２の先端部の位置Ｐが掘削位置Ｐ１９に至った場合（ステップＳ２９：ＹＥＳ）、移動処理部１１１１は、掘削操作信号を生成し、操作信号出力部１１１２は、掘削操作信号を油圧装置１２７に出力する（ステップＳ３６）。これにより、バケット１３３の刃先は掘削完了位置Ｐ１０に移動し、バケット１３３には土砂が収容される。そして、制御装置１２８は、自動掘削積込制御を終了する。または制御装置１２８は、処理をステップＳ１１に戻し、積込対象２００の積載量が最大積載量を超えない範囲で、自動積込と自動掘削を繰り返し実行する。
　上述の自動掘削積込制御により、積込機械１００は、バケット１３３がすくった土砂を積込対象２００に積込み、さらに次の土砂をすくうことができる。オペレータは、掘削積込指示信号の入力による自動掘削積込制御を、積込対象２００の積載量が最大積載量を超えない程度に繰り返し実行する。
《作用・効果》
　このように、第１の実施形態に係る積込機械１００の制御装置１２８は、旋回体１２０が旋回していないときに取得された姿勢情報および深度情報に基づいて、目標方位を決定する。旋回体１２０が旋回していないときに姿勢情報および深度情報を取得することで、当該深度情報を取得したときの姿勢情報の誤差を小さく抑えることができる。したがって、第１の実施形態に係る制御装置１２８は、旋回制御における目標方位を精度よく決定することができる。第１の実施形態に係る目標方位は、積荷旋回における目標方位である積込位置Ｐ１３を向く方位、および空荷旋回における目標方位である掘削位置Ｐ１９を向く方位である。なお、他の実施形態に係る制御装置１２８は、積荷旋回における目標方位または空荷旋回における目標方位のいずれか一方を決定するものであってもよい。この場合、旋回体１２０の両側部のうち一方のみに深度検出装置１２４が設けられていてよい。
　また、第１の実施形態に係る作業機１３０は、旋回体１２０の前部に設けられ、深度検出装置１２４は、旋回体１２０の側部に設けられる。これにより、作業機１３０が積込対象２００への積込作業を行っているときに、深度検出装置１２４は掘削対象の深度を計測することができる。またこれにより、作業機１３０が掘削対象の掘削作業を行っているときに、深度検出装置１２４は積込対象２００の深度を計測することができる。また、第１の実施形態に係る深度検出装置１２４は、検出範囲Ｒに作業機１３０が含まれないように設置される。これにより、制御装置１２８は深度情報から作業機１３０が含まれる範囲を除外する処理を行うことなく、積込点Ｐ２１および掘削点Ｐ２２を特定することができる。
　以上、図面を参照して一実施形態について詳しく説明してきたが、具体的な構成は上述のものに限られることはなく、様々な設計変更等をすることが可能である。
　例えば、第１の実施形態に係る制御装置１２８は、積込点Ｐ２１および掘削点Ｐ２２を、深度情報を用いて特定するが、これに限られない。他の実施形態に係る制御装置１２８は、積込点Ｐ２１または掘削点Ｐ２２の一方のみを、深度情報を用いて特定してもよい。つまり、第１の実施形態に係る制御装置１２８は、自動掘削積込制御を行うが、これに限られない。他の実施形態に係る制御装置１２８は自動積込制御を行い、掘削作業がオペレータの手動操作によって行われてもよい。また他の実施形態に係る制御装置１２８は自動掘削制御を行い、積込作業がオペレータの手動操作によって行われてもよい。
　また、第１の実施形態に係る制御装置１２８は、掘削点Ｐ２２を特定して、掘削点Ｐ２２への旋回操作のあとに掘削操作を実行するが、これに限らず、掘削点Ｐ２２への旋回操作までを実行して、自動掘削積込制御を終了してもよい。
　また第１の実施形態に係る制御装置１２８は、掘削操作後かつ積荷旋回前に取得した姿勢情報および深度情報を用いて積込点Ｐ２１を特定するが、これに限られない。例えば、他の実施形態に係る制御装置１２８は、空荷旋回後かつ掘削操作前に取得した姿勢情報および深度情報、または掘削操作中に取得した姿勢情報および深度情報を用いて積込点Ｐ２１を特定してもよい。いずれの場合も、姿勢情報および深度情報は旋回体１２０が旋回していないか、旋回したとしてもわずかに旋回しているときに取得されたものである。
　また第１の実施形態に係る制御装置１２８は、ダンプ操作後かつ空荷旋回前に取得した姿勢情報および深度情報を用いて掘削点Ｐ２２を特定するが、これに限られない。例えば、他の実施形態に係る制御装置１２８は、積荷旋回後かつダンプ操作前または積荷旋回後かつダンプ操作中に取得した姿勢情報および深度情報を用いて掘削点Ｐ２２を特定してもよい。いずれの場合も、姿勢情報および深度情報は旋回体１２０が旋回していないか、旋回したとしてもわずかに旋回しているときに取得されたものである。
　また第１の実施形態に係る深度検出装置１２４の検出範囲Ｒは、旋回体１２０の幅方向に伸びる軸を中心とするが、これに限られない。例えば、深度検出装置１２４は、旋回体１２０の前方向と検出範囲Ｒの中心軸とがなす角が、掘削積込サイクルにおける平均旋回角または目標旋回角と略一致するように設けられてもよい。
　また、第１の実施形態に係る積込機械１００はバケット１３３を備えるが、これに限られない。例えば、他の実施形態に係る積込機械１００は、バックオールとクラムシェルとを開閉可能に備えるクラムバケットを備えるものであってもよい。
　また、第１の実施形態に係る積込機械１００は、オペレータが搭乗して操作する有人運転車両であるが、これに限られない。例えば、他の実施形態に係る積込機械１００は、遠隔の事務所にいるオペレータがモニタの画面を見ながら操作する遠隔操作装置から、通信により取得する操作信号によって作動する遠隔運転車両であってもよい。この場合、制御装置１２８の一部の機能が遠隔操作装置に設けられてもよい。
　本願発明に係る制御装置は、旋回制御における目標方位を精度よく決定することができる。
　１００…積込機械　１１０…走行体　１２０…旋回体　１２１…運転室　１２２…運転席　１２３…操作装置　１２４…深度検出装置　１２５…位置方位演算器　１２６…傾斜計測器　１２７…油圧装置　１２８…制御装置　１３０…作業機　１３１…ブーム　１３２…アーム　１３３…バケット　１３４…ブームシリンダ　１３５…アームシリンダ　１３６…バケットシリンダ　１３７…ブームストロークセンサ　１３８…アームストロークセンサ　１３９…バケットストロークセンサ　１１００…プロセッサ　１２００…メインメモリ　１３００…ストレージ　１４００…インタフェース　１１０１…車両情報取得部　１１０２…検出情報取得部　１１０３…操作信号入力部　１１０４…バケット位置特定部　１１０５…マップ生成部　１１０６…積込対象特定部　１１０７…積込位置特定部　１１０８…回避位置特定部　１１０９…掘削対象特定部　１１１０…掘削位置特定部　１１１１…移動処理部　１１１２…操作信号出力部　２００…積込対象　Ｐ１０…掘削完了位置　Ｐ１１…旋回開始位置　Ｐ１２…干渉回避位置　Ｐ１３…積込位置　Ｐ１８…旋回終了位置　Ｐ１９…掘削位置　Ｐ２１…積込点　Ｐ２２…掘削点

Claims (7)

  1. 　旋回中心回りに旋回可能な旋回体と、前記旋回体に設けられた作業機と、前記旋回体の姿勢を計測する姿勢計測装置と、前記旋回体に設けられ、検出範囲における前記旋回体の周囲のうち少なくとも一部の深度を検出する深度検出装置とを備える積込機械を制御する制御装置であって、
    　前記姿勢計測装置が計測した姿勢を示す姿勢情報を取得する姿勢情報取得部と、
    　前記深度検出装置が検出した深度を示す深度情報を取得する検出情報取得部と、
    　前記旋回体が旋回を停止しているときに取得された前記姿勢情報および前記深度情報に基づいて、旋回制御における目標方位を決定する目標方位決定部と、
    　前記目標方位に基づいて旋回操作信号を出力する出力部と
    　を備える制御装置。
  2. 　前記旋回体が旋回していないときに取得された前記姿勢情報および前記深度情報に基づいて、前記旋回体の周囲のうち少なくとも一部の三次元位置を示す三次元マップを生成するマップ生成部を備え、
    　前記目標方位決定部は、前記三次元マップに基づいて前記目標方位を決定する
    　請求項１に記載の制御装置。
  3. 　前記作業機は、前記旋回体の前部に設けられ、
    　前記深度検出装置は、前記旋回体の側部に設けられる
    　請求項１または請求項２に記載の制御装置。
  4. 　前記目標方位決定部は、前記作業機による積込動作時に取得された前記姿勢情報および前記深度情報に基づいて、前記作業機による掘削対象が存在する方位を目標方位に決定する
    　請求項１から請求項３のいずれか１項に記載の制御装置。
  5. 　前記目標方位決定部は、前記作業機による掘削動作時に取得された前記姿勢情報および前記深度情報に基づいて、積込対象が存在する方位を目標方位に決定する
    　請求項１から請求項４のいずれか１項に記載の制御装置。
  6. 　旋回中心回りに旋回可能な旋回体と、
    　前記旋回体に設けられた作業機と、
    　前記旋回体の姿勢を計測する姿勢計測装置と、
    　前記旋回体に設けられ、検出範囲における前記旋回体の周囲のうち少なくとも一部の深度を検出する深度検出装置と、
    　請求項１から請求項５のいずれか１項に記載の制御装置と
    　を備える積込機械。
  7. 　旋回中心回りに旋回可能な旋回体と、前記旋回体に設けられた作業機と、前記旋回体の姿勢を計測する姿勢計測装置と、前記旋回体に設けられ、検出範囲における前記旋回体の周囲の深度を検出する深度検出装置とを備える積込機械の制御方法であって、
    　前記姿勢計測装置が計測した姿勢を示す姿勢情報を取得するステップと、
    　前記深度検出装置が検出した深度を示す深度情報を取得するステップと、
    　前記旋回体が旋回していないときに取得された前記姿勢情報および前記深度情報に基づいて、旋回制御における目標方位を決定するステップと、
    　前記目標方位に基づいて旋回操作信号を出力するステップと
    　を備える制御方法。
PCT/JP2019/028342 2018-08-31 2019-07-18 制御装置、積込機械、および制御方法 WO2020044842A1 (ja)

Priority Applications (3)

Application Number Priority Date Filing Date Title
CN201980047660.6A CN112424430B (zh) 2018-08-31 2019-07-18 控制装置、装载机械及控制方法
US16/973,635 US20210246625A1 (en) 2018-08-31 2019-07-18 Control device, loading machine, and control method
DE112019003165.1T DE112019003165T5 (de) 2018-08-31 2019-07-18 Steuervorrichtung, lademaschine und steuerverfahren

Applications Claiming Priority (2)

Application Number Priority Date Filing Date Title
JP2018-163416 2018-08-31
JP2018163416A JP7188940B2 (ja) 2018-08-31 2018-08-31 制御装置、積込機械、および制御方法

Publications (1)

Publication Number Publication Date
WO2020044842A1 true WO2020044842A1 (ja) 2020-03-05

Family

ID=69645113

Family Applications (1)

Application Number Title Priority Date Filing Date
PCT/JP2019/028342 WO2020044842A1 (ja) 2018-08-31 2019-07-18 制御装置、積込機械、および制御方法

Country Status (5)

Country Link
US (1) US20210246625A1 (ja)
JP (2) JP7188940B2 (ja)
CN (1) CN112424430B (ja)
DE (1) DE112019003165T5 (ja)
WO (1) WO2020044842A1 (ja)

Cited By (1)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021210665A1 (ja) * 2020-04-17 2021-10-21 株式会社小松製作所 制御システムおよび制御方法

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP7155516B2 (ja) * 2017-12-20 2022-10-19 コベルコ建機株式会社 建設機械
JP7088691B2 (ja) * 2018-02-28 2022-06-21 株式会社小松製作所 積込機械の制御装置、制御方法および遠隔操作システム
JP2023103810A (ja) * 2022-01-14 2023-07-27 日立建機株式会社 作業機械
JP2023114782A (ja) * 2022-02-07 2023-08-18 コベルコ建機株式会社 作業目標設定システム、作業機械、および作業目標設定プログラム
CN114592865A (zh) * 2022-02-25 2022-06-07 三一重型装备有限公司 掘进机的控制方法、装置、可读存储介质和掘进机
JP2023151010A (ja) * 2022-03-31 2023-10-16 日立建機株式会社 作業機械
JP2024054695A (ja) * 2022-10-05 2024-04-17 日立建機株式会社 作業機械

Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000136549A (ja) * 1998-10-09 2000-05-16 Carnegie Mellon Univ 自律掘削及びトラック載荷システム
US20150225923A1 (en) * 2014-02-13 2015-08-13 Trimble Navigation Limited Non-contact location and orientation determination of an implement coupled with a mobile machine
JP2016089389A (ja) * 2014-10-30 2016-05-23 日立建機株式会社 作業機械の旋回支援装置
WO2017115809A1 (ja) * 2015-12-28 2017-07-06 住友建機株式会社 ショベル
JP2017227014A (ja) * 2016-06-21 2017-12-28 株式会社小松製作所 施工システム及び施工方法

Family Cites Families (12)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JPH086352B2 (ja) * 1988-09-22 1996-01-24 株式会社クボタ バックホウのバックホウ装置操作構造
JPH10159123A (ja) * 1996-12-03 1998-06-16 Shin Caterpillar Mitsubishi Ltd 建設機械の制御装置
JP2000291076A (ja) * 1999-04-01 2000-10-17 Tokai Rika Co Ltd パワーショベル
CN102947513B (zh) * 2010-06-23 2015-07-08 斗山英维高株式会社 建筑机械的作业轨迹控制装置及其方法
AU2012202213B2 (en) * 2011-04-14 2014-11-27 Joy Global Surface Mining Inc Swing automation for rope shovel
US9540794B2 (en) * 2015-03-27 2017-01-10 Komatsu Ltd. Calibration device for work machine and calibration method of working equipment parameter for work machine
JP2017227104A (ja) * 2016-06-24 2017-12-28 株式会社工務店支援機構風土里舎 木造建築物モノコック耐震工法
WO2017047826A1 (ja) * 2016-09-30 2017-03-23 株式会社小松製作所 作業機械の表示システム及び作業機械
US20200217050A1 (en) * 2017-09-06 2020-07-09 Hitachi Construction Machinery Co., Ltd. Work machine
US11149411B2 (en) * 2018-03-12 2021-10-19 Hitachi Construction Machinery Co., Ltd. Work machine
EP3572590B1 (en) * 2018-03-14 2022-02-09 Hitachi Construction Machinery Co., Ltd. Work machine
WO2019189031A1 (ja) * 2018-03-28 2019-10-03 住友建機株式会社 ショベル

Patent Citations (5)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
JP2000136549A (ja) * 1998-10-09 2000-05-16 Carnegie Mellon Univ 自律掘削及びトラック載荷システム
US20150225923A1 (en) * 2014-02-13 2015-08-13 Trimble Navigation Limited Non-contact location and orientation determination of an implement coupled with a mobile machine
JP2016089389A (ja) * 2014-10-30 2016-05-23 日立建機株式会社 作業機械の旋回支援装置
WO2017115809A1 (ja) * 2015-12-28 2017-07-06 住友建機株式会社 ショベル
JP2017227014A (ja) * 2016-06-21 2017-12-28 株式会社小松製作所 施工システム及び施工方法

Cited By (3)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
WO2021210665A1 (ja) * 2020-04-17 2021-10-21 株式会社小松製作所 制御システムおよび制御方法
CN115380144A (zh) * 2020-04-17 2022-11-22 株式会社小松制作所 控制系统以及控制方法
JP7469127B2 (ja) 2020-04-17 2024-04-16 株式会社小松製作所 制御システムおよび制御方法

Also Published As

Publication number Publication date
JP2020033825A (ja) 2020-03-05
CN112424430B (zh) 2024-03-05
JP7188940B2 (ja) 2022-12-13
DE112019003165T5 (de) 2021-04-01
JP2023014313A (ja) 2023-01-26
JP7361186B2 (ja) 2023-10-13
CN112424430A (zh) 2021-02-26
US20210246625A1 (en) 2021-08-12

Similar Documents

Publication Publication Date Title
WO2020044842A1 (ja) 制御装置、積込機械、および制御方法
WO2020054418A1 (ja) 積込機械の制御装置および制御方法
US20210254312A1 (en) Control device and control method for work machine
JP7481422B2 (ja) 積込機械の制御装置および制御方法
WO2019168012A1 (ja) 積込機械の制御装置および制御方法
WO2019150616A1 (ja) 積込機械の制御装置および制御方法
WO2022230980A1 (ja) 積込機械の制御装置及び制御方法
JP7311681B2 (ja) 積込機械の制御装置、制御方法、および遠隔操作システム
WO2022244832A1 (ja) 積込機械の制御システム及び制御方法
WO2022244830A1 (ja) 積込機械の制御システム及び制御方法
WO2024024510A1 (ja) 積込機械の制御装置、積込機械の制御方法および制御システム
WO2024106536A1 (ja) 積込機械の制御装置、遠隔制御装置および制御方法
WO2021106905A1 (ja) 作業機械の制御システム、作業機械、および作業機械の制御方法
JP2024073906A (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: 19855680

Country of ref document: EP

Kind code of ref document: A1

122 Ep: pct application non-entry in european phase

Ref document number: 19855680

Country of ref document: EP

Kind code of ref document: A1