WO2025192005A1 - Work machine control device, work machine, external device, work machine system, and workability improvement method - Google Patents
Work machine control device, work machine, external device, work machine system, and workability improvement methodInfo
- Publication number
- WO2025192005A1 WO2025192005A1 PCT/JP2025/000657 JP2025000657W WO2025192005A1 WO 2025192005 A1 WO2025192005 A1 WO 2025192005A1 JP 2025000657 W JP2025000657 W JP 2025000657W WO 2025192005 A1 WO2025192005 A1 WO 2025192005A1
- Authority
- WO
- WIPO (PCT)
- Prior art keywords
- work
- position information
- work machine
- control
- controller
- Prior art date
- Legal status (The legal status 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 status listed.)
- Pending
Links
Definitions
- This disclosure relates to technology for work machines such as hydraulic excavators.
- Patent Document 1 discloses technology aimed at providing a shovel with high excavation efficiency by appropriately grasping the terrain of the work target.
- This shovel is equipped with a spatial recognition device and a control device, and the control device combines first data acquired by the spatial recognition device placed at a first viewpoint with second data acquired by the spatial recognition device placed at a second viewpoint different from the first viewpoint.
- Patent Document 2 discloses technology aimed at measuring piles of earth and sand that extend from inside the bucket to outside the bucket.
- the excavator in Patent Document 2 has a lower running body, an upper rotating body that is rotatably mounted on the lower running body, an attachment including a boom, arm, and bucket attached to the upper rotating body, and a distance measuring device that measures the distance to the ground in the digging direction of the bucket while digging is being performed.
- Patent Document 3 discloses an automatically operated shovel that excavates while sequentially changing the excavation depth within a limited excavation depth.
- This automatically operated shovel comprises a hydraulic shovel and an automatic operation controller built into the hydraulic shovel that repeatedly performs a cycle of operations from excavation to soil discharge through playback operations.
- the automatic operation controller comprises means for setting the number of times excavation can be repeated at different excavation depths corresponding to the limited excavation depth, and means for repeating the cycle of operations the set number of times during playback, deepening the excavation depth with each cycle of operations.
- Work machines use a bucket to excavate soil and perform a series of operations to move the soil held in the bucket to another location. For example, during the excavation operation of moving the bucket toward the undercarriage, some of the soil may overflow from the bucket or fall to the ground. In this case, soil may accumulate between the undercarriage and the target position for the bucket's work. The accumulated soil can reduce the productivity of the work performed by the work machine.
- the above issues can arise not only when the tip attachment is a bucket and the work object is soil and sand, but also when the tip attachment is other equipment such as a fork, grapple, or lifting magnet and the work object is other objects such as wood or waste materials.
- the purpose of this disclosure is to provide a work machine control device, work machine, external device, work machine system, and workability improvement method that can reduce, compared to conventional methods, the decline in work productivity caused by obstacles such as soil and sand that accumulate during work.
- a work machine control device includes a controller that performs predetermined control to enable acquisition of position information for a work target position when position information for the work target position at the work site cannot be acquired based on work site information, which is information about the work site input from a position information acquisition device.
- a work machine includes a machine body, a work device rotatably supported on the machine body, a position information acquisition device that acquires work site information that is information related to the work site, and the work machine control device.
- An external device includes the work machine control device.
- a work machine system includes a work machine and an external device.
- the work machine system includes the work machine control device.
- a workability improvement method includes a step in which a controller acquires position information of a work target position at a work site based on work site information, which is information about the work site, input from a position information acquisition device, and a step in which, if the controller is unable to acquire the position information, the controller performs predetermined control to enable acquisition of the position information of the work target position.
- This disclosure provides a work machine control device, work machine, external device, work machine system, and workability improvement method that can reduce, compared to conventional methods, the decline in work productivity caused by obstacles such as soil and sand that accumulate during work.
- FIG. 1 is a diagram showing a work machine system according to an embodiment, the work machine system including a work machine according to an embodiment and an external device.
- FIG. 2 is a block diagram illustrating components of the work machine system. 3 is a flowchart showing a calculation process performed by a controller of the work machine control device according to the embodiment.
- FIG. 2 is a plan view for explaining a work area and a plurality of work target positions at a work site.
- 4 is a conceptual diagram for explaining the positional relationship between the position information acquisition device of the work machine, the work target range, and a predetermined height.
- FIG. 10 is a conceptual diagram for explaining the positional relationship between the position information acquisition device, the task target position, the obstacle (deposit), and the predetermined height.
- FIG. 1 is a diagram showing a work machine system according to an embodiment, the work machine system including a work machine according to an embodiment and an external device.
- FIG. 2 is a block diagram illustrating components of the work machine system. 3 is a flow
- FIG. 10 is a conceptual diagram for explaining a case where an object other than the deposit is present between the position information acquisition device and the task target position.
- FIG. FIG. 10 is a conceptual diagram for explaining a predetermined height in a modified example of the embodiment.
- 3A to 3C are conceptual diagrams for explaining an excavation operation, a lifting and swinging operation, an earth-discharging operation, and a return swinging operation as examples of operations performed by the work machine.
- 10 is a flowchart showing a calculation process performed by a controller of a work machine control device according to a modified example of the embodiment.
- 10 is a flowchart showing a calculation process performed by a controller of a work machine control device according to another modified example of the embodiment.
- FIG. 1 is a side view showing a work machine system 300 according to an embodiment.
- the work machine system 300 includes a work machine 100 and an external device 200.
- FIG. 2 is a block diagram showing the components of the work machine system 300.
- the work machine 100 comprises a lower running body 1 including a travelling device, an upper rotating body 2 supported on the lower running body 1 so as to be rotatable relative to the lower running body 1 about a rotation axis Z extending vertically, a work device 3 supported on the upper rotating body 2, multiple actuators, a position information acquisition device 20, an attitude detection unit 30, and a work machine control device 40.
- the work machine control device 40 comprises a controller 50.
- the controller 50 controls the operation of the work machine 100.
- the lower running body 1 and the upper rotating body 2 are examples of the machine body in this disclosure.
- the work machine 100 in this embodiment is a hydraulic excavator, but the work machine in this disclosure is not limited to hydraulic excavators and may be other work machines such as cranes or bulldozers.
- the forward/backward and left/right directions shown in the figure may be directions based on the orientation of the upper rotating body 2, may be directions based on the orientation of the lower running body 1, or may be directions based on one of the various coordinate systems (e.g., the reference coordinate system) described below.
- the upper rotating body 2 comprises a rotating frame 2A, a cab 2B, and a rear outer wall 2C.
- the rotating frame 2A is a frame that is rotatably supported on the lower traveling body 1 and forms the base portion of the upper rotating body 2.
- the cab 2B is located, for example, at the front left of the revolving frame 2A.
- a driver's seat, operating devices, etc. are located inside the cab 2B.
- the operating devices include controls that receive various operations from the operator, such as boom operation to raise and lower the boom 4, arm operation to rotate the arm 5, tip attachment operation to rotate the tip attachment 6, swing operation to swing the upper swing body 2 relative to the undercarriage 1, and travel operation to travel the undercarriage 1.
- the controls may be composed of at least one of an operating lever, an operating pedal, and an operating button.
- the operating devices are used when the operator is inside the cab 2B and operates the work machine 100. The operating devices are not used when the work machine 100 is operated automatically or when the work machine 100 is remotely controlled.
- the rear outer wall 2C is located behind the cab 2B and is an outer wall that defines the machinery room.
- Various equipment is located in the machinery room, including power equipment such as an engine, battery, and generator, hydraulic equipment such as a hydraulic pump, and electrical equipment.
- the hydraulic pump is driven by the power equipment.
- a counterweight may be located at the rear or behind the rear outer wall 2C. The counterweight is a weight used to balance the work machine 100.
- the work device 3 includes a boom 4 that is attached to the upper rotating body 2 so that it can be raised and lowered, an arm 5 that is attached to the boom 4 so that it can rotate, and a tip attachment 6 that is attached to the arm 5 so that it can rotate.
- the tip attachment 6 is a bucket 6, but the tip attachment may also be other tip attachments such as a grapple, fork, or lifting magnet.
- Each of the multiple actuators operates by receiving a supply of hydraulic oil discharged from the hydraulic pump.
- the multiple actuators include a boom cylinder 7 for raising and lowering the boom 4, an arm cylinder 8 for rotating the arm 5, a tip attachment cylinder 9 for rotating the tip attachment 6, a swing motor 11 for rotating the upper swing body 2 relative to the lower running body 1, and a travel motor (not shown) for traveling the lower running body 1.
- the position information acquisition device 20 acquires work site information, which is information about the work site WS.
- the position information acquisition device 20 may be attached to the cab 2B, for example. Specifically, the position information acquisition device 20 may be attached to the front part of the top surface of the cab 2B.
- the position information acquisition device 20 acquires work site information, which is information related to the work site WS, and inputs the acquired work site information to the controller 50.
- the position information acquisition device 20 may be configured to acquire three-dimensional data (e.g., point cloud data) of objects present at the work site WS, such as the ground, obstacles, and other work machines.
- the position information acquisition device 20 may be a distance measurement sensor that acquires distance information regarding the distance to an object by irradiating light such as laser light.
- the distance measurement sensor may be, for example, a LiDAR (Light Detection and Ranging).
- the position information acquisition device 20 may also be a stereo camera, an ultrasonic sensor, a total station, an infrared sensor, or any other sensor capable of acquiring work site information regarding the work site.
- the position information acquisition device 20 may also be an imaging device that captures images of the work site WS as work site information.
- the position information acquisition device 20 may also be a combination of two or more of these devices.
- the attitude detection unit 30 acquires attitude information, which is information relating to the attitude of the work machine 100.
- the attitude detection unit 30 may include multiple attitude detectors. As shown in FIG. 1, the multiple attitude detectors may include a boom attitude detector 31, an arm attitude detector 32, and a tip attachment attitude detector 33. The multiple attitude detectors may further include a rotating unit attitude detector 34.
- the boom position detector 31 may be a sensor that detects the position of the boom 4, or may be a sensor that detects the state of the boom cylinder 7 that correlates with the position of the boom 4.
- the arm position detector 32 may be a sensor that detects the position of the arm 5, or may be a sensor that detects the state of the arm cylinder 8 that correlates with the position of the arm 5.
- the tip attachment position detector 33 may be a sensor that detects the position of the tip attachment 6, or may be a sensor that detects the state of the tip attachment cylinder 9 that correlates with the position of the tip attachment 6.
- the rotating body position detector 34 may be a sensor that detects the position of the upper rotating body 2, or may be a sensor that detects the state of the rotating motor 11 that correlates with the position of the upper rotating body 2.
- Each of the multiple attitude detectors may include, for example, an inertial measurement unit (IMU), a sensor that detects the degree of extension and contraction of the cylinder (e.g., a stroke sensor), or other sensors.
- the rotating body attitude detector 34 may include a sensor that detects the rotation angle of the upper rotating body 2 relative to the lower running body 1, or a sensor that detects the inclination angle of the upper rotating body 2 relative to the horizontal plane.
- the attitude detection unit 30 inputs the acquired attitude information to the controller 50 of the work machine control device 40.
- the controller 50 can calculate the attitude of the work machine 100 using the attitude information input from the attitude detection unit 30.
- the controller 50 of the work machine control device 40 performs specific control.
- the specific control may be, for example, control for automatic operation (automatic operation control) that automates the operation of the work machine 100, control for semi-automatic operation (semi-automatic operation control) that automates part of the operation of the work machine 100, control for an operator to remotely operate the work machine 100 using a remote operation device (not shown) located in a remote location away from the work machine 100 (remote operation control), or other control for assisting work-related personnel such as an operator, work manager, or assistant.
- the specific control may be control for assisting work-related personnel such as the work manager or assistant who monitors the automatic operation, control for assisting an operator who uses the remote operation device in the remote location, or control for assisting an operator when the operator is on board the work machine 100.
- the controller 50 controls the work machine 100, such as the specific control, using the work site information input from the position information acquisition device 20.
- the controller 50 performs the specific control using the work site information input from the position information acquisition device 20 and the attitude information input from the attitude detection unit 30. Specifically, for example, if the specific control is automatic driving control or semi-automatic driving control, the controller 50 outputs a control command to the control target 70 so that the work machine 100 performs an operation corresponding to the automatic driving data (described below) that is pre-stored in the data storage unit 56.
- the specific control is automatic driving control or semi-automatic driving control
- the controller 50 outputs a control command to the control target 70 so that the work machine 100 performs an operation corresponding to the automatic driving data (described below) that is pre-stored in the data storage unit 56.
- the work machine 100 is placed at a work site WS and performs a predetermined task within a work target range WR set at the work site WS.
- the predetermined task may be, for example, loading work, leveling work, or some other task.
- the controller 50 performs the specific control so that the work machine 100 performs the predetermined task.
- the controller 50 performs, for example, automatic driving control or semi-automatic driving control using the point cloud data input from the position information acquisition device 20 and the attitude information input from the attitude detection unit 30.
- the controller 50 outputs a control command to the control object 70 so that the work machine 100 performs an operation corresponding to the automatic driving data stored in advance in the data storage unit 56.
- Loading operations include multiple operations.
- the multiple operations may include, for example, the excavation operation shown in Figure 9(A), the lifting and swinging operation shown in Figure 9(B), the soil discharge operation shown in Figure 9(C), and the return swinging operation shown in Figure 9(D).
- the excavation operation, lifting and swinging operation, soil discharge operation, and return swinging operation are performed in this order.
- the excavation operation is an operation for excavating the work target range WR at the work site WS.
- the excavation operation may include, for example, a boom raising operation in which the boom 4 is raised, an arm pulling operation in which the arm 5 approaches the boom 4, and a bucket pulling operation in which the bucket 6 approaches the boom 4.
- the work target range WR may be, for example, the target excavation area indicated by the rectangular frame in Figure 4.
- the lifting and rotating operation is an operation for moving the bucket 6 holding the excavated soil from the work area WR to directly above the soil discharge area.
- the soil discharge area may be, for example, the bed of the dump truck 400, or an area for soil discharge formed at the work site WS.
- the lifting and rotating operation may include a boom-raising operation and a rotating operation in which the upper rotating body 2 rotates relative to the lower traveling body 1.
- the lifting and rotating operation may further include an arm-pushing operation in which the arm 5 moves away from the boom.
- the earth discharge operation is an operation for discharging earth and sand from the bucket 6 to the earth discharge area.
- the earth discharge operation may include a bucket pushing operation (earth discharge operation) in which the bucket 6 moves away from the boom 4.
- the earth discharge operation may further include an arm pushing operation in which the arm 5 moves away from the boom 4.
- the return swing operation is an operation for returning the bucket 6 from directly above the soil discharge area to the work range WR.
- the return swing operation may include a boom lowering operation in which the boom 4 is lowered, and a swing operation in which the upper swing structure 2 swings relative to the lower running structure 1.
- the return swing operation may further include an arm pulling operation or an arm pushing operation.
- Teaching data corresponding to loading operations that include multiple operations may be stored in the data storage unit 56, or may be stored in an external device 200 that is separate from the work machine 100.
- controller 50 When the controller 50 is performing the specific control, if it is unable to acquire position information of the work target position TP at the work site WS based on work site information (e.g., three-dimensional data such as point cloud data) relating to the work site WS input from the position information acquisition device 20, it outputs a command (shift command) to move an obstacle OB located between the position information acquisition device 20 and the work target position TP.
- work site information e.g., three-dimensional data such as point cloud data
- the controller 50 outputs a shift command to move the obstacle OB when it is unable to acquire the position information of the work target position TP based on the work site information, thereby reducing the decrease in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional cases.
- the controller 50 may output a shift command to the control object 70 of the work machine 100 when it is unable to acquire position information for the work target position TP based on the work site information.
- the control object 70 operates at least one of the work implement 3 and the upper rotating body 2 in response to the shift command so as to eliminate the state in which the obstacle OB is interposed between the position information acquisition device 20 and the work target position TP. This makes it possible for the position information acquisition device 20 to acquire position information for the work target position TP.
- the shift command may be a command to move an obstacle OB located on a straight line connecting the position information acquisition device 20 and the work target position TP to a position off said straight line.
- the shift command may be a command to control the operation of the work device 3 so that the bucket 6 (tip attachment) pushes the obstacle OB in a direction that moves the obstacle OB away from the lower traveling structure 1.
- the shift command may be a command to control the operation of the work device 3 so that the bucket 6 (tip attachment) pushes the obstacle OB in a direction that moves the obstacle OB away from the lower traveling structure 1, thereby returning the obstacle OB to within the work target range WR.
- the shift command may be a command to control the operation of the work device 3 so that the bucket 6 (tip attachment) pulls the obstacle OB in a direction that moves the obstacle OB closer to the lower traveling structure 1.
- the shift command may be a command to rotate the upper rotating structure 2 to the right or left so that the bucket 6 (tip attachment) pushes the obstacle OB to the right or left.
- the controller 50 comprises a computer including an arithmetic processing unit and memory. As shown in FIG. 2, the controller 50 may include, for example, a target setting unit 51, a position information determination unit 52, an obstacle determination unit 53, a control command output unit 54, a target change unit 55, and a data storage unit 56.
- the controller 50 realizes the functions of the target setting unit 51, the position information determination unit 52, the obstacle determination unit 53, the control command output unit 54, the target change unit 55, and the data storage unit 56 by the arithmetic processing unit executing a program stored in the memory.
- the target setting unit 51 may set a work target range WR.
- the target setting unit 51 may set at least one work target position TP.
- the target setting unit 51 sets multiple work target positions TP.
- the target setting unit 51 may set a work target position TP that will be the target of the next operation from among the multiple work target positions TP.
- the position information determination unit 52 determines whether or not position information for the work target position TP at the work site WS has been acquired based on work site information about the work site WS input from the position information acquisition device 20.
- the obstacle determination unit 53 determines whether or not an object (obstacle OB) is present between the position information acquisition device 20 and the work target position TP.
- the control command output unit 54 outputs commands to the control object 70 of the work machine 100. Specifically, if there is an obstacle OB between the position information acquisition device 20 and the work target position TP, the control command output unit 54 outputs a shift command to the control object 70 to move the obstacle OB.
- the control command output unit 54 also outputs a specific command, which is a command corresponding to the specific control described below, to the control object 70. Specifically, if the specific control is automatic driving control or semi-automatic driving control, the control command output unit 54 outputs an automatic driving command, which is a command corresponding to a series of operations in the automatic driving control or semi-automatic driving control of the work machine 100, to the control object 70.
- the target change unit 55 changes the task target position TP set at that time to a different task target position TP. In other words, the target change unit 55 changes the task target position TP.
- the data storage unit 56 stores specific data, which is data for specific control.
- the specific data may be, for example, automatic driving data for automatic or semi-automatic driving.
- the automatic driving data is used, for example, to calculate control commands that the controller 50 outputs to the controlled object 70 so that the work machine 100 performs a specified operation.
- the automatic driving data may be, for example, teaching data corresponding to operations given by the operator to the operating device in the cab 2B or the remote operating device, or may be data created using various information terminals.
- Each of the various positions required for specific control may be information represented by coordinates in a coordinate system based on the position information acquisition device 20 (acquisition device coordinate system), information represented by coordinates in a coordinate system based on the work machine 100 (machine coordinate system), information represented by coordinates in a coordinate system based on a specific position at the work site WS (site coordinate system), or information represented by coordinates in a global coordinate system.
- the controller 50 may be configured to be able to convert position information in any of these coordinate systems into position information in another coordinate system.
- the controller 50 is configured to convert point cloud data in the acquisition device coordinate system input from the position information acquisition device 20 into point cloud data in a predefined reference coordinate system.
- the reference coordinate system may be the machine coordinate system, the on-site coordinate system, the global coordinate system, or another coordinate system.
- the origin O of the reference coordinate system may be set at a specific position, for example, based on the work machine 100.
- the origin O of the reference coordinate system may be, for example, any position on the rotation axis Z. More specifically, the origin O of the reference coordinate system may be the intersection of the rotation axis Z and the ground.
- the origin O of the reference coordinate system may be, for example, a position on the rotation axis Z between the lower traveling body 1 and the upper rotating body 2 (origin O shown in Figure 1).
- the reference coordinate system is a three-dimensional coordinate system.
- the reference coordinate system may be, for example, a Cartesian coordinate system defined using an x-axis parallel to the left-right direction, a y-axis parallel to the front-back direction, and a z-axis parallel to the vertical direction.
- the reference coordinate system is not limited to the above specific example, and various other aspects can be adopted.
- the coordinates of the position information acquisition device 20 may be, for example, the coordinates of the viewpoint of the position information acquisition device 20, or the coordinates of another part of the position information acquisition device 20.
- the controller 50 may pre-store information regarding the relative position of the position information acquisition device 20 with respect to a specific position of the work machine 100 (for example, origin O). Specifically, for example, the controller 50 may store the coordinates of the position information acquisition device 20 in the reference coordinate system whose origin is the specific position of the work machine 100.
- the coordinates of the position information acquisition device 20 may be, for example, the coordinates of the viewpoint of the position information acquisition device 20, or the coordinates of another part of the position information acquisition device 20.
- the controlled object 70 is an object controlled by the controller 50.
- the output of the controlled object 70 changes in accordance with a control operation amount (control input), which is an operation amount input from the controller 50.
- the controlled object 70 may include a flow rate regulator and at least one of the plurality of actuators.
- the flow rate regulator adjusts the direction and flow rate of hydraulic oil supplied to at least one of the plurality of actuators in accordance with the control operation amount input from the controller 50. In other words, when the controller 50 inputs a control operation amount to the flow rate regulator, the flow rate regulator operates in accordance with the control operation amount input from the controller 50, thereby supplying hydraulic oil from the hydraulic pump to at least one of the plurality of actuators and operating that actuator.
- the flow rate regulator may include, for example, a boom controller 71, an arm controller 72, a tip attachment controller 73, and a swing controller 74.
- the boom controller 71 may include a spool for adjusting the direction and flow rate of hydraulic oil supplied to the boom cylinder 7, a pair of pilot ports, and a pair of proportional valves.
- the arm controller 72 may include a spool for adjusting the direction and flow rate of hydraulic oil supplied to the arm cylinder 8, a pair of pilot ports, and a pair of proportional valves.
- the tip attachment controller 73 may include a spool for adjusting the direction and flow rate of hydraulic oil supplied to the tip attachment cylinder 9, a pair of pilot ports, and a pair of proportional valves.
- the swing controller 74 may include a spool for adjusting the direction and flow rate of hydraulic oil supplied to the swing motor 11, a pair of pilot ports, and a pair of proportional valves. Each spool is operated by inputting pilot pressure to the pilot port corresponding to that spool, allowing hydraulic oil to be supplied to the actuator corresponding to that spool.
- Each proportional valve is arranged in an oil passage connecting the pilot port of the spool corresponding to that proportional valve with a pilot pump (not shown), and adjusts the pilot pressure input to that pilot port.
- each proportional valve outputs a secondary pressure corresponding to the control operation amount (e.g., current value) input from the controller 50, and that secondary pressure is input as pilot pressure to the pilot port corresponding to that proportional valve.
- Each proportional valve adjusts the pilot pressure input to the pilot port corresponding to that proportional valve to a magnitude corresponding to the control operation amount input from the controller 50.
- the work machine 100 is equipped with a communication device 82, and the external device 200 is equipped with a communication device (not shown), so the work machine 100 and the external device 200 can send and receive data to and from each other via wireless or wired communication using various networks such as the Internet or a mobile phone network.
- the external device 200 may be an information terminal such as a tablet computer (a so-called tablet), a smartphone, a laptop personal computer, or a desktop personal computer.
- the external device 200 may also be a remote control device for remotely controlling the work machine 100 at a remote location away from the work machine 100.
- the external device 200 may also be a management device such as a server for managing work performed by the work machine 100.
- the external device 200 may also be an external storage device that stores data such as the teaching data.
- the external device 200 may also be a computer in a cloud service provided as a service over a network such as the Internet.
- the work machine system 300 may be equipped with multiple external devices 200.
- Figure 3 is a flowchart showing the calculation processing performed by the controller 50 of the work machine control device 40.
- the controller 50 performs the calculation processing shown in Figure 3 along with specific controls such as automatic driving control, semi-automatic driving control, and remote operation control.
- specific controls such as automatic driving control, semi-automatic driving control, and remote operation control.
- the position information acquisition device 20 is a LiDAR that acquires three-dimensional data (point cloud data) of the work site.
- the target setting unit 51 of the controller 50 performs initial settings (step S11).
- the initial settings may include setting a work target range WR at the work site WS and setting multiple work target positions TP.
- the initial settings may further include setting the number of times to repeat work for the multiple work target positions TP.
- the target setting unit 51 of the controller 50 may set the work target range WR by identifying the positions of three or more of the four corners A, B, C, and D of the rectangle.
- the position of the corner may be identified, for example, by the operator using an operation device in the cab 2B of the work machine 100 or an external device 200 (e.g., a remote control device) to position the tip of the bucket 6 at a position corresponding to the corner, and then making a specified input to the input device 81 of the work machine 100 or an input device (not shown) of the external device 200 (e.g., a remote control device).
- the target setting unit 51 of the controller 50 can calculate the position of the tip of the bucket 6 based on the attitude information input from the attitude detection unit 30.
- the position of the corner may also be identified, for example, by a person involved in the work inputting the coordinates of the corner into the external device 200.
- the target setting unit 51 of the controller 50 sets multiple work target positions TP within the identified work range WR.
- Each of the multiple work target positions TP set by the target setting unit 51 of the controller 50 may be the x coordinate and y coordinate of the work target position TP.
- the target setting unit 51 of the controller 50 may set multiple work target positions TP based on input for setting multiple work target positions TP by those involved in the work. This input may be made to the external device 200 or to the input device 81 of the work machine 100.
- the target setting unit 51 of the controller 50 may also set multiple work target positions TP based on a pre-stored algorithm for setting the work target positions TP and information about the work target range WR.
- the target setting unit 51 of the controller 50 sets 15 work target positions TP within the work target range WR and sets the order in which excavation operations will be performed at these work target positions TP.
- the target setting unit 51 of the controller 50 sets the order of excavation operations in the order of the numbers 1 to 15 of the 15 work target positions TP.
- the order of excavation operations is not limited to the specific example shown in FIG. 4.
- the position information determination unit 52 of the controller 50 determines whether or not it has been able to acquire position information for the currently set work target position TP (e.g., work target position TP No. 1) based on the three-dimensional data (point cloud data) related to the work site WS input from the position information acquisition device 20 (step S12). Specifically, for example, the position information determination unit 52 of the controller 50 may determine whether or not it has been able to acquire the ground height (z coordinate) in the x and y coordinates of the currently set work target position TP based on the three-dimensional data (point cloud data). The position information determination unit 52 of the controller 50 may also determine whether or not there is data in the x and y coordinates of the currently set work target position TP.
- the three-dimensional data includes data corresponding to the first work target position TP.
- the position information determination unit 52 of the controller 50 can determine whether or not the position information of the currently set work target position TP has been acquired, based on the three-dimensional data (point cloud data) input from the position information acquisition device 20.
- step S12 If the position information determination unit 52 of the controller 50 cannot obtain the position information of the first work target position TP (NO in step S12), the controller 50 performs the processing from step S18 onwards. The processing from step S18 onwards will be described later.
- the position information determination unit 52 of the controller 50 If the position information determination unit 52 of the controller 50 is able to obtain the position information of the first work target position TP (YES in step S12), it sets the next work target position in specific control (e.g., automatic driving control) to the first work target position TP (step S13). Then, the control command output unit 54 of the controller 50 outputs control commands to the control object 70 based on the automatic driving data stored in the data storage unit 56 so that an excavation operation and the associated operations of lifting rotation, soil discharge, and return rotation are performed at the first work target position TP (steps S14 and S15).
- specific control e.g., automatic driving control
- the excavation operation in step S14 is an operation in which the bucket 6 moves in a predetermined direction (e.g., backward) over a predetermined range with the work target position TP set at that time as the reference (start point of the operation, center of the operation, or end point of the operation).
- a predetermined direction e.g., backward
- the position information determination unit 52 of the controller 50 determines whether the series of tasks has been completed (step S16).
- the determination of whether the series of tasks has been completed may be, for example, whether the excavation operations and associated operations at task target positions TP 1 through 15 have been repeated the number of times (e.g., three times) set in the initial settings.
- the determination of whether the series of tasks has been completed may be, for example, whether the amount of soil excavated at that point has reached or exceeded a predetermined value.
- step S16 If the series of tasks is complete (YES in step S16), the controller 50 ends the specific control. On the other hand, if the series of tasks is not complete (NO in step S16), the controller 50 changes the setting of the task target position TP (step S17). Specifically, the controller 50 changes the next task target position TP, for example, from task target position TP No. 1 to task target position TP No. 2. The controller 50 then performs the processing from step S12 onwards again.
- the obstacle determination unit 53 of the controller 50 determines whether or not there is an object (obstacle OB) between the position information acquisition device 20 and the first work target position TP (step S18). Specifically, in step S18, the obstacle determination unit 53 of the controller 50 may determine whether or not there is an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the first work target position TP.
- step S12 If the controller 50 cannot acquire position information for the work target position TP based on the three-dimensional data (point cloud data) (NO in step S12), and if the position information acquisition device 20 detects an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP (YES in step S18), it outputs the shift command (step S19).
- the control command output unit 54 of the controller 50 may output a command to the control object 70 as a shift command to control the operation of the work device 3 so that, for example, the bucket 6 pushes the obstacle OB in a direction that moves the obstacle OB away from the undercarriage 1, thereby returning the obstacle OB to within the work target range WR.
- the controller 50 again performs the processing from step S12 onwards.
- the controller 50 outputs the shift command when the above two conditions are met (the controller 50 is unable to acquire position information for the work target position TP based on the three-dimensional data, and the position information acquisition device 20 detects an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP), and does not output the shift command when the above two conditions are not met. This improves the accuracy of determining that an obstacle OB is present in the area between the position information acquisition device 20 and the work target position TP.
- the predetermined height Th may be the height from the ground where the work machine 100 is placed (a height that is set in advance), as shown in Figures 5 to 7, or it may be a height that is determined as in the modified example shown in Figure 8, or it may be a height that is determined by some other method.
- the predetermined height Th is a height that corresponds to an imaginary line connecting the position information acquisition device 20 and the work target position TP.
- the area above the predetermined height Th is the area on and above that imaginary line (the area hatched with dashed dotted lines in Figure 8).
- step S12 if the controller 50 cannot acquire position information for the work target position TP (for example, work target position TP No. 1) based on the three-dimensional data (point cloud data) (NO in step S12), and if the position information acquisition device 20 does not detect an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP (NO in step S18), the controller 50 does not output the shift command and performs the processing of step S20.
- the controller 50 does not output the shift command and performs the processing of step S20.
- step S20 the controller 50 determines whether it is possible to acquire position information for other work target positions TP (for example, work target positions TP number 2 and onward) among the multiple work target positions TP based on the three-dimensional data (point cloud data). If the controller 50 is unable to acquire position information for all of the multiple work target positions TP based on the three-dimensional data (point cloud data) (YES in step S20), it ends the operation.
- position information for other work target positions TP for example, work target positions TP number 2 and onward
- the controller 50 ends the work or changes the position of the work machine 100, thereby preventing unnecessary work from being continued and reducing declines in work productivity.
- controller 50 can obtain position information for at least one of the multiple work target positions TP based on the three-dimensional data (point cloud data) (NO in step S20), the controller 50 changes the setting of the work target position TP (step S21) and performs the processing from step S12 onwards again.
- the controller 50 cannot acquire the position information of the work target position TP based on the three-dimensional data (NO in step S12), and if the position information acquisition device 20 does not detect an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP (NO in step S18), it is possible that an obstacle OB, such as a deposit of soil or sand, is not present in the area between the position information acquisition device 20 and the work target position TP, or that even if such deposit is present, it is not present in large quantities. In such a case, as shown in FIG. 7, for example, an object other than the deposit may be present in the area between the position information acquisition device 20 and the work target position TP.
- an obstacle OB such as a deposit of soil or sand
- the controller 50 changes the work target position TP (step S21) rather than outputting the shift command (step S19), allowing work to continue smoothly at the changed work target position TP (for example, any of work target positions TP 6 to 10).
- the present disclosure provides a work machine control device 40, work machine 100, external device 200, work machine system 300, and workability improvement method that can mitigate, compared to conventional methods, the decline in work productivity caused by obstacles OB, such as soil and sand, that accumulate during work.
- the present disclosure includes the following first to ninth aspects.
- the work machine control device 40 includes a controller 50 that performs predetermined control to enable acquisition of the position information of the work target position TP at the work site WS when the position information of the work site WS cannot be acquired based on the work site information, which is information relating to the work site WS input from the position information acquisition device 20.
- the controller 50 performs the specified control, which makes it possible to reduce the decline in work productivity caused by obstacles OB, such as soil and sand, that accumulate during work compared to conventional methods.
- obstacles OB such as soil and sand
- the construction machine control device 40 according to the second aspect further comprises the following configuration in addition to the construction machine control device 40 according to the first aspect. That is, in the construction machine control device 40 according to the second aspect, it is preferable that the predetermined control is control that outputs a command to move an obstacle OB that is between the position information acquisition device 20 and the work target position TP (first control), control that changes the work target position TP (second control), or control that changes the position of the construction machine 100 (third control).
- each of the first control, second control, and third control as the predetermined control can increase the possibility of acquiring position information for the work target position TP, and therefore can suppress a decrease in work productivity caused by an obstacle OB compared to conventional methods.
- the reasons why the first control, the second control, and the third control each increase the possibility of acquiring position information for the work target position TP are as follows. There is a correlation between the controller 50 being unable to acquire position information for the work target position TP based on work site information, such as three-dimensional data related to the work site WS, and the presence of an obstacle OB between the position information acquisition device 20 and the work target position TP. If the controller 50 performs the first control, which outputs a command (shift command) to move the obstacle OB when it is unable to acquire position information for the work target position TP based on the work site information, the obstacle OB between the position information acquisition device 20 and the work target position TP is removed or the amount of the obstacle OB is reduced.
- work site information such as three-dimensional data related to the work site WS
- the controller 50 performs the second control, which changes the work target position TP when it is unable to acquire position information for the work target position TP based on the work site information, the virtual line connecting the position information acquisition device 20 and the newly set work target position TP may pass through a position that is away from the obstacle OB. This increases the possibility of acquiring position information for the work target position TP.
- the controller 50 performs a third control to change the position of the work machine 100 when it is unable to acquire position information for the work target position TP based on the work site information
- the position of the position information acquisition device 20 also changes, and the virtual line connecting the changed position information acquisition device 20 and the work target position TP may pass through a position that is away from the obstacle OB.
- This increases the likelihood of acquiring position information for the work target position TP.
- each of the first control, second control, and third control as the predetermined control can increase the likelihood of acquiring position information for the work target position TP, thereby reducing the decline in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional methods.
- a work machine control device 40 according to the third aspect preferably includes the following configuration in addition to the work machine control device 40 according to the first aspect. That is, in the work machine control device 40 according to the third aspect, the predetermined control is control that outputs a command to move an obstacle OB that is between the position information acquisition device 20 and the work target position TP, and the controller 50 preferably outputs the shift command when it is unable to acquire position information of the work target position TP based on the work site information such as the three-dimensional data, and when the position information acquisition device 20 detects an object having a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP.
- the predetermined control is control that outputs a command to move an obstacle OB that is between the position information acquisition device 20 and the work target position TP
- the controller 50 preferably outputs the shift command when it is unable to acquire position information of the work target position TP based on the work site information such as the three-dimensional data, and when the position information acquisition device 20 detects an
- the controller 50 outputs the shift command when the above two conditions (the conditions that the controller 50 is unable to acquire position information of the work target position TP based on the work site information, and the position information acquisition device 20 detects an object having a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP) are satisfied, and does not output the shift command when the above two conditions are not satisfied.
- the third aspect can improve the accuracy of determining that an obstacle OB is present in the area between the position information acquisition device 20 and the work target position TP.
- the predetermined height Th may be, for example, the height from the ground where the work machine 100 is placed, or it may be a height determined in the sixth aspect described below, or it may be a height determined by a method other than these.
- the work machine control device 40 according to the fourth aspect further comprises the following configuration in addition to the work machine control device 40 according to any one of the first to third aspects. That is, in the work machine control device 40 according to the fourth aspect, it is preferable that the controller 50 changes the work target position TP when it is unable to acquire position information for the work target position TP based on the work site information such as the three-dimensional data, and when the position information acquisition device 20 does not detect an object having a predetermined height Th or more in the area between the position information acquisition device 20 and the work target position TP.
- the condition that the controller 50 is unable to acquire position information for the work target position TP based on the work site information, and the condition that the position information acquisition device 20 does not detect an object having a predetermined height Th or more in the area between the position information acquisition device 20 and the work target position TP) are met, there is a possibility that an obstacle OB, which is a deposit such as earth and sand, is not present in the area between the position information acquisition device 20 and the work target position TP, or that even if such deposit is present, it is not present in large amounts. In such a case, there is a possibility that something other than the deposits is present in the area between the position information acquisition device 20 and the work target position TP.
- the controller 50 changes the work target position TP instead of outputting the shift command, so that work can be continued smoothly at the changed work target position TP.
- the work machine control device 40 according to the fifth aspect further comprises the following configuration in addition to the work machine control device 40 according to the fourth aspect. That is, in the work machine control device 40 according to the fifth aspect, if the controller 50 is unable to acquire position information for all of the multiple work target positions TP, including the work target position TP, based on the three-dimensional data, it is preferable that the controller 50 performs control to change the position of the work machine 100 or control to end the work. If it is unable to acquire position information for all of the multiple work target positions TP, it may not be possible to address the issue by simply changing the work target position TP.
- the controller 50 can prevent unnecessary work from being continued and prevent a decrease in work productivity. Furthermore, when the controller 50 is unable to acquire the position information for all of the multiple work target positions TP based on the work site information, the position of the position information acquisition device 20 changes as the position of the work machine 100 is changed, and therefore, an imaginary line connecting the changed position information acquisition device 20 and the work target position TP may pass through a position that is outside the obstacle OB. This increases the possibility of acquiring the position information for the work target position TP.
- the work machine control device 40 according to the sixth aspect may further include the following configuration in addition to the work machine control device 40 according to any one of the third to fifth aspects: That is, in the work machine control device 40 according to the sixth aspect, the predetermined height Th may be a height corresponding to an imaginary line connecting the position information acquisition device 20 and the work target position TP.
- a work machine 100 according to a seventh aspect includes a machine main body, a work implement 3 rotatably supported on the machine main body, a position information acquisition device 20 that acquires work site information such as three-dimensional data related to the work site WS, and a work machine control device 40 according to any one of the first to sixth aspects.
- the controller 50 when the controller 50 is unable to acquire position information for the work target position TP based on the work site information, the controller 50 performs the predetermined control such as the first control, the second control, or the third control, thereby making it possible to suppress a decrease in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional systems.
- the external device 200 includes the work machine control device 40 according to any one of the first to sixth aspects.
- the controller 50 performs the predetermined control, such as the first control, the second control, or the third control, when it is unable to acquire position information for the work target position TP based on the work site information, such as three-dimensional data, and therefore it is possible to suppress a decrease in work productivity caused by obstacles OB, such as soil and sand, that accumulate during work, compared to conventional methods.
- the predetermined control such as the first control, the second control, or the third control
- a work machine system 300 includes a work machine 100 and an external device 200, and the work machine system 300 includes the work machine control device 40 according to any one of the first to sixth aspects.
- the controller 50 when the controller 50 cannot acquire position information for the work target position TP based on the work site information such as three-dimensional data, the controller 50 performs the predetermined control such as the first control, the second control, or the third control, thereby making it possible to suppress a decrease in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional methods.
- the workability improvement method includes the steps of: a step in which a controller 50 acquires position information of a work target position TP at the work site WS based on work site information such as three-dimensional data about the work site WS input from a position information acquisition device 20; and a step in which, when the controller 50 is unable to acquire the position information, the controller performs predetermined control to enable acquisition of the position information of the work target position.
- the controller 50 when the controller 50 is unable to acquire the position information of the work target position TP based on the work site information, the controller performs the predetermined control such as the first control, the second control, or the third control, thereby making it possible to suppress a decrease in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional methods.
- the predetermined control such as the first control, the second control, or the third control
- the tip attachment is a bucket 6, but the tip attachment may also be a device such as a fork, a grapple, or a lifting magnet.
- Each of these tip attachments holds a work object such as wood or waste material and performs various operations to move the work object. During these operations, a portion of the work object may fall from the tip attachment to the ground. Work objects that fall to the ground may cause a decrease in productivity of work performed by the work machine 100.
- the work machine control device 40 is provided on the work machine 100, but the work machine control device 40 may also be provided on the external device 200.
- the controller 50 of the work machine control device 40 includes a target setting unit 51, a position information determination unit 52, an obstacle determination unit 53, a control command output unit 54, a target change unit 55, and a data storage unit 56, and the work machine 100 is provided with the controller 50; however, the work machine 100 may also be provided with part of the target setting unit 51, the position information determination unit 52, the obstacle determination unit 53, the control command output unit 54, the target change unit 55, and the data storage unit 56, and the external device 200 may be provided with other parts of the target setting unit 51, the position information determination unit 52, the obstacle determination unit 53, the control command output unit 54, the target change unit 55, and the data storage unit 56. Furthermore, the controller 50 of the work machine control device 40 does not have to be provided with the data storage unit 56.
- the autonomous driving data does not necessarily have to be stored in the work machine 100, but may be stored in an external device 200 separate from the work machine 100.
- the controller 50 of the work machine 100 may acquire the autonomous driving data stored in the external device 200 by wireless or wired communication via the communicator 82, and may perform the specific control using the acquired autonomous driving data.
- the controller 50 When the controller 50 is unable to acquire position information of the work target position TP based on work site information such as three-dimensional data, it may output a shift command to an auxiliary machine (not shown) that assists the work machine 100 at the work site WS.
- the auxiliary machine operates in response to the shift command to eliminate the state in which the obstacle OB is interposed between the position information acquisition device 20 and the work target position TP. This enables the position information acquisition device 20 to acquire position information of the work target position TP.
- the work machine 100 may further include an antenna 83 for a satellite positioning system.
- the satellite positioning system may be, for example, the Global Positioning System (GPS), the Global Navigation Satellite System (GNSS), or another satellite positioning system.
- the antenna 83 may be configured to be able to detect the attitude of the upper rotating body 2 relative to the undercarriage 1, and may be configured to be able to acquire position information of the work machine 100 at the work site WS (for example, the coordinates of the work machine 100 in a global coordinate system).
- FIG. 10 is a flowchart showing the calculation processing performed by the controller 50 of the work machine control device 40 according to the eighth modified embodiment.
- the processing of steps S11 to S21 in the flowchart shown in Figure 10 is the same as the processing of steps S11 to S21 in the flowchart shown in Figure 3, so a description of these processes will be omitted.
- the calculation processing according to the flowchart shown in Figure 10 differs from the calculation processing according to the flowchart shown in Figure 3 in that it further includes step S22.
- step S20 if the controller 50 cannot acquire all of the position information based on the three-dimensional data (point cloud data) (YES in step S20), it outputs a command to the control object 70 to change the position of the work machine 100 (step S22). Then, after changing the position of the work machine 100, the controller 50 performs the processes from step S12 onwards again.
- FIG. 11 is a flowchart showing the calculation processing performed by the controller 50 of the work machine control device 40 according to the ninth modification of the embodiment.
- the processing of steps S11 to S17 in the flowchart shown in Figure 11 is the same as the processing of steps S11 to S17 in the flowchart shown in Figure 3, so a description of these processes will be omitted.
- the calculation processing according to the flowchart shown in Figure 11 differs from the calculation processing according to the flowchart shown in Figure 3 in that it further includes step S23 and does not include steps S18 to S21 of the flowchart shown in Figure 3.
- step S12 if the controller 50 cannot acquire the position information of the currently set work target position TP (for example, work target position TP No. 1) (NO in step S12), the controller 50 performs predetermined control to enable acquisition of the position information of the work target position TP (step S23). Then, once the predetermined control is completed, the controller 50 performs the processes from step S12 onwards again.
- the controller 50 performs the processes from step S12 onwards again.
- the predetermined control is control to output a command to move an obstacle OB between the position information acquisition device 20 and the work target position TP, control to change the work target position TP, or control to change the position of the work machine 100.
- the predetermined control may be set in advance in the controller 50 before work begins.
Landscapes
- Operation Control Of Excavators (AREA)
Abstract
Description
本開示は、油圧ショベルなどの作業機械のための技術に関する。 This disclosure relates to technology for work machines such as hydraulic excavators.
特許文献1は、好適に作業対象の地形を把握することにより、掘削効率の高いショベルを提供することを目的とする技術を開示している。このショベルは、空間認識装置と制御装置とを備え、前記制御装置は、第1の視点に配置した前記空間認識装置によって取得される第1のデータと、前記第1の視点とは異なる第2の視点に配置した前記空間認識装置によって取得される第2のデータとを合成する。 Patent Document 1 discloses technology aimed at providing a shovel with high excavation efficiency by appropriately grasping the terrain of the work target. This shovel is equipped with a spatial recognition device and a control device, and the control device combines first data acquired by the spatial recognition device placed at a first viewpoint with second data acquired by the spatial recognition device placed at a second viewpoint different from the first viewpoint.
特許文献2は、バケット内からバケット外に及ぶ土砂山を測定することを目的とする技術を開示している。特許文献2のショベルは、下部走行体と、下部走行体に対して旋回自在に搭載された上部旋回体と、上部旋回体に取り付けられたブーム、アーム、及びバケットを含むアタッチメントと、掘削を実行中において、バケットの掘削方向に位置する地面までの距離を計測する距離測定装置と、を有する。 Patent Document 2 discloses technology aimed at measuring piles of earth and sand that extend from inside the bucket to outside the bucket. The excavator in Patent Document 2 has a lower running body, an upper rotating body that is rotatably mounted on the lower running body, an attachment including a boom, arm, and bucket attached to the upper rotating body, and a distance measuring device that measures the distance to the ground in the digging direction of the bucket while digging is being performed.
特許文献3は、自動運転ショベルにおいて、掘削制限深さ内において順次掘削深度を変更しながら掘削することを目的とする自動運転ショベルを開示している。この自動運転ショベルは、油圧ショベルと、この油圧ショベルに内蔵され、教示された掘削から放土までの一巡する動作を再生操作により繰り返し行わせる自動運転コントローラと、を備え、前記自動運転コントローラは、掘削制限深さに対応して掘削深度の異なる掘削繰り返し可能回数を設定する手段と、再生時に前記一巡する動作毎に掘削深度を深めながら、前記一巡する動作を前記設定された回数繰り返させる手段と、を備える。 Patent Document 3 discloses an automatically operated shovel that excavates while sequentially changing the excavation depth within a limited excavation depth. This automatically operated shovel comprises a hydraulic shovel and an automatic operation controller built into the hydraulic shovel that repeatedly performs a cycle of operations from excavation to soil discharge through playback operations. The automatic operation controller comprises means for setting the number of times excavation can be repeated at different excavation depths corresponding to the limited excavation depth, and means for repeating the cycle of operations the set number of times during playback, deepening the excavation depth with each cycle of operations.
作業機械は、バケットを用いて土砂を掘削し、バケットに保持された土砂を別の場所に動かすための一連の作業を行う。例えばバケットを下部走行体に向かって近づける掘削動作中には、土砂の一部がバケットからあふれたり、土砂の一部がバケットから地面に落下したりすることがある。この場合、下部走行体とバケットによる作業の目標位置との間に土砂が堆積することがある。堆積した土砂は、作業機械による作業の生産性を低下させる原因となり得る。 Work machines use a bucket to excavate soil and perform a series of operations to move the soil held in the bucket to another location. For example, during the excavation operation of moving the bucket toward the undercarriage, some of the soil may overflow from the bucket or fall to the ground. In this case, soil may accumulate between the undercarriage and the target position for the bucket's work. The accumulated soil can reduce the productivity of the work performed by the work machine.
上記の課題は、先端アタッチメントがバケットであり作業対象物が土砂である場合だけでなく、先端アタッチメントがフォーク、グラップル、リフティングマグネットなどの他の装置であり作業対象物が木材、廃材などの他の対象物である場合にも同様に生じ得る。 The above issues can arise not only when the tip attachment is a bucket and the work object is soil and sand, but also when the tip attachment is other equipment such as a fork, grapple, or lifting magnet and the work object is other objects such as wood or waste materials.
本開示は、作業中に堆積する土砂などの障害物に起因する作業の生産性の低下を従来に比べて抑制できる作業機械制御装置、作業機械、外部装置、作業機械システムおよび作業性改善方法を提供することを目的とする。 The purpose of this disclosure is to provide a work machine control device, work machine, external device, work machine system, and workability improvement method that can reduce, compared to conventional methods, the decline in work productivity caused by obstacles such as soil and sand that accumulate during work.
本開示の一態様に係る作業機械制御装置は、位置情報取得装置から入力される作業現場に関する情報である作業現場情報に基づいて前記作業現場における作業目標位置の位置情報を取得できない場合に、前記作業目標位置の前記位置情報を取得できるようにするための所定の制御を行うコントローラを備える。 A work machine control device according to one aspect of the present disclosure includes a controller that performs predetermined control to enable acquisition of position information for a work target position when position information for the work target position at the work site cannot be acquired based on work site information, which is information about the work site input from a position information acquisition device.
本開示の他の態様に係る作業機械は、機械本体と、前記機械本体に回動可能に支持される作業装置と、作業現場に関する情報である作業現場情報を取得する位置情報取得装置と、前記作業機械制御装置と、を備える。 A work machine according to another aspect of the present disclosure includes a machine body, a work device rotatably supported on the machine body, a position information acquisition device that acquires work site information that is information related to the work site, and the work machine control device.
本開示の他の態様に係る外部装置は、前記作業機械制御装置を備える。 An external device according to another aspect of the present disclosure includes the work machine control device.
本開示の他の態様に係る作業機械システムは、作業機械と、外部装置と、を備える。前記作業機械システムは、前記作業機械制御装置を含む。 A work machine system according to another aspect of the present disclosure includes a work machine and an external device. The work machine system includes the work machine control device.
本開示の他の態様に係る作業性改善方法は、位置情報取得装置から入力される作業現場に関する情報である作業現場情報に基づいて前記作業現場における作業目標位置の位置情報をコントローラが取得するためのステップと、前記コントローラが前記位置情報を取得できない場合に、前記作業目標位置の前記位置情報を取得できるようにするための所定の制御を前記コントローラが行うステップと、を含む。 A workability improvement method according to another aspect of the present disclosure includes a step in which a controller acquires position information of a work target position at a work site based on work site information, which is information about the work site, input from a position information acquisition device, and a step in which, if the controller is unable to acquire the position information, the controller performs predetermined control to enable acquisition of the position information of the work target position.
本開示によれば、作業中に堆積する土砂などの障害物に起因する作業の生産性の低下を従来に比べて抑制できる作業機械制御装置、作業機械、外部装置、作業機械システムおよび作業性改善方法が提供される。 This disclosure provides a work machine control device, work machine, external device, work machine system, and workability improvement method that can reduce, compared to conventional methods, the decline in work productivity caused by obstacles such as soil and sand that accumulate during work.
本開示の実施形態について図面を参照しながら説明する。図1は、実施形態に係る作業機械システム300を示す側面図である。作業機械システム300は、作業機械100と、外部装置200と、を含む。図2は、作業機械システム300の構成要素を示すブロック図である。 Embodiments of the present disclosure will be described with reference to the drawings. FIG. 1 is a side view showing a work machine system 300 according to an embodiment. The work machine system 300 includes a work machine 100 and an external device 200. FIG. 2 is a block diagram showing the components of the work machine system 300.
作業機械100は、走行装置を含む下部走行体1と、上下に延びる旋回軸Zの回りに下部走行体1に対して旋回可能となるように下部走行体1に支持される上部旋回体2と、上部旋回体2に支持される作業装置3と、複数のアクチュエータと、位置情報取得装置20と、姿勢検出部30と、作業機械制御装置40と、を備える。作業機械制御装置40は、コントローラ50を備える。コントローラ50は、作業機械100の動作を制御する。下部走行体1および上部旋回体2は、本開示における機械本体の一例である。 The work machine 100 comprises a lower running body 1 including a travelling device, an upper rotating body 2 supported on the lower running body 1 so as to be rotatable relative to the lower running body 1 about a rotation axis Z extending vertically, a work device 3 supported on the upper rotating body 2, multiple actuators, a position information acquisition device 20, an attitude detection unit 30, and a work machine control device 40. The work machine control device 40 comprises a controller 50. The controller 50 controls the operation of the work machine 100. The lower running body 1 and the upper rotating body 2 are examples of the machine body in this disclosure.
本実施形態に係る作業機械100は油圧ショベルであるが、本開示における作業機械は、油圧ショベルに限られず、クレーン、ブルドーザなどの他の作業機械であってもよい。 The work machine 100 in this embodiment is a hydraulic excavator, but the work machine in this disclosure is not limited to hydraulic excavators and may be other work machines such as cranes or bulldozers.
図中に記載されている前後方向および左右方向のそれぞれは、上部旋回体2の向きを基準とする方向であってもよく、下部走行体1の向きを基準とする方向であってもよく、後述する種々の座標系の何れかの座標系(例えば基準座標系)を基準とする方向であってもよい。 The forward/backward and left/right directions shown in the figure may be directions based on the orientation of the upper rotating body 2, may be directions based on the orientation of the lower running body 1, or may be directions based on one of the various coordinate systems (e.g., the reference coordinate system) described below.
上部旋回体2は、旋回フレーム2Aと、キャブ2Bと、後部外壁2Cと、を備える。旋回フレーム2Aは、下部走行体1に旋回可能に支持されるフレームであり、上部旋回体2のベース部分を構成する。 The upper rotating body 2 comprises a rotating frame 2A, a cab 2B, and a rear outer wall 2C. The rotating frame 2A is a frame that is rotatably supported on the lower traveling body 1 and forms the base portion of the upper rotating body 2.
キャブ2Bは、旋回フレーム2Aの例えば左前部に配置されている。キャブ2Bの内部には、運転席、操作装置などが配置されている。前記操作装置は、ブーム4を起伏させるためのブーム操作、アーム5を回動させるためのアーム操作、先端アタッチメント6を回動させるための先端アタッチメント操作、上部旋回体2を下部走行体1に対して旋回させるための旋回操作、下部走行体1を走行させるための走行操作などのオペレータによる種々の操作を受ける操作器を含む。前記操作器は、操作レバー、操作ペダルおよび操作ボタンの少なくとも一つにより構成されていてもよい。前記操作装置は、オペレータがキャブ2Bに搭乗して作業機械100を操作する場合に用いられる。前記操作装置は、作業機械100が自動運転される場合および作業機械100が遠隔操作される場合には用いられない。 The cab 2B is located, for example, at the front left of the revolving frame 2A. A driver's seat, operating devices, etc. are located inside the cab 2B. The operating devices include controls that receive various operations from the operator, such as boom operation to raise and lower the boom 4, arm operation to rotate the arm 5, tip attachment operation to rotate the tip attachment 6, swing operation to swing the upper swing body 2 relative to the undercarriage 1, and travel operation to travel the undercarriage 1. The controls may be composed of at least one of an operating lever, an operating pedal, and an operating button. The operating devices are used when the operator is inside the cab 2B and operates the work machine 100. The operating devices are not used when the work machine 100 is operated automatically or when the work machine 100 is remotely controlled.
後部外壁2Cは、キャブ2Bの後ろに配置され、機械室を画定する外壁である。前記機械室には、エンジン、バッテリ、発電機などの動力機器、油圧ポンプなどの油圧機器、電気機器などの種々の機器が配置される。前記油圧ポンプは、前記動力機器により駆動される。後部外壁2Cの後部または後方にはカウンタウェイトが配置されていてもよい。前記カウンタウェイトは、作業機械100のつり合いをとるための重りである。 The rear outer wall 2C is located behind the cab 2B and is an outer wall that defines the machinery room. Various equipment is located in the machinery room, including power equipment such as an engine, battery, and generator, hydraulic equipment such as a hydraulic pump, and electrical equipment. The hydraulic pump is driven by the power equipment. A counterweight may be located at the rear or behind the rear outer wall 2C. The counterweight is a weight used to balance the work machine 100.
作業装置3は、上部旋回体2に対して起伏可能に取り付けられるブーム4と、ブーム4に対して回動可能に取り付けられるアーム5と、アーム5に対して回動可能に取り付けられる先端アタッチメント6と、を含む。本実施形態における先端アタッチメント6はバケット6であるが、先端アタッチメントは、例えば、グラップル、フォーク、リフティングマグネットなどの他の先端アタッチメントであってもよい。 The work device 3 includes a boom 4 that is attached to the upper rotating body 2 so that it can be raised and lowered, an arm 5 that is attached to the boom 4 so that it can rotate, and a tip attachment 6 that is attached to the arm 5 so that it can rotate. In this embodiment, the tip attachment 6 is a bucket 6, but the tip attachment may also be other tip attachments such as a grapple, fork, or lifting magnet.
複数のアクチュエータのそれぞれは、前記油圧ポンプから吐出される作動油の供給を受けて作動する。複数のアクチュエータは、ブーム4を起伏させるためのブームシリンダ7と、アーム5を回動させるためのアームシリンダ8と、先端アタッチメント6を回動させるための先端アタッチメントシリンダ9と、上部旋回体2を下部走行体1に対して旋回させるための旋回モータ11と、下部走行体1を走行させるための図略の走行モータと、を含む。 Each of the multiple actuators operates by receiving a supply of hydraulic oil discharged from the hydraulic pump. The multiple actuators include a boom cylinder 7 for raising and lowering the boom 4, an arm cylinder 8 for rotating the arm 5, a tip attachment cylinder 9 for rotating the tip attachment 6, a swing motor 11 for rotating the upper swing body 2 relative to the lower running body 1, and a travel motor (not shown) for traveling the lower running body 1.
位置情報取得装置20は、作業現場WSの情報である作業現場情報を取得する。位置情報取得装置20は、例えばキャブ2Bに取り付けられてもよい。具体的には、位置情報取得装置20は、キャブ2Bの上面における前部に取り付けられてもよい。 The position information acquisition device 20 acquires work site information, which is information about the work site WS. The position information acquisition device 20 may be attached to the cab 2B, for example. Specifically, the position information acquisition device 20 may be attached to the front part of the top surface of the cab 2B.
位置情報取得装置20は、作業現場WSに関する情報である作業現場情報を取得し、取得した作業現場情報をコントローラ50に入力する。位置情報取得装置20は、作業現場WSに存在する地面、障害物、他の作業機械などの物体の3次元データ(例えば、点群データ)を取得するように構成されていてもよい。 The position information acquisition device 20 acquires work site information, which is information related to the work site WS, and inputs the acquired work site information to the controller 50. The position information acquisition device 20 may be configured to acquire three-dimensional data (e.g., point cloud data) of objects present at the work site WS, such as the ground, obstacles, and other work machines.
位置情報取得装置20は、レーザ光などの光の照射により物体までの距離に関する距離情報を取得する測距センサであってもよい。測距センサは、例えば、LiDAR(Light Detection and Ranging)であってもよい。また、位置情報取得装置20は、ステレオカメラであってもよく、超音波センサであってもよく、トータルステーションであってもよく、赤外線センサであってもよく、作業現場に関する作業現場情報を取得することができる他のセンサであってもよい。位置情報取得装置20は、作業現場WSの画像を作業現場情報として撮像する撮像装置であってもよい。また、位置情報取得装置20は、これらの機器のうちの2つ以上の機器を組み合わせたものであってもよい。 The position information acquisition device 20 may be a distance measurement sensor that acquires distance information regarding the distance to an object by irradiating light such as laser light. The distance measurement sensor may be, for example, a LiDAR (Light Detection and Ranging). The position information acquisition device 20 may also be a stereo camera, an ultrasonic sensor, a total station, an infrared sensor, or any other sensor capable of acquiring work site information regarding the work site. The position information acquisition device 20 may also be an imaging device that captures images of the work site WS as work site information. The position information acquisition device 20 may also be a combination of two or more of these devices.
姿勢検出部30は、作業機械100の姿勢に関する情報である姿勢情報を取得する。姿勢検出部30は、複数の姿勢検出器を含んでいてもよい。図1に示すように、複数の姿勢検出器は、ブーム姿勢検出器31と、アーム姿勢検出器32と、先端アタッチメント姿勢検出器33と、を含んでいてもよい。複数の姿勢検出器は、旋回体姿勢検出器34をさらに含んでいてもよい。 The attitude detection unit 30 acquires attitude information, which is information relating to the attitude of the work machine 100. The attitude detection unit 30 may include multiple attitude detectors. As shown in FIG. 1, the multiple attitude detectors may include a boom attitude detector 31, an arm attitude detector 32, and a tip attachment attitude detector 33. The multiple attitude detectors may further include a rotating unit attitude detector 34.
ブーム姿勢検出器31は、ブーム4の姿勢を検出するセンサであってもよく、ブーム4の姿勢に相関するブームシリンダ7の状態を検出するセンサであってもよい。アーム姿勢検出器32は、アーム5の姿勢を検出するセンサであってもよく、アーム5の姿勢に相関するアームシリンダ8の状態を検出するセンサであってもよい。先端アタッチメント姿勢検出器33は、先端アタッチメント6の姿勢を検出するセンサであってもよく、先端アタッチメント6の姿勢に相関する先端アタッチメントシリンダ9の状態を検出するセンサであってもよい。旋回体姿勢検出器34は、上部旋回体2の姿勢を検出するセンサであってもよく、上部旋回体2の姿勢に相関する旋回モータ11の状態を検出するセンサであってもよい。 The boom position detector 31 may be a sensor that detects the position of the boom 4, or may be a sensor that detects the state of the boom cylinder 7 that correlates with the position of the boom 4. The arm position detector 32 may be a sensor that detects the position of the arm 5, or may be a sensor that detects the state of the arm cylinder 8 that correlates with the position of the arm 5. The tip attachment position detector 33 may be a sensor that detects the position of the tip attachment 6, or may be a sensor that detects the state of the tip attachment cylinder 9 that correlates with the position of the tip attachment 6. The rotating body position detector 34 may be a sensor that detects the position of the upper rotating body 2, or may be a sensor that detects the state of the rotating motor 11 that correlates with the position of the upper rotating body 2.
複数の姿勢検出器のそれぞれは、例えば、慣性計測装置(IMU)を含んでいてもよく、シリンダの伸縮の度合いを検出するセンサ(例えばストロークセンサ)を含んでいてもよく、他のセンサを含んでいてもよい。旋回体姿勢検出器34は、下部走行体1に対する上部旋回体2の旋回角度を検出するセンサを含んでいてもよく、水平面に対する上部旋回体2の傾斜角度を検出するセンサを含んでいてもよい。 Each of the multiple attitude detectors may include, for example, an inertial measurement unit (IMU), a sensor that detects the degree of extension and contraction of the cylinder (e.g., a stroke sensor), or other sensors. The rotating body attitude detector 34 may include a sensor that detects the rotation angle of the upper rotating body 2 relative to the lower running body 1, or a sensor that detects the inclination angle of the upper rotating body 2 relative to the horizontal plane.
姿勢検出部30は、取得した姿勢情報を作業機械制御装置40のコントローラ50に入力する。コントローラ50は、姿勢検出部30から入力される姿勢情報を用いて作業機械100の姿勢を演算することができる。 The attitude detection unit 30 inputs the acquired attitude information to the controller 50 of the work machine control device 40. The controller 50 can calculate the attitude of the work machine 100 using the attitude information input from the attitude detection unit 30.
作業機械制御装置40のコントローラ50は、特定制御を行う。前記特定制御は、例えば、作業機械100の動作を自動化する自動運転のための制御(自動運転制御)であってもよく、作業機械100の動作の一部を自動化する半自動運転のための制御(半自動運転制御)であってもよく、作業機械100から離れた遠隔地に配置される図略の遠隔操作装置を用いてオペレータが作業機械100を遠隔操作するための制御(遠隔操作制御)であってもよく、オペレータ、作業管理者、補助者などの作業関係者を補助するための他の制御であってもよい。すなわち、前記特定制御は、前記自動運転を監視する前記作業管理者、前記補助者などの作業関係者を補助するための制御であってもよく、前記遠隔地において前記遠隔操作装置を用いるオペレータを補助するための制御であってもよく、オペレータが作業機械100に搭乗しているときにオペレータを補助するための制御であってもよい。 The controller 50 of the work machine control device 40 performs specific control. The specific control may be, for example, control for automatic operation (automatic operation control) that automates the operation of the work machine 100, control for semi-automatic operation (semi-automatic operation control) that automates part of the operation of the work machine 100, control for an operator to remotely operate the work machine 100 using a remote operation device (not shown) located in a remote location away from the work machine 100 (remote operation control), or other control for assisting work-related personnel such as an operator, work manager, or assistant. In other words, the specific control may be control for assisting work-related personnel such as the work manager or assistant who monitors the automatic operation, control for assisting an operator who uses the remote operation device in the remote location, or control for assisting an operator when the operator is on board the work machine 100.
コントローラ50は、位置情報取得装置20から入力される作業現場情報を用いて前記特定制御などの作業機械100の制御を行う。 The controller 50 controls the work machine 100, such as the specific control, using the work site information input from the position information acquisition device 20.
コントローラ50は、位置情報取得装置20から入力される作業現場情報と、姿勢検出部30から入力される姿勢情報と、を用いて前記特定制御を行う。具体的には例えば、前記特定制御が自動運転制御または半自動運転制御である場合、コントローラ50は、データ記憶部56に予め記憶される後述の自動運転データに対応する動作を作業機械100が行うように制御対象70に対して制御指令を出力する。 The controller 50 performs the specific control using the work site information input from the position information acquisition device 20 and the attitude information input from the attitude detection unit 30. Specifically, for example, if the specific control is automatic driving control or semi-automatic driving control, the controller 50 outputs a control command to the control target 70 so that the work machine 100 performs an operation corresponding to the automatic driving data (described below) that is pre-stored in the data storage unit 56.
次に、前記特定制御の一例について説明する。図4に示す具体例では、作業機械100は、作業現場WSに配置され、作業現場WSにおいて設定される作業対象の作業対象範囲WRに対して所定の作業を行う。所定の作業は、例えば、積込み作業であってもよく、整地作業であってもよく、他の作業であってもよい。コントローラ50は、作業機械100が前記所定の作業を行うように前記特定制御を行う。 Next, an example of the specific control will be described. In the specific example shown in Figure 4, the work machine 100 is placed at a work site WS and performs a predetermined task within a work target range WR set at the work site WS. The predetermined task may be, for example, loading work, leveling work, or some other task. The controller 50 performs the specific control so that the work machine 100 performs the predetermined task.
具体的には例えば、コントローラ50は、位置情報取得装置20から入力される点群データと、姿勢検出部30から入力される姿勢情報と、を用いて、例えば、自動運転制御または半自動運転制御を行う。コントローラ50は、データ記憶部56に予め記憶される前記自動運転データに対応する動作を作業機械100が行うように制御対象70に対して制御指令を出力する。 Specifically, for example, the controller 50 performs, for example, automatic driving control or semi-automatic driving control using the point cloud data input from the position information acquisition device 20 and the attitude information input from the attitude detection unit 30. The controller 50 outputs a control command to the control object 70 so that the work machine 100 performs an operation corresponding to the automatic driving data stored in advance in the data storage unit 56.
積込み作業は、複数の動作を含む。複数の動作は、例えば、図9の(A)に示す掘削動作と、図9の(B)に示す持上旋回動作と、図9の(C)に示す排土動作と、図9の(D)に示す復帰旋回動作と、を含んでいてもよい。掘削動作、持上旋回動作、排土動作および復帰旋回動作はこの順に行われる。 Loading operations include multiple operations. The multiple operations may include, for example, the excavation operation shown in Figure 9(A), the lifting and swinging operation shown in Figure 9(B), the soil discharge operation shown in Figure 9(C), and the return swinging operation shown in Figure 9(D). The excavation operation, lifting and swinging operation, soil discharge operation, and return swinging operation are performed in this order.
掘削動作は、作業現場WSにおける作業対象範囲WRを掘削するための動作である。掘削動作は、例えばブーム4が上がるブーム上げ動作、アーム5がブーム4に近づくアーム引き動作、および、バケット6がブーム4に近づくバケット引き動作を含んでいてもよい。作業対象範囲WRは、例えば図4において四角形の枠で示される目標掘削エリアであってもよい。 The excavation operation is an operation for excavating the work target range WR at the work site WS. The excavation operation may include, for example, a boom raising operation in which the boom 4 is raised, an arm pulling operation in which the arm 5 approaches the boom 4, and a bucket pulling operation in which the bucket 6 approaches the boom 4. The work target range WR may be, for example, the target excavation area indicated by the rectangular frame in Figure 4.
持上旋回動作は、掘削された土砂を保持するバケット6を作業対象範囲WRから排土エリアの真上に移動するための動作である。排土エリアは、例えばダンプトラック400の荷台であってもよく、作業現場WSに形成された排土のための領域であってもよい。持上旋回動作は、ブーム上げ動作および上部旋回体2が下部走行体1に対して旋回する旋回動作を含んでいてもよい。持上旋回動作は、アーム5がブームから遠ざかるアーム押し動作をさらに含んでいてもよい。 The lifting and rotating operation is an operation for moving the bucket 6 holding the excavated soil from the work area WR to directly above the soil discharge area. The soil discharge area may be, for example, the bed of the dump truck 400, or an area for soil discharge formed at the work site WS. The lifting and rotating operation may include a boom-raising operation and a rotating operation in which the upper rotating body 2 rotates relative to the lower traveling body 1. The lifting and rotating operation may further include an arm-pushing operation in which the arm 5 moves away from the boom.
排土動作は、バケット6から排土エリアに土砂を排土するための動作である。排土動作は、バケット6がブーム4から遠ざかるバケット押し動作(排土動作)を含んでいてもよい。排土動作は、アーム5がブーム4から遠ざかるアーム押し動作をさらに含んでいてもよい。 The earth discharge operation is an operation for discharging earth and sand from the bucket 6 to the earth discharge area. The earth discharge operation may include a bucket pushing operation (earth discharge operation) in which the bucket 6 moves away from the boom 4. The earth discharge operation may further include an arm pushing operation in which the arm 5 moves away from the boom 4.
復帰旋回動作は、バケット6を排土エリアの真上から作業対象範囲WRに戻すための動作である。復帰旋回動作は、ブーム4が下がるブーム下げ動作および上部旋回体2が下部走行体1に対して旋回する旋回動作を含んでいてもよい。復帰旋回動作は、アーム引き動作またはアーム押し動作をさらに含んでいてもよい。 The return swing operation is an operation for returning the bucket 6 from directly above the soil discharge area to the work range WR. The return swing operation may include a boom lowering operation in which the boom 4 is lowered, and a swing operation in which the upper swing structure 2 swings relative to the lower running structure 1. The return swing operation may further include an arm pulling operation or an arm pushing operation.
複数の動作を含む積込み作業に対応するティーチングデータは、データ記憶部56に記憶されていてもよく、作業機械100とは別の機器である外部装置200に記憶されていてもよい。 Teaching data corresponding to loading operations that include multiple operations may be stored in the data storage unit 56, or may be stored in an external device 200 that is separate from the work machine 100.
コントローラ50は、前記特定制御を行っているときに、位置情報取得装置20から入力される作業現場WSに関する作業現場情報(例えば点群データなどの3次元データ)に基づいて作業現場WSにおける作業目標位置TPの位置情報を取得できない場合に、位置情報取得装置20と作業目標位置TPとの間にある障害物OBを動かすための指令(シフト指令)を出力する。 When the controller 50 is performing the specific control, if it is unable to acquire position information of the work target position TP at the work site WS based on work site information (e.g., three-dimensional data such as point cloud data) relating to the work site WS input from the position information acquisition device 20, it outputs a command (shift command) to move an obstacle OB located between the position information acquisition device 20 and the work target position TP.
コントローラ50が前記作業現場情報に基づいて作業目標位置TPの前記位置情報を取得できないことと、位置情報取得装置20と作業目標位置TPとの間に障害物OBが存在することと、の間には相関がある。障害物OBが位置情報取得装置20と作業目標位置TPとの間に介在して位置情報取得装置20による作業目標位置TPの位置情報の取得を妨げるからである。本実施形態では、コントローラ50は、作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合に障害物OBを動かすためのシフト指令を出力するので、作業中に堆積する土砂などの障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる。 There is a correlation between the controller 50 being unable to acquire the position information of the work target position TP based on the work site information and the presence of an obstacle OB between the position information acquisition device 20 and the work target position TP. This is because the obstacle OB is between the position information acquisition device 20 and the work target position TP and prevents the position information acquisition device 20 from acquiring the position information of the work target position TP. In this embodiment, the controller 50 outputs a shift command to move the obstacle OB when it is unable to acquire the position information of the work target position TP based on the work site information, thereby reducing the decrease in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional cases.
具体的には、コントローラ50は、作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合にシフト指令を作業機械100の制御対象70に出力してもよい。この場合、制御対象70は、障害物OBが位置情報取得装置20と作業目標位置TPとの間に介在した状態が解消されるようにシフト指令に応じて作業装置3および上部旋回体2の少なくとも一方を作動させる。これにより、位置情報取得装置20による作業目標位置TPの位置情報の取得が可能になる。 Specifically, the controller 50 may output a shift command to the control object 70 of the work machine 100 when it is unable to acquire position information for the work target position TP based on the work site information. In this case, the control object 70 operates at least one of the work implement 3 and the upper rotating body 2 in response to the shift command so as to eliminate the state in which the obstacle OB is interposed between the position information acquisition device 20 and the work target position TP. This makes it possible for the position information acquisition device 20 to acquire position information for the work target position TP.
シフト指令は、位置情報取得装置20と作業目標位置TPとを結ぶ直線上にある障害物OBを前記直線から外れた位置に動かすための指令であってもよい。シフト指令は、障害物OBが下部走行体1から遠ざかる方向にバケット6(先端アタッチメント)が障害物OBを押し出すように作業装置3の動作を制御するための指令であってもよい。具体的には、シフト指令は、障害物OBが下部走行体1から遠ざかる方向にバケット6(先端アタッチメント)が障害物OBを押し出すことにより障害物OBを作業対象範囲WR内に戻すように作業装置3の動作を制御するための指令であってもよい。シフト指令は、障害物OBが下部走行体1に近づく方向にバケット6(先端アタッチメント)が障害物OBを引き寄せるように作業装置3の動作を制御するための指令であってもよい。シフト指令は、バケット6(先端アタッチメント)が障害物OBを右方または左方に押すように上部旋回体2を右旋回または左旋回させるための指令であってもよい。 The shift command may be a command to move an obstacle OB located on a straight line connecting the position information acquisition device 20 and the work target position TP to a position off said straight line. The shift command may be a command to control the operation of the work device 3 so that the bucket 6 (tip attachment) pushes the obstacle OB in a direction that moves the obstacle OB away from the lower traveling structure 1. Specifically, the shift command may be a command to control the operation of the work device 3 so that the bucket 6 (tip attachment) pushes the obstacle OB in a direction that moves the obstacle OB away from the lower traveling structure 1, thereby returning the obstacle OB to within the work target range WR. The shift command may be a command to control the operation of the work device 3 so that the bucket 6 (tip attachment) pulls the obstacle OB in a direction that moves the obstacle OB closer to the lower traveling structure 1. The shift command may be a command to rotate the upper rotating structure 2 to the right or left so that the bucket 6 (tip attachment) pushes the obstacle OB to the right or left.
コントローラ50は、演算処理装置とメモリとを含むコンピュータを備える。図2に示すように、コントローラ50は、例えば、目標設定部51と、位置情報判定部52と、障害物判定部53と、制御指令出力部54と、目標変更部55と、データ記憶部56と、を含んでいてもよい。コントローラ50は、メモリに記憶されるプログラムを演算処理装置が実行することにより、目標設定部51、位置情報判定部52、障害物判定部53、制御指令出力部54、目標変更部55、および、データ記憶部56のそれぞれの機能を実現する。 The controller 50 comprises a computer including an arithmetic processing unit and memory. As shown in FIG. 2, the controller 50 may include, for example, a target setting unit 51, a position information determination unit 52, an obstacle determination unit 53, a control command output unit 54, a target change unit 55, and a data storage unit 56. The controller 50 realizes the functions of the target setting unit 51, the position information determination unit 52, the obstacle determination unit 53, the control command output unit 54, the target change unit 55, and the data storage unit 56 by the arithmetic processing unit executing a program stored in the memory.
目標設定部51は、作業対象範囲WRを設定してもよい。目標設定部51は、少なくとも一つの作業目標位置TPを設定してもよい。本実施形態では、目標設定部51は、複数の作業目標位置TPを設定する。目標設定部51は、複数の作業目標位置TPの中から、次の動作の対象となる作業目標位置TPを設定してもよい。 The target setting unit 51 may set a work target range WR. The target setting unit 51 may set at least one work target position TP. In this embodiment, the target setting unit 51 sets multiple work target positions TP. The target setting unit 51 may set a work target position TP that will be the target of the next operation from among the multiple work target positions TP.
位置情報判定部52は、位置情報取得装置20から入力される作業現場WSに関する作業現場情報に基づいて作業現場WSにおける作業目標位置TPの位置情報を取得できたか否かを判定する。 The position information determination unit 52 determines whether or not position information for the work target position TP at the work site WS has been acquired based on work site information about the work site WS input from the position information acquisition device 20.
障害物判定部53は、位置情報判定部52が前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合に、位置情報取得装置20と作業目標位置TPとの間に物体(障害物OB)があるか否かを判定する。 If the position information determination unit 52 is unable to acquire position information for the work target position TP based on the work site information, the obstacle determination unit 53 determines whether or not an object (obstacle OB) is present between the position information acquisition device 20 and the work target position TP.
制御指令出力部54は、作業機械100の制御対象70に指令を出力する。具体的には、制御指令出力部54は、位置情報取得装置20と作業目標位置TPとの間に障害物OBがある場合に、当該障害物OBを動かすためのシフト指令を制御対象70に出力する。また、制御指令出力部54は、後述する特定制御に対応する指令である特定指令を制御対象70に出力する。具体的には、特定制御が自動運転制御または半自動運転制御である場合には、制御指令出力部54は、作業機械100の自動運転制御または半自動運転制御における一連の動作に対応する指令である自動運転指令を制御対象70に出力する。 The control command output unit 54 outputs commands to the control object 70 of the work machine 100. Specifically, if there is an obstacle OB between the position information acquisition device 20 and the work target position TP, the control command output unit 54 outputs a shift command to the control object 70 to move the obstacle OB. The control command output unit 54 also outputs a specific command, which is a command corresponding to the specific control described below, to the control object 70. Specifically, if the specific control is automatic driving control or semi-automatic driving control, the control command output unit 54 outputs an automatic driving command, which is a command corresponding to a series of operations in the automatic driving control or semi-automatic driving control of the work machine 100, to the control object 70.
目標変更部55は、その時点で設定されている作業目標位置TPを、別の作業目標位置TPに変更する。すなわち、目標変更部55は、作業目標位置TPを変更する。 The target change unit 55 changes the task target position TP set at that time to a different task target position TP. In other words, the target change unit 55 changes the task target position TP.
データ記憶部56は、特定制御のためのデータである特定データを記憶する。特定データは、例えば、自動運転または半自動運転のための自動運転データであってもよい。自動運転データは、例えば、作業機械100が所定の動作を行うようにコントローラ50が制御対象70に対して出力する制御指令を演算するために用いられる。自動運転データは、例えば、キャブ2B内の操作装置または遠隔操作装置に対してオペレータが与える操作に応じたティーチングデータであってもよく、種々の情報端末を用いて作成されたデータであってもよい。 The data storage unit 56 stores specific data, which is data for specific control. The specific data may be, for example, automatic driving data for automatic or semi-automatic driving. The automatic driving data is used, for example, to calculate control commands that the controller 50 outputs to the controlled object 70 so that the work machine 100 performs a specified operation. The automatic driving data may be, for example, teaching data corresponding to operations given by the operator to the operating device in the cab 2B or the remote operating device, or may be data created using various information terminals.
位置情報取得装置20の位置、作業対象範囲WR、複数の作業目標位置TPなどのように特定制御に必要な種々の位置のそれぞれは、位置情報取得装置20を基準とする座標系(取得装置座標系)における座標によって表される情報であってもよく、作業機械100を基準とする座標系(機械座標系)における座標によって表される情報であってもよく、作業現場WSの特定位置を基準とする座標系(現場座標系)における座標によって表される情報であってもよく、グローバル座標系における座標によって表される情報であってもよい。コントローラ50は、これらのうちの何れかの座標系における位置情報を他の座標系における位置情報に変換可能なように構成されていてもよい。 Each of the various positions required for specific control, such as the position of the position information acquisition device 20, the work target range WR, and multiple work target positions TP, may be information represented by coordinates in a coordinate system based on the position information acquisition device 20 (acquisition device coordinate system), information represented by coordinates in a coordinate system based on the work machine 100 (machine coordinate system), information represented by coordinates in a coordinate system based on a specific position at the work site WS (site coordinate system), or information represented by coordinates in a global coordinate system. The controller 50 may be configured to be able to convert position information in any of these coordinate systems into position information in another coordinate system.
以下の具体例では、コントローラ50は、位置情報取得装置20から入力される取得装置座標系における点群データを、予め規定される基準座標系における点群データに変換するように構成されている。前記基準座標系は、前記機械座標系であってもよく、前記現場座標系であってもよく、前記グローバル座標系であってもよく、他の座標系であってもよい。 In the following specific example, the controller 50 is configured to convert point cloud data in the acquisition device coordinate system input from the position information acquisition device 20 into point cloud data in a predefined reference coordinate system. The reference coordinate system may be the machine coordinate system, the on-site coordinate system, the global coordinate system, or another coordinate system.
前記基準座標系の原点Oは、例えば作業機械100を基準とする特定位置に設定されていてもよい。具体的には、前記基準座標系の原点Oは、例えば、旋回軸Z上の何れかの位置であってもよい。より具体的には、前記基準座標系の原点Oは、旋回軸Zと地面の交点であってもよい。また、前記基準座標系の原点Oは、例えば、旋回軸Z上で、かつ、下部走行体1と上部旋回体2の間の位置(図1に示す原点O)であってもよい。 The origin O of the reference coordinate system may be set at a specific position, for example, based on the work machine 100. Specifically, the origin O of the reference coordinate system may be, for example, any position on the rotation axis Z. More specifically, the origin O of the reference coordinate system may be the intersection of the rotation axis Z and the ground. Furthermore, the origin O of the reference coordinate system may be, for example, a position on the rotation axis Z between the lower traveling body 1 and the upper rotating body 2 (origin O shown in Figure 1).
本実施形態では、前記基準座標系は3次元の座標系である。この場合、前記基準座標系は、例えば、左右方向に平行なx軸と、前後方向に平行なy軸と、鉛直方向に平行なz軸とを用いて規定される直交座標系であってもよい。ただし、前記基準座標系は、上記の具体例に限られず、種々の態様を採用可能である。 In this embodiment, the reference coordinate system is a three-dimensional coordinate system. In this case, the reference coordinate system may be, for example, a Cartesian coordinate system defined using an x-axis parallel to the left-right direction, a y-axis parallel to the front-back direction, and a z-axis parallel to the vertical direction. However, the reference coordinate system is not limited to the above specific example, and various other aspects can be adopted.
位置情報取得装置20の座標は、例えば、位置情報取得装置20の視点の座標であってもよく、位置情報取得装置20の他の部位の座標であってもよい。コントローラ50は、作業機械100の特定位置(例えば原点O)に対する位置情報取得装置20の相対位置に関する情報を予め記憶していてもよい。具体的には例えば、コントローラ50は、作業機械100の特定位置を原点とする前記基準座標系における位置情報取得装置20の座標を記憶していてもよい。位置情報取得装置20の座標は、例えば、位置情報取得装置20の視点の座標であってもよく、位置情報取得装置20の他の部位の座標であってもよい。 The coordinates of the position information acquisition device 20 may be, for example, the coordinates of the viewpoint of the position information acquisition device 20, or the coordinates of another part of the position information acquisition device 20. The controller 50 may pre-store information regarding the relative position of the position information acquisition device 20 with respect to a specific position of the work machine 100 (for example, origin O). Specifically, for example, the controller 50 may store the coordinates of the position information acquisition device 20 in the reference coordinate system whose origin is the specific position of the work machine 100. The coordinates of the position information acquisition device 20 may be, for example, the coordinates of the viewpoint of the position information acquisition device 20, or the coordinates of another part of the position information acquisition device 20.
制御対象70は、コントローラ50によって制御される対象である。制御対象70は、コントローラ50から入力される操作量である制御操作量(制御入力)に応じて出力が変化する。制御対象70は、流量調節器と、前記複数のアクチュエータの少なくとも一つと、を含んでいてもよい。前記流量調節器は、前記複数のアクチュエータの少なくとも一つのアクチュエータに供給される作動油の方向および流量を、コントローラ50から入力される制御操作量に応じて調節する。すなわち、コントローラ50が前記流量調節器に制御操作量を入力すると、前記流量調節器がコントローラ50から入力される当該制御操作量に応じて作動し、これにより、前記油圧ポンプからの作動油が前記複数のアクチュエータの少なくとも一つに供給され、当該アクチュエータが作動する。 The controlled object 70 is an object controlled by the controller 50. The output of the controlled object 70 changes in accordance with a control operation amount (control input), which is an operation amount input from the controller 50. The controlled object 70 may include a flow rate regulator and at least one of the plurality of actuators. The flow rate regulator adjusts the direction and flow rate of hydraulic oil supplied to at least one of the plurality of actuators in accordance with the control operation amount input from the controller 50. In other words, when the controller 50 inputs a control operation amount to the flow rate regulator, the flow rate regulator operates in accordance with the control operation amount input from the controller 50, thereby supplying hydraulic oil from the hydraulic pump to at least one of the plurality of actuators and operating that actuator.
前記流量調節器は、例えば、ブーム制御器71と、アーム制御器72と、先端アタッチメント制御器73と、旋回制御器74と、を含んでいてもよい。 The flow rate regulator may include, for example, a boom controller 71, an arm controller 72, a tip attachment controller 73, and a swing controller 74.
ブーム制御器71は、ブームシリンダ7に供給される作動油の方向および流量を調節するためのスプールと、一対のパイロットポートと、一対の比例弁と、を含んでいてもよい。アーム制御器72は、アームシリンダ8に供給される作動油の方向および流量を調節するためのスプールと、一対のパイロットポートと、一対の比例弁と、を含んでいてもよい。先端アタッチメント制御器73は、先端アタッチメントシリンダ9に供給される作動油の方向および流量を調節するためのスプールと、一対のパイロットポートと、一対の比例弁と、を含んでいてもよい。旋回制御器74は、旋回モータ11に供給される作動油の方向および流量を調節するためのスプールと、一対のパイロットポートと、一対の比例弁と、を含んでいてもよい。各スプールは、そのスプールに対応するパイロットポートにパイロット圧が入力されることにより作動し、当該スプールに対応するアクチュエータに作動油が供給されることを許容する。 The boom controller 71 may include a spool for adjusting the direction and flow rate of hydraulic oil supplied to the boom cylinder 7, a pair of pilot ports, and a pair of proportional valves. The arm controller 72 may include a spool for adjusting the direction and flow rate of hydraulic oil supplied to the arm cylinder 8, a pair of pilot ports, and a pair of proportional valves. The tip attachment controller 73 may include a spool for adjusting the direction and flow rate of hydraulic oil supplied to the tip attachment cylinder 9, a pair of pilot ports, and a pair of proportional valves. The swing controller 74 may include a spool for adjusting the direction and flow rate of hydraulic oil supplied to the swing motor 11, a pair of pilot ports, and a pair of proportional valves. Each spool is operated by inputting pilot pressure to the pilot port corresponding to that spool, allowing hydraulic oil to be supplied to the actuator corresponding to that spool.
各比例弁は、その比例弁に対応するスプールのパイロットポートと図略のパイロットポンプとをつなぐ油路に配置され、前記パイロットポートに入力されるパイロット圧を調節する。言い換えると、各比例弁は、コントローラ50から入力される制御操作量(例えば電流値)に応じた二次圧を出力し、その二次圧は、当該比例弁に対応するパイロットポートにパイロット圧として入力される。各比例弁は、当該比例弁に対応するパイロットポートに入力されるパイロット圧をコントローラ50から入力される制御操作量に応じた大きさに調節する。 Each proportional valve is arranged in an oil passage connecting the pilot port of the spool corresponding to that proportional valve with a pilot pump (not shown), and adjusts the pilot pressure input to that pilot port. In other words, each proportional valve outputs a secondary pressure corresponding to the control operation amount (e.g., current value) input from the controller 50, and that secondary pressure is input as pilot pressure to the pilot port corresponding to that proportional valve. Each proportional valve adjusts the pilot pressure input to the pilot port corresponding to that proportional valve to a magnitude corresponding to the control operation amount input from the controller 50.
作業機械100は、通信器82を備え、外部装置200は、図略の通信器を備えるので、作業機械100と外部装置200は、例えばインターネット、携帯電話網などの種々のネットワークを利用した無線または有線の通信によって互いにデータの送受信を行うことが可能である。 The work machine 100 is equipped with a communication device 82, and the external device 200 is equipped with a communication device (not shown), so the work machine 100 and the external device 200 can send and receive data to and from each other via wireless or wired communication using various networks such as the Internet or a mobile phone network.
外部装置200は、タブレット型コンピュータ(いわゆるタブレット)、スマートフォン、ラップトップパーソナルコンピュータ、デスクトップパーソナルコンピュータなどの情報端末であってもよい。外部装置200は、作業機械100から離れた遠隔地において作業機械100を遠隔操作するための遠隔操作装置であってもよい。また、外部装置200は、作業機械100による作業を管理するためのサーバなどの管理装置であってもよい。また、外部装置200は、前記ティーチングデータなどのデータを格納する外部記憶装置であってもよい。また、外部装置200は、インターネットなどのネットワーク上でサービスとして提供されるクラウドサービスにおけるコンピュータであってもよい。作業機械システム300は、複数の外部装置200を備えていてもよい。 The external device 200 may be an information terminal such as a tablet computer (a so-called tablet), a smartphone, a laptop personal computer, or a desktop personal computer. The external device 200 may also be a remote control device for remotely controlling the work machine 100 at a remote location away from the work machine 100. The external device 200 may also be a management device such as a server for managing work performed by the work machine 100. The external device 200 may also be an external storage device that stores data such as the teaching data. The external device 200 may also be a computer in a cloud service provided as a service over a network such as the Internet. The work machine system 300 may be equipped with multiple external devices 200.
図3は、作業機械制御装置40のコントローラ50が行う演算処理を示すフローチャートである。コントローラ50は、自動運転制御、半自動運転制御、遠隔操作制御などの特定制御とともに図3に示すような演算処理を行う。なお、以下では、位置情報取得装置20が作業現場の3次元データ(点群データ)を取得するLiDARである場合を例に挙げて説明する。 Figure 3 is a flowchart showing the calculation processing performed by the controller 50 of the work machine control device 40. The controller 50 performs the calculation processing shown in Figure 3 along with specific controls such as automatic driving control, semi-automatic driving control, and remote operation control. Note that the following explanation takes as an example a case where the position information acquisition device 20 is a LiDAR that acquires three-dimensional data (point cloud data) of the work site.
コントローラ50の目標設定部51は、初期設定を行う(ステップS11)。初期設定は、作業現場WSにおける作業対象範囲WRの設定と、複数の作業目標位置TPの設定と、を含んでいてもよい。初期設定は、複数の作業目標位置TPに対する作業を繰り返す回数の設定をさらに含んでいてもよい。 The target setting unit 51 of the controller 50 performs initial settings (step S11). The initial settings may include setting a work target range WR at the work site WS and setting multiple work target positions TP. The initial settings may further include setting the number of times to repeat work for the multiple work target positions TP.
例えば図4に示すように作業対象範囲WRが四角形である場合、コントローラ50の目標設定部51は、四角形の4つのコーナーA,B,C,Dのうちの3つ以上のコーナーの位置を特定することにより、作業対象範囲WRを設定してもよい。コーナーの位置は、例えばオペレータが作業機械100のキャブ2B内の操作装置または外部装置200(例えば遠隔操作装置)を用いてバケット6の先端をコーナーに対応する位置に配置した状態で、オペレータが作業機械100の入力器81または外部装置200(例えば遠隔操作装置)の図略の入力器に所定の入力を行うことで特定されてもよい。コントローラ50の目標設定部51は、姿勢検出部30から入力される姿勢情報に基づいてバケット6の先端の位置を演算することができる。また、コーナーの位置は、例えば作業関係者が外部装置200に当該コーナーの座標を入力することで特定されてもよい。 For example, if the work target range WR is a rectangle as shown in FIG. 4 , the target setting unit 51 of the controller 50 may set the work target range WR by identifying the positions of three or more of the four corners A, B, C, and D of the rectangle. The position of the corner may be identified, for example, by the operator using an operation device in the cab 2B of the work machine 100 or an external device 200 (e.g., a remote control device) to position the tip of the bucket 6 at a position corresponding to the corner, and then making a specified input to the input device 81 of the work machine 100 or an input device (not shown) of the external device 200 (e.g., a remote control device). The target setting unit 51 of the controller 50 can calculate the position of the tip of the bucket 6 based on the attitude information input from the attitude detection unit 30. The position of the corner may also be identified, for example, by a person involved in the work inputting the coordinates of the corner into the external device 200.
コントローラ50の目標設定部51は、特定された作業対象範囲WR内において、複数の作業目標位置TPを設定する。コントローラ50の目標設定部51が設定する複数の作業目標位置TPのそれぞれは、当該作業目標位置TPのx座標とy座標であってもよい。 The target setting unit 51 of the controller 50 sets multiple work target positions TP within the identified work range WR. Each of the multiple work target positions TP set by the target setting unit 51 of the controller 50 may be the x coordinate and y coordinate of the work target position TP.
コントローラ50の目標設定部51は、作業関係者による複数の作業目標位置TPの設定のための入力に基づいて複数の作業目標位置TPを設定してもよい。当該入力は、外部装置200に対して行われてもよく、作業機械100の入力器81に対して行われてもよい。また、コントローラ50の目標設定部51は、作業目標位置TPの設定のために予め記憶されているアルゴリズムと、作業対象範囲WRの情報と、に基づいて、複数の作業目標位置TPを設定してもよい。図4に示す具体例では、コントローラ50の目標設定部51は、作業対象範囲WR内の15個の作業目標位置TPを設定し、これらの作業目標位置TPにおいて掘削動作を行う順番を設定する。図4に示す具体例では、コントローラ50の目標設定部51は、15個の作業目標位置TPの1から15までの番号の順に掘削動作の順番を設定する。ただし、掘削動作の順番は、図4に示す具体例に限られない。 The target setting unit 51 of the controller 50 may set multiple work target positions TP based on input for setting multiple work target positions TP by those involved in the work. This input may be made to the external device 200 or to the input device 81 of the work machine 100. The target setting unit 51 of the controller 50 may also set multiple work target positions TP based on a pre-stored algorithm for setting the work target positions TP and information about the work target range WR. In the specific example shown in FIG. 4, the target setting unit 51 of the controller 50 sets 15 work target positions TP within the work target range WR and sets the order in which excavation operations will be performed at these work target positions TP. In the specific example shown in FIG. 4, the target setting unit 51 of the controller 50 sets the order of excavation operations in the order of the numbers 1 to 15 of the 15 work target positions TP. However, the order of excavation operations is not limited to the specific example shown in FIG. 4.
コントローラ50の位置情報判定部52は、位置情報取得装置20から入力される作業現場WSに関する3次元データ(点群データ)に基づいて、その時点で設定されている作業目標位置TP(例えば1番の作業目標位置TP)の位置情報を取得できたか否かを判定する(ステップS12)。具体的には例えば、コントローラ50の位置情報判定部52は、前記3次元データ(点群データ)に基づいて、その時点で設定されている作業目標位置TPのx座標およびy座標における地面の高さ(z座標)を取得できたか否かを判定してもよい。コントローラ50の位置情報判定部52は、その時点で設定されている作業目標位置TPのx座標およびy座標におけるデータの有無を判定してもよい。 The position information determination unit 52 of the controller 50 determines whether or not it has been able to acquire position information for the currently set work target position TP (e.g., work target position TP No. 1) based on the three-dimensional data (point cloud data) related to the work site WS input from the position information acquisition device 20 (step S12). Specifically, for example, the position information determination unit 52 of the controller 50 may determine whether or not it has been able to acquire the ground height (z coordinate) in the x and y coordinates of the currently set work target position TP based on the three-dimensional data (point cloud data). The position information determination unit 52 of the controller 50 may also determine whether or not there is data in the x and y coordinates of the currently set work target position TP.
図5に示すように、位置情報取得装置20と1番の作業目標位置TPとの間に障害物OBが存在しない場合、前記3次元データ(点群データ)には、1番の作業目標位置TPに対応するデータが含まれている。一方、図6に示すように位置情報取得装置20と1番の作業目標位置TPとの間に障害物OBが存在する場合、例えばLiDARなどの位置情報取得装置20から照射される光が障害物OBによって遮られるため、前記3次元データ(点群データ)には、1番の作業目標位置TPに対応するデータが含まれていない。従って、コントローラ50の位置情報判定部52は、位置情報取得装置20から入力される前記3次元データ(点群データ)に基づいて、その時点で設定されている作業目標位置TPの位置情報を取得できたか否かを判定することができる。 As shown in FIG. 5, if there is no obstacle OB between the position information acquisition device 20 and the first work target position TP, the three-dimensional data (point cloud data) includes data corresponding to the first work target position TP. On the other hand, as shown in FIG. 6, if there is an obstacle OB between the position information acquisition device 20 and the first work target position TP, the light emitted from the position information acquisition device 20, such as a LiDAR, is blocked by the obstacle OB, and therefore the three-dimensional data (point cloud data) does not include data corresponding to the first work target position TP. Therefore, the position information determination unit 52 of the controller 50 can determine whether or not the position information of the currently set work target position TP has been acquired, based on the three-dimensional data (point cloud data) input from the position information acquisition device 20.
コントローラ50の位置情報判定部52が、1番の作業目標位置TPの位置情報を取得できない場合(ステップS12においてNO)、コントローラ50は、ステップS18以降の処理を行う。ステップS18以降の処理については後述する。 If the position information determination unit 52 of the controller 50 cannot obtain the position information of the first work target position TP (NO in step S12), the controller 50 performs the processing from step S18 onwards. The processing from step S18 onwards will be described later.
コントローラ50の位置情報判定部52は、1番の作業目標位置TPの位置情報を取得できた場合(ステップS12においてYES)、特定制御(例えば自動運転制御)における次の作業目標位置を1番の作業目標位置TPに設定する(ステップS13)。そして、コントローラ50の制御指令出力部54は、データ記憶部56に記憶された自動運転データに基づいて、1番の作業目標位置TPにおいて掘削動作およびこれに付随する動作である持上旋回動作、排土動作および復帰旋回動作が行われるように制御対象70に制御指令を出力する(ステップS14およびステップS15)。ステップS14の掘削動作は、その時点で設定されている作業目標位置TPを基準(動作の始点、動作の中心または動作の終点)とする所定の範囲にわたってバケット6が所定の方向(例えば後方)に移動するような動作である。 If the position information determination unit 52 of the controller 50 is able to obtain the position information of the first work target position TP (YES in step S12), it sets the next work target position in specific control (e.g., automatic driving control) to the first work target position TP (step S13). Then, the control command output unit 54 of the controller 50 outputs control commands to the control object 70 based on the automatic driving data stored in the data storage unit 56 so that an excavation operation and the associated operations of lifting rotation, soil discharge, and return rotation are performed at the first work target position TP (steps S14 and S15). The excavation operation in step S14 is an operation in which the bucket 6 moves in a predetermined direction (e.g., backward) over a predetermined range with the work target position TP set at that time as the reference (start point of the operation, center of the operation, or end point of the operation).
コントローラ50の位置情報判定部52は、一連の作業が完了したか否かを判定する(ステップS16)。一連の作業が完了したか否かの判定は、例えば、1番から15番までの作業目標位置TPにおける掘削動作およびこれに付随する動作が、前記初期設定において設定される繰り返し回数(例えば3回)だけ、繰り返すことが完了したか否かであってもよい。また、一連の作業が完了したか否かの判定は、例えば、その時点で掘削された土量が所定の値以上に達したか否かであってもよい。 The position information determination unit 52 of the controller 50 determines whether the series of tasks has been completed (step S16). The determination of whether the series of tasks has been completed may be, for example, whether the excavation operations and associated operations at task target positions TP 1 through 15 have been repeated the number of times (e.g., three times) set in the initial settings. Furthermore, the determination of whether the series of tasks has been completed may be, for example, whether the amount of soil excavated at that point has reached or exceeded a predetermined value.
一連の作業が完了している場合(ステップS16においてYES)、コントローラ50は、特定制御を終了する。一方、一連の作業が完了していない場合(ステップS16においてNO)、コントローラ50は、作業目標位置TPの設定を変更する(ステップS17)。具体的には、コントローラ50は、次の作業目標位置TPを、例えば1番の作業目標位置TPから2番の作業目標位置TPに変更する。そして、コントローラ50は、ステップS12以降の処理を再び行う。 If the series of tasks is complete (YES in step S16), the controller 50 ends the specific control. On the other hand, if the series of tasks is not complete (NO in step S16), the controller 50 changes the setting of the task target position TP (step S17). Specifically, the controller 50 changes the next task target position TP, for example, from task target position TP No. 1 to task target position TP No. 2. The controller 50 then performs the processing from step S12 onwards again.
一方、コントローラ50の位置情報判定部52がその時点で設定されている作業目標位置TP(例えば1番の作業目標位置TP)の位置情報を取得できない場合(ステップS12においてNO)、コントローラ50の障害物判定部53は、位置情報取得装置20と1番目の作業目標位置TPとの間に物体(障害物OB)があるか否かを判定する(ステップS18)。具体的には、ステップS18において、コントローラ50の障害物判定部53は、位置情報取得装置20と1番目の作業目標位置TPとの間の領域に、所定高さTh以上の物体があるか否かを判定してもよい。 On the other hand, if the position information determination unit 52 of the controller 50 cannot acquire position information for the currently set work target position TP (e.g., the first work target position TP) (NO in step S12), the obstacle determination unit 53 of the controller 50 determines whether or not there is an object (obstacle OB) between the position information acquisition device 20 and the first work target position TP (step S18). Specifically, in step S18, the obstacle determination unit 53 of the controller 50 may determine whether or not there is an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the first work target position TP.
コントローラ50は、前記3次元データ(点群データ)に基づいて作業目標位置TPの位置情報を取得できない場合で(ステップS12においてNO)、かつ、位置情報取得装置20が当該位置情報取得装置20と作業目標位置TPとの間の領域に所定高さTh以上の物体を検出する場合に(ステップS18においてYES)、前記シフト指令を出力する(ステップS19)。 If the controller 50 cannot acquire position information for the work target position TP based on the three-dimensional data (point cloud data) (NO in step S12), and if the position information acquisition device 20 detects an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP (YES in step S18), it outputs the shift command (step S19).
コントローラ50の制御指令出力部54は、例えば、障害物OBが下部走行体1から遠ざかる方向にバケット6が障害物OBを押し出すことにより障害物OBを作業対象範囲WR内に戻すように作業装置3の動作を制御する指令をシフト指令として制御対象70に出力してもよい。コントローラ50は、シフト指令に対応する作業装置3の動作が完了すると、ステップS12以降の処理を再び行う。 The control command output unit 54 of the controller 50 may output a command to the control object 70 as a shift command to control the operation of the work device 3 so that, for example, the bucket 6 pushes the obstacle OB in a direction that moves the obstacle OB away from the undercarriage 1, thereby returning the obstacle OB to within the work target range WR. When the operation of the work device 3 corresponding to the shift command is completed, the controller 50 again performs the processing from step S12 onwards.
本実施形態では、コントローラ50は、上記の2つの条件(コントローラ50が前記3次元データに基づいて作業目標位置TPの位置情報を取得できず、かつ、位置情報取得装置20が当該位置情報取得装置20と作業目標位置TPとの間の領域に所定高さTh以上の物体を検出するという条件)が満たされる場合に前記シフト指令を出力し、前記2つの条件が満たされない場合には前記シフト指令を出力しない。これにより、位置情報取得装置20と作業目標位置TPとの間の領域に障害物OBが存在することの判定精度を高めることができる。 In this embodiment, the controller 50 outputs the shift command when the above two conditions are met (the controller 50 is unable to acquire position information for the work target position TP based on the three-dimensional data, and the position information acquisition device 20 detects an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP), and does not output the shift command when the above two conditions are not met. This improves the accuracy of determining that an obstacle OB is present in the area between the position information acquisition device 20 and the work target position TP.
所定高さThは、例えば図5~図7に示すように、作業機械100が配置される地面からの高さ(予め設定される高さ)であってもよく、図8に示す変形例のように規定される高さであってもよく、これら以外の手法により規定される高さであってもよい。図8に示す変形例では、所定高さThは、位置情報取得装置20と作業目標位置TPとを結ぶ仮想直線に対応する高さである。この場合、所定高さTh以上の領域は、当該仮想直線上および当該仮想直線よりも上の領域(図8において一点鎖線のハッチングが記載されている領域)である。 The predetermined height Th may be the height from the ground where the work machine 100 is placed (a height that is set in advance), as shown in Figures 5 to 7, or it may be a height that is determined as in the modified example shown in Figure 8, or it may be a height that is determined by some other method. In the modified example shown in Figure 8, the predetermined height Th is a height that corresponds to an imaginary line connecting the position information acquisition device 20 and the work target position TP. In this case, the area above the predetermined height Th is the area on and above that imaginary line (the area hatched with dashed dotted lines in Figure 8).
一方、コントローラ50は、前記3次元データ(点群データ)に基づいて作業目標位置TP(例えば1番の作業目標位置TP)の位置情報を取得できない場合で(ステップS12においてNO)、かつ、位置情報取得装置20が当該位置情報取得装置20と作業目標位置TPとの間の領域に所定高さTh以上の物体を検出しない場合には(ステップS18においてNO)、前記シフト指令を出力せず、ステップS20の処理を行う。 On the other hand, if the controller 50 cannot acquire position information for the work target position TP (for example, work target position TP No. 1) based on the three-dimensional data (point cloud data) (NO in step S12), and if the position information acquisition device 20 does not detect an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP (NO in step S18), the controller 50 does not output the shift command and performs the processing of step S20.
ステップS20において、コントローラ50は、複数の作業目標位置TPのうちの他の作業目標位置TP(例えば2番以降の作業目標位置TP)についても、前記3次元データ(点群データ)に基づいて位置情報を取得できないかを判定する。コントローラ50は、複数の作業目標位置TPの全ての位置情報を前記3次元データ(点群データ)に基づいて取得できない場合(ステップS20においてYES)、作業を終了する。 In step S20, the controller 50 determines whether it is possible to acquire position information for other work target positions TP (for example, work target positions TP number 2 and onward) among the multiple work target positions TP based on the three-dimensional data (point cloud data). If the controller 50 is unable to acquire position information for all of the multiple work target positions TP based on the three-dimensional data (point cloud data) (YES in step S20), it ends the operation.
複数の作業目標位置TPの全ての位置情報の取得ができない場合、作業目標位置TPの変更では対応できない可能性がある。本実施形態では、コントローラ50は、複数の作業目標位置TPの全ての位置情報を前記3次元データに基づいて取得できない場合には、作業を終了する、または、作業機械100の位置を変更するので、無駄な作業が継続されることを抑制でき、作業の生産性の低下を抑制できる。 If it is not possible to obtain position information for all of the multiple work target positions TP, changing the work target positions TP may not be enough. In this embodiment, if it is not possible to obtain position information for all of the multiple work target positions TP based on the three-dimensional data, the controller 50 ends the work or changes the position of the work machine 100, thereby preventing unnecessary work from being continued and reducing declines in work productivity.
コントローラ50は、複数の作業目標位置TPの少なくとも一つの位置情報を前記3次元データ(点群データ)に基づいて取得できる場合(ステップS20においてNO)、コントローラ50は、作業目標位置TPの設定を変更し(ステップS21)、ステップS12以降の処理を再び行う。 If the controller 50 can obtain position information for at least one of the multiple work target positions TP based on the three-dimensional data (point cloud data) (NO in step S20), the controller 50 changes the setting of the work target position TP (step S21) and performs the processing from step S12 onwards again.
具体的には、コントローラ50は、前記3次元データに基づいて作業目標位置TPの位置情報を取得できない場合で(ステップS12においてNO)、かつ、位置情報取得装置20が当該位置情報取得装置20と作業目標位置TPとの間の領域に所定高さTh以上の物体を検出しない場合に(ステップS18においてNO)、土砂などの堆積物である障害物OBが位置情報取得装置20と作業目標位置TPとの間の領域に存在しない可能性、または、当該堆積物が存在したとしても多量には存在しない可能性がある。このような場合には、例えば図7に示すように、前記堆積物以外の物が位置情報取得装置20と作業目標位置TPとの間の領域に存在する可能性がある。具体的には例えば、作業対象範囲WRにおける掘削がある程度進行して、その時点で設定されている作業目標位置TP(例えば1番の作業目標位置TP)と作業機械100が配置される地面との高低差が大きくなることに起因して、位置情報取得装置20と作業目標位置TPとの間の領域に前記地面が介在する状態になっている可能性がある。この場合、コントローラ50は、前記シフト指令の出力(ステップS19)ではなく、作業目標位置TPを変更する(ステップS21)ので、変更後の作業目標位置TP(例えば、6番~10番の何れかの作業目標位置TP)において作業が円滑に継続される。 Specifically, if the controller 50 cannot acquire the position information of the work target position TP based on the three-dimensional data (NO in step S12), and if the position information acquisition device 20 does not detect an object of a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP (NO in step S18), it is possible that an obstacle OB, such as a deposit of soil or sand, is not present in the area between the position information acquisition device 20 and the work target position TP, or that even if such deposit is present, it is not present in large quantities. In such a case, as shown in FIG. 7, for example, an object other than the deposit may be present in the area between the position information acquisition device 20 and the work target position TP. Specifically, for example, if excavation in the work target range WR has progressed to a certain extent, the difference in elevation between the work target position TP set at that time (e.g., work target position TP No. 1) and the ground on which the work machine 100 is located may become large, resulting in the ground being present in the area between the position information acquisition device 20 and the work target position TP. In this case, the controller 50 changes the work target position TP (step S21) rather than outputting the shift command (step S19), allowing work to continue smoothly at the changed work target position TP (for example, any of work target positions TP 6 to 10).
以上説明したように、本開示によれば、作業中に堆積する土砂などの障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる作業機械制御装置40、作業機械100、外部装置200、作業機械システム300および作業性改善方法が提供される。本開示は、以下の第1~第9の態様を含む。 As explained above, the present disclosure provides a work machine control device 40, work machine 100, external device 200, work machine system 300, and workability improvement method that can mitigate, compared to conventional methods, the decline in work productivity caused by obstacles OB, such as soil and sand, that accumulate during work. The present disclosure includes the following first to ninth aspects.
[第1の態様]
第1の態様に係る作業機械制御装置40は、位置情報取得装置20から入力される作業現場WSに関する情報である作業現場情報に基づいて作業現場WSにおける作業目標位置TPの位置情報を取得できない場合に、作業目標位置TPの前記位置情報を取得できるようにするための所定の制御を行うコントローラ50を備える。
[First Aspect]
The work machine control device 40 according to the first aspect includes a controller 50 that performs predetermined control to enable acquisition of the position information of the work target position TP at the work site WS when the position information of the work site WS cannot be acquired based on the work site information, which is information relating to the work site WS input from the position information acquisition device 20.
第1の態様では、コントローラ50が前記所定の制御を行うので、作業中に堆積する土砂などの障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる。 In the first aspect, the controller 50 performs the specified control, which makes it possible to reduce the decline in work productivity caused by obstacles OB, such as soil and sand, that accumulate during work compared to conventional methods.
[第2の態様]
第2の態様に係る作業機械制御装置40は、第1の態様に係る作業機械制御装置40においてさらに次の構成を備えることが好ましい。すなわち、第2の態様に係る作業機械制御装置40では、前記所定の制御は、位置情報取得装置20と作業目標位置TPとの間にある障害物OBを動かすための指令を出力する制御(第1の制御)、作業目標位置TPを変更する制御(第2の制御)、または、作業機械100の位置を変更する制御(第3の制御)であることが好ましい。第2の態様では、前記所定の制御としての前記第1の制御、前記第2の制御および前記第3の制御のそれぞれは、作業目標位置TPの位置情報の取得の可能性を高めることができるので、障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる。
[Second Aspect]
It is preferable that the construction machine control device 40 according to the second aspect further comprises the following configuration in addition to the construction machine control device 40 according to the first aspect. That is, in the construction machine control device 40 according to the second aspect, it is preferable that the predetermined control is control that outputs a command to move an obstacle OB that is between the position information acquisition device 20 and the work target position TP (first control), control that changes the work target position TP (second control), or control that changes the position of the construction machine 100 (third control). In the second aspect, each of the first control, second control, and third control as the predetermined control can increase the possibility of acquiring position information for the work target position TP, and therefore can suppress a decrease in work productivity caused by an obstacle OB compared to conventional methods.
前記第1の制御、前記第2の制御および前記第3の制御のそれぞれが作業目標位置TPの位置情報の取得の可能性を高める理由は次のとおりである。コントローラ50が作業現場WSに関する3次元データなどの作業現場情報に基づいて作業目標位置TPの位置情報を取得できないことと、位置情報取得装置20と作業目標位置TPとの間に障害物OBが存在することと、の間には相関がある。前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合にコントローラ50が障害物OBを動かすための指令(シフト指令)を出力する第1の制御を行う場合、位置情報取得装置20と作業目標位置TPとの間の障害物OBが除去されるまたは当該障害物OBの量が減少する。これにより、作業目標位置TPの位置情報の取得の可能性が高まる。また、前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合にコントローラ50が作業目標位置TPを変更する第2の制御を行う場合、位置情報取得装置20と新たに設定される作業目標位置TPとを結ぶ仮想直線が障害物OBから外れた位置を通る場合がある。これにより、作業目標位置TPの位置情報の取得の可能性が高まる。また、前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合にコントローラ50が作業機械100の位置を変更する第3の制御を行う場合、位置情報取得装置20の位置も変わるので、位置が変更された位置情報取得装置20と作業目標位置TPとを結ぶ仮想直線が障害物OBから外れた位置を通る場合がある。これにより、作業目標位置TPの位置情報の取得の可能性が高まる。以上のことから、前記所定の制御としての前記第1の制御、前記第2の制御および前記第3の制御のそれぞれは、作業目標位置TPの位置情報の取得の可能性を高めることができるので、作業中に堆積する土砂などの障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる。 The reasons why the first control, the second control, and the third control each increase the possibility of acquiring position information for the work target position TP are as follows. There is a correlation between the controller 50 being unable to acquire position information for the work target position TP based on work site information, such as three-dimensional data related to the work site WS, and the presence of an obstacle OB between the position information acquisition device 20 and the work target position TP. If the controller 50 performs the first control, which outputs a command (shift command) to move the obstacle OB when it is unable to acquire position information for the work target position TP based on the work site information, the obstacle OB between the position information acquisition device 20 and the work target position TP is removed or the amount of the obstacle OB is reduced. This increases the possibility of acquiring position information for the work target position TP. Furthermore, if the controller 50 performs the second control, which changes the work target position TP when it is unable to acquire position information for the work target position TP based on the work site information, the virtual line connecting the position information acquisition device 20 and the newly set work target position TP may pass through a position that is away from the obstacle OB. This increases the possibility of acquiring position information for the work target position TP. Furthermore, if the controller 50 performs a third control to change the position of the work machine 100 when it is unable to acquire position information for the work target position TP based on the work site information, the position of the position information acquisition device 20 also changes, and the virtual line connecting the changed position information acquisition device 20 and the work target position TP may pass through a position that is away from the obstacle OB. This increases the likelihood of acquiring position information for the work target position TP. As described above, each of the first control, second control, and third control as the predetermined control can increase the likelihood of acquiring position information for the work target position TP, thereby reducing the decline in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional methods.
[第3の態様]
第3の態様に係る作業機械制御装置40は、第1の態様に係る作業機械制御装置40においてさらに次の構成を備えることが好ましい。すなわち、第3の態様に係る作業機械制御装置40では、前記所定の制御は、位置情報取得装置20と作業目標位置TPとの間にある障害物OBを動かすための指令を出力する制御であり、コントローラ50は、前記3次元データなどの前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合で、かつ、位置情報取得装置20が当該位置情報取得装置20と作業目標位置TPとの間の領域に所定高さTh以上の物体を検出する場合に、前記シフト指令を出力することが好ましい。この第3の態様では、コントローラ50は、上記の2つの条件(コントローラ50が前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できず、かつ、位置情報取得装置20が当該位置情報取得装置20と作業目標位置TPとの間の領域に所定高さTh以上の物体を検出するという条件)が満たされる場合に前記シフト指令を出力し、前記2つの条件が満たされない場合には前記シフト指令を出力しない。この第3の態様は、第1の態様に比べて、位置情報取得装置20と作業目標位置TPとの間の領域に障害物OBが存在することの判定精度を高めることができる。所定高さThは、例えば作業機械100が配置される地面からの高さであってもよく、後述する第6の態様において規定される高さであってもよく、これら以外の手法により規定される高さであってもよい。
[Third Aspect]
A work machine control device 40 according to the third aspect preferably includes the following configuration in addition to the work machine control device 40 according to the first aspect. That is, in the work machine control device 40 according to the third aspect, the predetermined control is control that outputs a command to move an obstacle OB that is between the position information acquisition device 20 and the work target position TP, and the controller 50 preferably outputs the shift command when it is unable to acquire position information of the work target position TP based on the work site information such as the three-dimensional data, and when the position information acquisition device 20 detects an object having a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP. In this third aspect, the controller 50 outputs the shift command when the above two conditions (the conditions that the controller 50 is unable to acquire position information of the work target position TP based on the work site information, and the position information acquisition device 20 detects an object having a predetermined height Th or greater in the area between the position information acquisition device 20 and the work target position TP) are satisfied, and does not output the shift command when the above two conditions are not satisfied. Compared to the first aspect, the third aspect can improve the accuracy of determining that an obstacle OB is present in the area between the position information acquisition device 20 and the work target position TP. The predetermined height Th may be, for example, the height from the ground where the work machine 100 is placed, or it may be a height determined in the sixth aspect described below, or it may be a height determined by a method other than these.
[第4の態様]
第4の態様に係る作業機械制御装置40は、第1~第3の態様の何れか一つに係る作業機械制御装置40においてさらに次の構成を備えることが好ましい。すなわち、第4の態様に係る作業機械制御装置40では、コントローラ50は、前記3次元データなどの前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合で、かつ、位置情報取得装置20が当該位置情報取得装置20と作業目標位置TPとの間の領域に所定高さTh以上の物体を検出しない場合に、作業目標位置TPを変更することが好ましい。上記の2つの条件(コントローラ50が前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できず、かつ、位置情報取得装置20が当該位置情報取得装置20と作業目標位置TPとの間の領域に所定高さTh以上の物体を検出しないという条件)が満たされる場合には、土砂などの堆積物である障害物OBが位置情報取得装置20と作業目標位置TPとの間の領域に存在しない可能性、または、当該堆積物が存在したとしても多量には存在しない可能性がある。このような場合には、前記堆積物以外の物が位置情報取得装置20と作業目標位置TPとの間の領域に存在する可能性がある。具体的には例えば掘削作業がある程度進行して当該作業目標位置TPと作業機械100が配置される地面との高低差が大きくなることに起因して、位置情報取得装置20と作業目標位置TPとの間の領域に前記地面が介在する状態になっている可能性がある。この第4の態様では、コントローラ50は、上記の2つの条件が満たされる場合に、前記シフト指令の出力に代えて、作業目標位置TPを変更するので、変更後の作業目標位置TPにおいて作業が円滑に継続される。
[Fourth Aspect]
It is preferable that the work machine control device 40 according to the fourth aspect further comprises the following configuration in addition to the work machine control device 40 according to any one of the first to third aspects. That is, in the work machine control device 40 according to the fourth aspect, it is preferable that the controller 50 changes the work target position TP when it is unable to acquire position information for the work target position TP based on the work site information such as the three-dimensional data, and when the position information acquisition device 20 does not detect an object having a predetermined height Th or more in the area between the position information acquisition device 20 and the work target position TP. If the above two conditions (the condition that the controller 50 is unable to acquire position information for the work target position TP based on the work site information, and the condition that the position information acquisition device 20 does not detect an object having a predetermined height Th or more in the area between the position information acquisition device 20 and the work target position TP) are met, there is a possibility that an obstacle OB, which is a deposit such as earth and sand, is not present in the area between the position information acquisition device 20 and the work target position TP, or that even if such deposit is present, it is not present in large amounts. In such a case, there is a possibility that something other than the deposits is present in the area between the position information acquisition device 20 and the work target position TP. Specifically, for example, as the excavation work progresses to a certain extent and the difference in elevation between the work target position TP and the ground on which the work machine 100 is located increases, there is a possibility that the ground will be present in the area between the position information acquisition device 20 and the work target position TP. In this fourth aspect, when the above two conditions are met, the controller 50 changes the work target position TP instead of outputting the shift command, so that work can be continued smoothly at the changed work target position TP.
[第5の態様]
第5の態様に係る作業機械制御装置40は、第4の態様に係る作業機械制御装置40においてさらに次の構成を備えることが好ましい。すなわち、第5の態様に係る作業機械制御装置40では、コントローラ50は、作業目標位置TPを含む複数の作業目標位置TPの全ての位置情報を前記3次元データに基づいて取得できない場合には、作業機械100の位置を変更する制御、または、作業を終了する制御を行うことが好ましい。複数の作業目標位置TPの全ての位置情報の取得ができない場合、作業目標位置TPの変更では対応できない可能性がある。この第5の態様では、コントローラ50は、複数の作業目標位置TPの全ての位置情報を前記作業現場情報に基づいて取得できない場合に、作業を終了することで、無駄な作業が継続されることを抑制でき、作業の生産性の低下を抑制できる。また、コントローラ50は、複数の作業目標位置TPの全ての位置情報を前記作業現場情報に基づいて取得できない場合に、作業機械100の位置を変更することに伴って位置情報取得装置20の位置も変わるので、位置が変更された位置情報取得装置20と作業目標位置TPとを結ぶ仮想直線が障害物OBから外れた位置を通る場合がある。これにより、作業目標位置TPの位置情報の取得の可能性が高まる。
[Fifth Aspect]
It is preferable that the work machine control device 40 according to the fifth aspect further comprises the following configuration in addition to the work machine control device 40 according to the fourth aspect. That is, in the work machine control device 40 according to the fifth aspect, if the controller 50 is unable to acquire position information for all of the multiple work target positions TP, including the work target position TP, based on the three-dimensional data, it is preferable that the controller 50 performs control to change the position of the work machine 100 or control to end the work. If it is unable to acquire position information for all of the multiple work target positions TP, it may not be possible to address the issue by simply changing the work target position TP. In this fifth aspect, by ending the work if it is unable to acquire position information for all of the multiple work target positions TP based on the work site information, the controller 50 can prevent unnecessary work from being continued and prevent a decrease in work productivity. Furthermore, when the controller 50 is unable to acquire the position information for all of the multiple work target positions TP based on the work site information, the position of the position information acquisition device 20 changes as the position of the work machine 100 is changed, and therefore, an imaginary line connecting the changed position information acquisition device 20 and the work target position TP may pass through a position that is outside the obstacle OB. This increases the possibility of acquiring the position information for the work target position TP.
[第6の態様]
第6の態様に係る作業機械制御装置40は、第3~第5の態様の何れか一つに係る作業機械制御装置40においてさらに次の構成を備えていてもよい。すなわち、第6の態様に係る作業機械制御装置40では、所定高さThは、位置情報取得装置20と作業目標位置TPとを結ぶ仮想直線に対応する高さであってもよい。
[Sixth Aspect]
The work machine control device 40 according to the sixth aspect may further include the following configuration in addition to the work machine control device 40 according to any one of the third to fifth aspects: That is, in the work machine control device 40 according to the sixth aspect, the predetermined height Th may be a height corresponding to an imaginary line connecting the position information acquisition device 20 and the work target position TP.
[第7の態様]
第7の態様に係る作業機械100は、機械本体と、前記機械本体に回動可能に支持される作業装置3と、作業現場WSに関する3次元データなどの作業現場情報を取得する位置情報取得装置20と、第1~第6の態様の何れか一つに係る作業機械制御装置40と、を備える。この第7の態様では、コントローラ50は、前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合に、前記第1の制御、前記第2の制御、前記第3の制御などの前記所定の制御を行うので、作業中に堆積する土砂などの障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる。
[Seventh Aspect]
A work machine 100 according to a seventh aspect includes a machine main body, a work implement 3 rotatably supported on the machine main body, a position information acquisition device 20 that acquires work site information such as three-dimensional data related to the work site WS, and a work machine control device 40 according to any one of the first to sixth aspects. In this seventh aspect, when the controller 50 is unable to acquire position information for the work target position TP based on the work site information, the controller 50 performs the predetermined control such as the first control, the second control, or the third control, thereby making it possible to suppress a decrease in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional systems.
[第8の態様]
第8の態様に係る外部装置200は、第1~第6の態様の何れか一つに係る作業機械制御装置40を備える。この第8の態様では、コントローラ50は、3次元データなどの前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合に、前記第1の制御、前記第2の制御、前記第3の制御などの前記所定の制御を行うので、作業中に堆積する土砂などの障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる。
[Eighth Aspect]
The external device 200 according to the eighth aspect includes the work machine control device 40 according to any one of the first to sixth aspects. In this eighth aspect, the controller 50 performs the predetermined control, such as the first control, the second control, or the third control, when it is unable to acquire position information for the work target position TP based on the work site information, such as three-dimensional data, and therefore it is possible to suppress a decrease in work productivity caused by obstacles OB, such as soil and sand, that accumulate during work, compared to conventional methods.
[第9の態様]
第9の態様に係る作業機械システム300は、作業機械100と、外部装置200と、を備え、作業機械システム300は、第1~第6の態様の何れか一つに係る作業機械制御装置40を含む。第9の態様では、コントローラ50は、3次元データなどの前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合に、前記第1の制御、前記第2の制御、前記第3の制御などの前記所定の制御を行うので、作業中に堆積する土砂などの障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる。
[Ninth Aspect]
A work machine system 300 according to a ninth aspect includes a work machine 100 and an external device 200, and the work machine system 300 includes the work machine control device 40 according to any one of the first to sixth aspects. In the ninth aspect, when the controller 50 cannot acquire position information for the work target position TP based on the work site information such as three-dimensional data, the controller 50 performs the predetermined control such as the first control, the second control, or the third control, thereby making it possible to suppress a decrease in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional methods.
[第10の態様]
第10の態様に係る作業性改善方法は、位置情報取得装置20から入力される作業現場WSに関する3次元データなどの作業現場情報に基づいて作業現場WSにおける作業目標位置TPの位置情報をコントローラ50が取得するためのステップと、コントローラ50が前記位置情報を取得できない場合に、前記作業目標位置の前記位置情報を取得できるようにするための所定の制御を前記コントローラが行うステップと、を含む。第10の態様では、コントローラ50が前記作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合に、前記第1の制御、前記第2の制御、前記第3の制御などの前記所定の制御を行うので、作業中に堆積する土砂などの障害物OBに起因する作業の生産性の低下を従来に比べて抑制できる。
[Tenth Aspect]
The workability improvement method according to the tenth aspect includes the steps of: a step in which a controller 50 acquires position information of a work target position TP at the work site WS based on work site information such as three-dimensional data about the work site WS input from a position information acquisition device 20; and a step in which, when the controller 50 is unable to acquire the position information, the controller performs predetermined control to enable acquisition of the position information of the work target position. In the tenth aspect, when the controller 50 is unable to acquire the position information of the work target position TP based on the work site information, the controller performs the predetermined control such as the first control, the second control, or the third control, thereby making it possible to suppress a decrease in work productivity caused by obstacles OB such as soil and sand that accumulate during work compared to conventional methods.
[変形例]
以上、本開示の実施形態について説明したが、本開示は前記実施形態に限定されるものではなく、例えば以下のような変形例をさらに含む。
[Modification]
Although the embodiments of the present disclosure have been described above, the present disclosure is not limited to the above-described embodiments and further includes, for example, the following modified examples.
(A)変形例1
前記実施形態では、先端アタッチメントがバケット6であるが、先端アタッチメントは、例えばフォーク、グラップル、リフティングマグネットなどの装置であってもよい。これらの先端アタッチメントのそれぞれは、木材、廃材などの作業対象物を保持し、当該作業対象物を動かすための種々の作業を行う。これらの作業中には、前記作業対象物の一部が先端アタッチメントから地面に落下することがある。地面に落下した作業対象物は、作業機械100による作業の生産性を低下させる原因となり得る。
(A) Modification 1
In the above embodiment, the tip attachment is a bucket 6, but the tip attachment may also be a device such as a fork, a grapple, or a lifting magnet. Each of these tip attachments holds a work object such as wood or waste material and performs various operations to move the work object. During these operations, a portion of the work object may fall from the tip attachment to the ground. Work objects that fall to the ground may cause a decrease in productivity of work performed by the work machine 100.
(B)変形例2
前記実施形態では、作業機械制御装置40は作業機械100に備えられるが、作業機械制御装置40は、外部装置200に備えられていてもよい。また、図2に示す具体例では、作業機械制御装置40のコントローラ50は、目標設定部51と、位置情報判定部52と、障害物判定部53と、制御指令出力部54と、目標変更部55と、データ記憶部56と、を含み、作業機械100がコントローラ50を備えるが、作業機械100が、目標設定部51、位置情報判定部52、障害物判定部53、制御指令出力部54、目標変更部55およびデータ記憶部56の一部を備え、外部装置200が、目標設定部51、位置情報判定部52、障害物判定部53、制御指令出力部54、目標変更部55およびデータ記憶部56の他の一部を備えていてもよい。また、作業機械制御装置40のコントローラ50は、データ記憶部56を備えていなくてもよい。
(B) Modification 2
In the embodiment described above, the work machine control device 40 is provided on the work machine 100, but the work machine control device 40 may also be provided on the external device 200. Furthermore, in the specific example shown in Fig. 2, the controller 50 of the work machine control device 40 includes a target setting unit 51, a position information determination unit 52, an obstacle determination unit 53, a control command output unit 54, a target change unit 55, and a data storage unit 56, and the work machine 100 is provided with the controller 50; however, the work machine 100 may also be provided with part of the target setting unit 51, the position information determination unit 52, the obstacle determination unit 53, the control command output unit 54, the target change unit 55, and the data storage unit 56, and the external device 200 may be provided with other parts of the target setting unit 51, the position information determination unit 52, the obstacle determination unit 53, the control command output unit 54, the target change unit 55, and the data storage unit 56. Furthermore, the controller 50 of the work machine control device 40 does not have to be provided with the data storage unit 56.
(C)変形例3
前記自動運転データは、必ずしも作業機械100に記憶されていなくてもよく、作業機械100とは別の外部装置200に記憶されていてもよい。この場合、作業機械100のコントローラ50は、外部装置200に記憶された前記自動運転データを、通信器82を介した無線または有線の通信によって取得し、取得された前記自動運転データを用いて前記特定制御を行ってもよい。
(C) Modification 3
The autonomous driving data does not necessarily have to be stored in the work machine 100, but may be stored in an external device 200 separate from the work machine 100. In this case, the controller 50 of the work machine 100 may acquire the autonomous driving data stored in the external device 200 by wireless or wired communication via the communicator 82, and may perform the specific control using the acquired autonomous driving data.
(D)変形例4
コントローラ50は、3次元データなどの作業現場情報に基づいて作業目標位置TPの位置情報を取得できない場合に、シフト指令を、作業現場WSにおいて作業機械100を補助するための図略の補助機械に出力してもよい。この場合、前記補助機械は、障害物OBが位置情報取得装置20と作業目標位置TPとの間に介在した状態が解消されるようにシフト指令に応じて作動する。これにより、位置情報取得装置20による作業目標位置TPの位置情報の取得が可能になる。
(D) Modification 4
When the controller 50 is unable to acquire position information of the work target position TP based on work site information such as three-dimensional data, it may output a shift command to an auxiliary machine (not shown) that assists the work machine 100 at the work site WS. In this case, the auxiliary machine operates in response to the shift command to eliminate the state in which the obstacle OB is interposed between the position information acquisition device 20 and the work target position TP. This enables the position information acquisition device 20 to acquire position information of the work target position TP.
(E)変形例5
作業機械100は、衛星測位システムのためのアンテナ83をさらに備えていてもよい。衛星測位システムは、例えば、GPS(Global Positioning System)であってもよく、GNSS(Global Navigation Satellite System)であってもよく、他の衛星測位システムであってもよい。アンテナ83は、下部走行体1に対する上部旋回体2の姿勢を検出することが可能なように構成されていてもよく、作業現場WSにおける作業機械100の位置情報(例えばグローバル座標系における作業機械100の座標)を取得することができるように構成されていてもよい。
(E) Modification 5
The work machine 100 may further include an antenna 83 for a satellite positioning system. The satellite positioning system may be, for example, the Global Positioning System (GPS), the Global Navigation Satellite System (GNSS), or another satellite positioning system. The antenna 83 may be configured to be able to detect the attitude of the upper rotating body 2 relative to the undercarriage 1, and may be configured to be able to acquire position information of the work machine 100 at the work site WS (for example, the coordinates of the work machine 100 in a global coordinate system).
(F)変形例6
作業機械システム300において、外部装置200は省略可能である。
(F) Modification 6
In the work machine system 300, the external device 200 can be omitted.
(G)変形例7
障害物OBが堆積する領域は、作業対象範囲WRの外でなくてもよく、作業対象範囲WRの内部であってもよい。
(G) Modification 7
The area where the obstacles OB accumulate does not have to be outside the work range WR, but may be inside the work range WR.
(H)変形例8
図10は、実施形態の変形例8に係る作業機械制御装置40のコントローラ50が行う演算処理を示すフローチャートである。図10に示すフローチャートのステップS11~S21の処理は、図3に示すフローチャートのステップS11~S21の処理と同様であるので、これらの処理の説明は省略する。図10に示すフローチャートに係る演算処理は、ステップS22をさらに備える点で、図3に示すフローチャートに係る演算処理と相違する。
(H) Modification 8
Figure 10 is a flowchart showing the calculation processing performed by the controller 50 of the work machine control device 40 according to the eighth modified embodiment. The processing of steps S11 to S21 in the flowchart shown in Figure 10 is the same as the processing of steps S11 to S21 in the flowchart shown in Figure 3, so a description of these processes will be omitted. The calculation processing according to the flowchart shown in Figure 10 differs from the calculation processing according to the flowchart shown in Figure 3 in that it further includes step S22.
図10に示す変形例8に係る演算処理では、コントローラ50は、前記全ての位置情報を前記3次元データ(点群データ)に基づいて取得できない場合(ステップS20においてYES)、作業機械100の位置を変更する指令を制御対象70に出力する(ステップS22)。そして、コントローラ50は、作業機械100の位置を変更した後、ステップS12以降の処理を再び行う。 In the calculation process related to variant 8 shown in FIG. 10, if the controller 50 cannot acquire all of the position information based on the three-dimensional data (point cloud data) (YES in step S20), it outputs a command to the control object 70 to change the position of the work machine 100 (step S22). Then, after changing the position of the work machine 100, the controller 50 performs the processes from step S12 onwards again.
(I)変形例9
図11は、実施形態の変形例9に係る作業機械制御装置40のコントローラ50が行う演算処理を示すフローチャートである。図11に示すフローチャートのステップS11~S17の処理は、図3に示すフローチャートのステップS11~S17の処理と同様であるので、これらの処理の説明は省略する。図11に示すフローチャートに係る演算処理は、ステップS23をさらに備える点、および、図3に示すフローチャートのステップS18~S21を備えていない点で、図3に示すフローチャートに係る演算処理と相違する。
(I) Modification 9
Figure 11 is a flowchart showing the calculation processing performed by the controller 50 of the work machine control device 40 according to the ninth modification of the embodiment. The processing of steps S11 to S17 in the flowchart shown in Figure 11 is the same as the processing of steps S11 to S17 in the flowchart shown in Figure 3, so a description of these processes will be omitted. The calculation processing according to the flowchart shown in Figure 11 differs from the calculation processing according to the flowchart shown in Figure 3 in that it further includes step S23 and does not include steps S18 to S21 of the flowchart shown in Figure 3.
図11に示す変形例9に係る演算処理では、その時点で設定されている作業目標位置TP(例えば1番の作業目標位置TP)の位置情報をコントローラ50が取得できない場合(ステップS12においてNO)、コントローラ50は、作業目標位置TPの位置情報を取得できるようにするための所定の制御を行う(ステップS23)。そして、コントローラ50は、前記所定の制御が完了すると、ステップS12以降の処理を再び行う。 In the calculation process related to Variation 9 shown in FIG. 11, if the controller 50 cannot acquire the position information of the currently set work target position TP (for example, work target position TP No. 1) (NO in step S12), the controller 50 performs predetermined control to enable acquisition of the position information of the work target position TP (step S23). Then, once the predetermined control is completed, the controller 50 performs the processes from step S12 onwards again.
前記所定の制御は、位置情報取得装置20と作業目標位置TPとの間にある障害物OBを動かすための指令を出力する制御、作業目標位置TPを変更する制御、または、作業機械100の位置を変更する制御である。前記所定の制御は、作業が開始される前に、コントローラ50において予め設定されていてもよい。 The predetermined control is control to output a command to move an obstacle OB between the position information acquisition device 20 and the work target position TP, control to change the work target position TP, or control to change the position of the work machine 100. The predetermined control may be set in advance in the controller 50 before work begins.
Claims (10)
前記コントローラは、前記作業現場情報に基づいて前記作業目標位置の前記位置情報を取得できない場合で、かつ、前記位置情報取得装置が当該位置情報取得装置と前記作業目標位置との間の領域に所定高さ以上の物体を検出する場合に、前記指令を出力する、請求項1または2に記載の作業機械制御装置。 the predetermined control is a control for outputting a command to move an obstacle between the position information acquisition device and the work target position,
3. The work machine control device according to claim 1, wherein the controller outputs the command when the position information of the work target position cannot be acquired based on the work site information and when the position information acquisition device detects an object of a predetermined height or higher in an area between the position information acquisition device and the work target position.
前記機械本体に回動可能に支持される作業装置と、
作業現場に関する情報である作業現場情報を取得する位置情報取得装置と、
請求項1~6の何れか1項に記載の作業機械制御装置と、を備える作業機械。 The machine body,
a working device rotatably supported on the machine body;
a location information acquisition device that acquires work site information that is information related to a work site;
A work machine comprising: the work machine control device according to any one of claims 1 to 6.
前記作業機械システムは、請求項1~6の何れか1項に記載の作業機械制御装置を含む、作業機械システム。 A work machine system including a work machine and an external device,
The work machine system includes the work machine control device according to any one of claims 1 to 6.
前記コントローラが前記位置情報を取得できない場合に、前記作業目標位置の前記位置情報を取得できるようにするための所定の制御を前記コントローラが行うステップと、を含む作業性改善方法。 a step in which a controller acquires position information of a work target position in the work site based on work site information that is information about the work site input from a position information acquisition device;
and when the controller is unable to acquire the position information, the controller performs a predetermined control to enable acquisition of the position information of the work target position.
Applications Claiming Priority (2)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
JP2024-040770 | 2024-03-15 | ||
JP2024040770A JP2025141039A (en) | 2024-03-15 | Work machine control device, work machine, external device, work machine system, and workability improvement method |
Publications (1)
Publication Number | Publication Date |
---|---|
WO2025192005A1 true WO2025192005A1 (en) | 2025-09-18 |
Family
ID=97063128
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
PCT/JP2025/000657 Pending WO2025192005A1 (en) | 2024-03-15 | 2025-01-10 | Work machine control device, work machine, external device, work machine system, and workability improvement method |
Country Status (1)
Country | Link |
---|---|
WO (1) | WO2025192005A1 (en) |
-
2025
- 2025-01-10 WO PCT/JP2025/000657 patent/WO2025192005A1/en active Pending
Similar Documents
Publication | Publication Date | Title |
---|---|---|
JP7402736B2 (en) | Excavator and its control method | |
JP7726614B2 (en) | Excavator | |
CN112962709B (en) | Engineering mechanical equipment, operation track planning method and system thereof and storage medium | |
KR102785874B1 (en) | Shovel | |
US20210254312A1 (en) | Control device and control method for work machine | |
CN105339561A (en) | Device for computing orientation of work machine, work machine, and method for computing orientation of work machine | |
CN112424430A (en) | Control device, loading machine, and control method | |
CN114829710B (en) | Shovel, remote operation support device | |
WO2021019951A1 (en) | Construction machine work information generation system and work information generation method | |
JP2023174887A (en) | Work machine, information processing device | |
JP2022137769A (en) | Excavator, information processing equipment | |
KR102782893B1 (en) | Automatic operation system | |
CN115030243A (en) | System and method for terrain-based control of a self-propelled work vehicle | |
JP2022154674A (en) | Excavator | |
JP2022154722A (en) | Excavator | |
WO2025192005A1 (en) | Work machine control device, work machine, external device, work machine system, and workability improvement method | |
JP2025141039A (en) | Work machine control device, work machine, external device, work machine system, and workability improvement method | |
JP2024073207A (en) | Shovel, shovel control device, and machine learning device | |
KR102705219B1 (en) | Construction machinery | |
CN116997698A (en) | Excavator | |
JP2021155998A (en) | Work machine management system | |
JP2025117732A (en) | Work machine control device, work machine, external device for work machine, work machine system, and position correction method | |
JP2025084395A (en) | AUTONOMOUS DRIVING INFORMATION PROCESSING DEVICE, AUTONOMOUS DRIVING SYSTEM, AUTONOMOUS DRIVING METHOD, AND AUTONOMOUS DRIVING PROGRAM | |
JP2025133186A (en) | Work machine control device, work machine, external device, work machine system, program, and method for determining amount of soil movement | |
WO2025047877A1 (en) | Excavator, and remote operation system for excavator |