Work machine control device, work machine, external device for work machine, work machine system, and position correction method

Abstract

A work machine (100) comprises: a machine body; a mobile unit (14) the relative position of which with respect to the machine body can be changed; and a site information acquisition unit (20) that is attached to the mobile unit (14) and that acquires information on a work site. A work machine control device (40) comprises a controller (50) that corrects the position of the site information acquisition unit (20) using: first position information correlated with the position of the site information acquisition unit (20) when the mobile unit (14) is disposed at a first position (Pa); and second position information correlated with the position of the site information acquisition unit (20) when the mobile unit (14) is disposed at a second position (Px) different from the first position (Pa).

Description

Work machine control device, work machine, external device for work machine, work machine system, and position correction method

[0001] The present disclosure relates to technology for work machines such as hydraulic excavators.

[0002] Generally, a work machine such as a hydraulic excavator includes a lower traveling body, an upper rotating body that is rotatably supported on the lower traveling body, and a work implement that is rotatably supported on the upper rotating body. The work implement includes, for example, a boom, an arm, and a tip attachment such as a bucket. The upper rotating body includes a rotating frame and a cab that is supported on the rotating frame. Operating devices such as control levers are disposed in the cab, and the work machine performs operations in response to operations applied to the operating devices by an operator.

[0003] Incidentally, when assist control is performed to assist operators and other related parties in the work, such as in the case of automatic driving control that automates the operation of a work machine, a site information acquirer such as a LiDAR may be attached to the work machine to acquire information about the work target at the work site. However, when the site information acquirer is attached to a movable part that can change its position relative to the machine body, such as a cab that can be raised and lowered relative to the machine body (see, for example, Patent Documents 1 and 2), the controller may not be able to appropriately control the work machine using the work site information acquired by the site information acquirer.

[0004] JP 2014-141837 A JP 2016-176288 A

[0005] The present disclosure aims to provide a work machine control device, a work machine, an external device for a work machine, a work machine system, and a position correction method that can appropriately control a work machine using information from the work site acquired by a site information acquirer, even when the site information acquirer is attached to a movable part whose relative position with respect to the machine body can be changed.

[0006] The work machine control device of the first aspect is a work machine control device for controlling a work machine that includes a machine main body, a movable part that can change its relative position with respect to the machine main body, and a site information acquirer that is attached to the movable part and acquires work site information, which is information about the work site, and includes a controller that corrects the position of the site information acquirer using first position information that correlates with the position of the site information acquirer when the movable part is positioned at a first position, and second position information that correlates with the position of the site information acquirer when the movable part is positioned at a second position different from the first position.

[0007] FIG. 1 is a side view showing a work machine according to a first embodiment. FIG. 2 is a block diagram showing components of the work machine according to the first embodiment. FIG. 3 is a diagram for explaining an example of a position correction method according to the first embodiment. FIG. 4 is a diagram for explaining a work target and a reference position at a work site. FIG. 5 is a flowchart showing calculation processing performed by a controller of a work machine control device according to the first embodiment. FIG. 6 is a diagram showing a work machine system equipped with a work machine control device according to a modified example of the first embodiment. FIG. 7 is a diagram showing a work machine equipped with a work machine control device according to a second embodiment. FIG. 8 is a flowchart showing calculation processing performed by a controller of a work machine control device according to the second embodiment. FIG. 9 is a diagram showing a work machine according to a modified example. FIG. 10 is a diagram showing a work machine system equipped with a work machine control device according to a reference example.

[0008] Embodiments of the present disclosure will be described with reference to the drawings.

[0009] [First embodiment] Figure 1 is a side view showing a work machine 100 according to a first embodiment. As shown in Figure 1, the work machine 100 comprises a lower running body 1 including a traveling 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 A extending vertically, a work device 3 supported on the upper rotating body 2, a plurality of actuators, and an attitude information acquirer 80 (see Figure 2).

[0010] The work machine 100 according to 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 a crane, a bulldozer, etc. The travelling device may be a crawler travelling device as shown in Fig. 1 or a travelling device having tires (not shown).

[0011] The front-rear direction and the left-right direction shown in the drawings are directions based on the orientation of the upper rotating body 2. Specifically, the front-rear direction is a horizontal direction parallel to the longitudinal direction of the work implement 3 in a plan view, and the left-right direction is a horizontal direction perpendicular to the front-rear direction.

[0012] 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, but the tip attachment may be another tip attachment such as a grapple, fork, crusher, or lifting magnet.

[0013] Each of the multiple actuators is operated by receiving a supply of hydraulic oil discharged from a hydraulic pump (not shown). 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 (not shown) for rotating the upper swing structure 2 relative to the undercarriage 1, and a travel motor (not shown) for traveling the undercarriage 1. The multiple actuators may also include a lifting actuator 10 for raising and lowering the cab 14.

[0014] The upper rotating body 2 includes a rotating frame 11, a counterweight 12, a cab support 13, a cab 14, and a center section 15 (see FIG. 3 ). In this embodiment, the rotating frame 11 and the cab support 13 are an example of a machine body. That is, in this embodiment, the machine body includes the rotating frame 11 and the cab support 13.

[0015] The revolving frame 11 is a frame that is rotatably supported on the lower traveling body 1, and constitutes a base portion of the upper revolving body 2. The counterweight 12 is disposed at the rear of the upper revolving body 2.

[0016] The counterweight 12 is a weight for balancing the work machine 100. The cab support portion 13 is supported by the revolving frame 11 in front of the counterweight 12.

[0017] The cab support portion 13 supports the cab 14. The cab 14 may be supported by the cab support portion 13 via a lifting actuator 10. The lifting actuator 10 may be, for example, a cylinder such as a hydraulic cylinder or an electric cylinder, or a motor such as a hydraulic motor or an electric motor.

[0018] The cab 14 is a so-called elevator cab. The cab 14 moves up and down relative to the cab support 13 within a range between a lowest position Pa and a highest position Pb shown in FIG. 1 in response to operation of the lifting actuator 10. The cab 14 is an example of a movable part that can change its position relative to the machine body. The cab 14 is disposed in front of the cab support 13 and is supported by the revolving frame 11 via the lifting actuator 10 and the cab support 13. The cab 14 is disposed, for example, at the left front portion of the revolving frame 11.

[0019] The cab 14 may be configured to rise and fall along the vertical direction, or along a direction inclined at a predetermined angle relative to the vertical direction. The cab 14 may be configured to rise and fall along a linear track, a curved track, or a track that includes a linear track and a curved track.

[0020] A driver's seat, an operating device 16, etc. are arranged inside the cab 14. The operating device 16 includes operating devices that receive various operations by an operator, such as a boom operation for raising and lowering the boom 4, an arm operation for rotating the arm 5, a tip attachment operation for rotating the tip attachment 6, a swing operation for swinging the upper rotating body 2 relative to the undercarriage 1, and a traveling operation for traveling the undercarriage 1. The operating device 16 may also include an operating device that receives a lifting operation for raising and lowering the cab 14. The operating device may be composed of at least one of an operating lever, an operating pedal, and an operating button.

[0021] The center section 15 has a portion that stands upward from the revolving frame 11, and this portion rotatably supports the boom 4. The center section 15 also rotatably supports the base end of the boom cylinder 7. Specifically, the base end of the boom cylinder 7 is rotatably attached to the center section 15, and the tip end of the boom cylinder 7 is rotatably attached to the boom 4.

[0022] The attitude information acquirer 80 (see FIG. 2 ) acquires attitude information, which is information relating to the attitude of the work machine 100. As shown in FIG. 1 , the attitude information acquirer 80 may include a plurality of attitude detectors. The plurality of attitude detectors may include a boom attitude detector 81, an arm attitude detector 82, and a tip attachment attitude detector 83. The plurality of attitude detectors may further include a rotating bed attitude detector 84.

[0023] The boom attitude detector 81 may be a sensor that detects the attitude of the boom 4, or may be a sensor that detects the state of the boom cylinder 7 that correlates with the attitude of the boom 4. The arm attitude detector 82 may be a sensor that detects the attitude of the arm 5, or may be a sensor that detects the state of the arm cylinder 8 that correlates with the attitude of the arm 5. The tip attachment attitude detector 83 may be a sensor that detects the attitude of the tip attachment 6, or may be a sensor that detects the state of the tip attachment cylinder 9 that correlates with the attitude of the tip attachment 6. The revolving structure attitude detector 84 may be a sensor that detects the attitude of the upper revolving structure 2, or may be a sensor that detects the state of the revolving motor that correlates with the attitude of the upper revolving structure 2.

[0024] Each of the plurality of attitude detectors may include, for example, an inertial measurement unit (IMU), a sensor (e.g., a stroke sensor) that detects the degree of extension / contraction of a cylinder, or other sensors. The rotating body attitude detector 84 may include a sensor that detects the rotation angle of the upper rotating body 2 relative to the undercarriage 1, or a sensor that detects the inclination angle of the upper rotating body 2 relative to the horizontal plane.

[0025] The attitude information acquirer 80 inputs the acquired attitude information to the controller 50, which will be described later. The controller 50 can calculate the attitude of the work machine 100 using the attitude information input from the attitude information acquirer 80.

[0026] 2, the work machine 100 includes a site information acquirer 20 and a work machine control device 40. The work machine control device 40 includes a controller 50.

[0027] The site information acquirer 20 is a device for acquiring work site information, which is information about a work site. As shown in FIG. 2 , the site information acquirer 20 inputs the acquired work site information (e.g., point cloud data) to the controller 50. In this embodiment, the site information acquirer 20 is attached to the cab 14 (an example of a movable part). Specifically, the site information acquirer 20 may be attached to the front part of the top surface of the cab 14.

[0028] The site information acquirer 20 may be a three-dimensional position information acquirer configured to acquire three-dimensional position information (e.g., point cloud data) of objects present at the work site, such as the ground, obstacles, and other work machines. Specific examples are as follows.

[0029] The site information acquirer 20 may be a distance measuring sensor that acquires distance information regarding the distance to an object by irradiating light such as laser light. The distance measuring sensor may be, for example, a LiDAR (Light Detection and Ranging). The site information acquirer 20 may also be a stereo camera, an ultrasonic sensor, a total station, or other sensor capable of acquiring three-dimensional position information. The site information acquirer 20 may also be a height detection device capable of detecting the height of the site information acquirer 20. The site information acquirer 20 may also be a combination of two or more of these devices.

[0030] The controller 50 includes a computer including an arithmetic processing unit and a memory. The controller 50 realizes the functions of the work machine control device 40, such as the assist control, by the arithmetic processing unit executing a program stored in the memory.

[0031] The controller 50 controls the operation of the work machine 100. In this embodiment, the controller 50 performs assist control to assist those involved in the work, such as an operator, work manager, and assistant. The assist control may be, for example, control for automatic operation that automates the operation of the work machine 100 (automatic operation control), control for semi-automatic operation that automates part of the operation of the work machine 100 (semi-automatic operation control), control for the operator to remotely operate the work machine 100 using a remote operation device (not shown) that is located in a remote location away from the work machine 100 (remote operation control), or other control to assist the those involved in the work.

[0032] In the specific example shown in FIG. 2 , the controller 50 includes a correction controller 51 (surroundings recognition controller), a driving control controller 52 , and an assist data storage unit 53 .

[0033] The correction controller 51 performs position correction control for correcting the position of the site information acquirer 20. The position correction control may include not only correction of the position of the site information acquirer 20, but also correction of the orientation of the site information acquirer 20 as in a second embodiment described later.

[0034] The operation controller 52 uses the work site information input from the site information acquirer 20 to perform the assist control and other controls of the work machine 100 .

[0035] The assist data memory 53 stores assist data, which is data for the assist control. The assist data may be, for example, automatic driving data for the automatic driving or semi-automatic driving. The automatic driving data is used, for example, to calculate a control command that the controller 50 outputs to the controlled object 70 so that the work machine 100 performs a predetermined operation. The automatic driving data may be, for example, teaching data corresponding to operations that an operator applies to the operating device in the cab 14 or the remote operating device, or may be data created using various information terminals.

[0036] The controller 50 performs the assist control using the work site information input from the site information acquirer 20 and the attitude information input from the attitude information acquirer 80. Specifically, for example, when the assist control is automatic driving control or semi-automatic driving control, the controller 50 outputs a control command to the controlled object 70 so that the work machine 100 performs an operation corresponding to the automatic driving data stored in advance in the assist data memory 53.

[0037] The controlled object 70 is an object controlled by the operation control controller 52 of the controller 50. The output of the controlled object 70 changes in accordance with a control operation amount (control input) that is a control 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, whereby hydraulic oil from the hydraulic pump is supplied to at least one of the plurality of actuators, and the actuator is operated.

[0038] The flow rate regulator may include, for example, a plurality of proportional valves 71 and a control valve 72. The control valve 72 has a plurality of spools corresponding to the plurality of actuators. The control valve has a pair of pilot ports corresponding to each spool. Each of the plurality of spools is actuated by inputting a pilot pressure to one of the pair of pilot ports corresponding to the spool, allowing hydraulic oil to be supplied to the actuator corresponding to the spool. Each of the plurality of proportional valves 71 is disposed in an oil passage connecting the pilot port of the spool corresponding to the proportional valve 71 to a pilot pump (not shown) and adjusts the pilot pressure input to the pilot port. In other words, each of the plurality of proportional valves 71 outputs a secondary pressure corresponding to a control operation amount (e.g., a current value) input from the controller 50, and the secondary pressure is input as a pilot pressure to the pilot port corresponding to the proportional valve 71. Each of the plurality of proportional valves 71 adjusts the pilot pressure input to the pilot port corresponding to the proportional valve 71 to a magnitude corresponding to the control operation amount input from the controller 50.

[0039] The plurality of proportional valves 71 may include a pair of boom proportional valves 71 for controlling the operation of the boom cylinder 7, a pair of arm proportional valves 71 for controlling the operation of the arm cylinder 8, a pair of tip attachment proportional valves 71 for controlling the operation of the tip attachment cylinder 9, a pair of swing proportional valves 71 for controlling the operation of the swing motor, and a pair of travel proportional valves 71 for controlling the travel motor. Furthermore, if the lifting actuator 10 is a hydraulic actuator such as a hydraulic cylinder or a hydraulic motor, the plurality of proportional valves 71 may further include a pair of lifting proportional valves 71 for controlling the operation of the lifting actuator 10.

[0040] In this embodiment, the cab 14 is an elevator cab (an example of a movable part) that can be raised and lowered relative to the machine body (the rotating frame 11 and the cab support part 13), and since the site information acquisition device 20 is attached to this cab 14, the controller 50 performs the following position correction control at least either before or during the execution of the assist control.

[0041] In the position correction control, the controller 50 corrects the position of the site information acquirer 20 using first position information that correlates with the position of the site information acquirer 20 when the cab 14 is positioned at a first position (for example, the lowest position Pa shown in the upper diagram (A) of Figure 3), and second position information that correlates with the position of the site information acquirer 20 when the cab 14 is positioned at a second position different from the lowest position Pa (for example, the work position Px shown in the center diagram (B) of Figure 3).

[0042] Therefore, in this embodiment, even if the relative position between the site information acquirer 20 attached to the cab 14 and the work object at the work site changes as the cab 14 displaces relative to the machine body, the assist control of the work machine 100 is performed appropriately using the work site information acquired by the site information acquirer 20.

[0043] Each of the first position information and the second position information may be information represented by coordinates in a coordinate system based on the site information acquirer 20 (acquirer coordinate system), may be information represented by coordinates in a coordinate system based on the work machine 100 (machine coordinate system), may be information represented by coordinates in a coordinate system based on a specific position at the work site (site coordinate system), or may be 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.

[0044] In the following specific example, the controller 50 is configured to convert point cloud data in the acquirer coordinate system input from the site information acquirer 20 into point cloud data in a predetermined reference coordinate system. The reference coordinate system may be the machine coordinate system, the site coordinate system, the global coordinate system, or another coordinate system.

[0045] The origin O of the reference coordinate system may be set at a specific position relative to the work machine 100, for example. Specifically, the origin O of the reference coordinate system may be at any position on the rotation axis A, for example. More specifically, the origin O of the reference coordinate system may be the intersection of the rotation axis A and the ground. Furthermore, the origin O of the reference coordinate system may be at a position on the rotation axis A and between the lower traveling body 1 and the upper rotating body 2 (specific position SP in FIG. 1 ), for example.

[0046] In this embodiment, the reference coordinate system is a three-dimensional coordinate system. In this case, the reference coordinate system may be, for example, an orthogonal coordinate system defined by an x-axis parallel to the left-right direction, a y-axis parallel to the front-rear 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.

[0047] The controller 50 may store in advance an initial setting position for the cab 14. The initial setting position is a position of the cab 14 that is set in advance as a reference position when correcting the position of the site information acquirer 20. The initial setting position may be, for example, the lowest position Pa. The initial setting position (lowest position Pa) is an example of a first position.

[0048] The controller 50 may pre-store information (initial relative position information) regarding the relative position of the site information acquirer 20 with respect to the specific position SP when the cab 14 is located at the initial setting position (first position). Specifically, for example, the controller 50 may store, as the initial relative position information, acquirer initial coordinates C0, which are coordinates in the reference coordinate system with the specific position SP as the origin and are the coordinates of the site information acquirer 20 when the cab 14 is located at the lowest position Pa. The coordinates of the site information acquirer 20 may be, for example, coordinates of the viewpoint of the site information acquirer 20 or coordinates of another part of the site information acquirer 20.

[0049] When the cab 14 moves up or down from the initial setting position (first position) to the second position and the relative position of the site information acquirer 20 to the machine body (swivel frame 11 and cab support portion 13) changes, the controller 50 may correct the position of the site information acquirer 20 as follows.

[0050] That is, the controller 50 may acquire, as the first position information, a first coordinate C1 which is the coordinate of a reference position RP described below when the cab 14 is positioned at the initial setting position (first position), and may acquire, as the second position information, a second coordinate C2 which is the coordinate of the reference position RP when the cab 14 is positioned at the second position (for example, the work position Px in Figure 3).

[0051] The first coordinate C1 may be the coordinate of a reference position RP identified by the controller 50 based on point cloud data input from the site information acquirer 20 to the controller 50 when the cab 14 is located at a first position. Similarly, the second coordinate C2 may be the coordinate of a reference position RP identified by the controller 50 based on point cloud data input from the site information acquirer 20 to the controller 50 when the cab 14 is located at a second position.

[0052] The reference position RP does not fluctuate at least during the time period when the position correction control is performed. Meanwhile, the first coordinate C1 and the second coordinate C2 are each calculated using the initial relative position information (e.g., the acquirer initial coordinate C0). Therefore, even though the reference position RP does not fluctuate, the first coordinate C1 and the second coordinate C2 have different values. The difference ΔC between the first coordinate C1 and the second coordinate C2 corresponds to the change in the coordinate of the site information acquirer 20 that occurs as the cab 14 is raised or lowered from the first position (the initial setting position) to the second position.

[0053] Therefore, the controller 50 may use the difference ΔC between the first coordinate C1 and the second coordinate C2 to correct the position of the site information acquirer 20. Specifically, the controller 50 may calculate the acquirer corrected coordinate C0′ by substituting the acquirer initial coordinate C0 and the difference ΔC into a predetermined relational expression that is set to correct the position of the site information acquirer 20.

[0054] The calculated acquirer corrected coordinates C0' are coordinates in the reference coordinate system with the specific position SP as the origin, and are the coordinates of the site information acquirer 20 when the cab 14 is located at a second position (e.g., work position Px). Therefore, the controller 50 can appropriately perform the assist control after the position correction control by using the acquirer corrected coordinates C0' corrected in the position correction control and the point cloud data acquired by the site information acquirer 20. In other words, the assist control for a predetermined task that is performed when the cab 14 is located at the second position (e.g., work position Px) is appropriately performed.

[0055] An example of the reference position RP will now be described. In this embodiment, as shown in Figures 3 and 4, a reference object 60 is placed at the work site WS. The reference object 60 is an object that serves as a reference for correcting the position of the site information acquirer 20 in position correction control by the controller 50. The relative position of the reference object 60 with respect to the work target WT at the work site WS does not change at least during the time period in which position correction control is performed.

[0056] The reference object 60 is preferably placed in the work site WS in a manner that makes it easy to distinguish from objects surrounding the reference object 60. Specifically, for example, the reference object 60 is preferably placed at a position higher than the ground around the reference object 60 in the work site WS. The reference object 60 may be placed at a position higher than the surrounding ground by being supported by, for example, a rod-shaped support member. The reference object 60 preferably has a highly reflective surface so that it can be easily detected by a distance measurement sensor such as LiDAR. The reference object 60 preferably has a color (e.g., white, yellow, etc.) that can be easily detected by a distance measurement sensor such as LiDAR. The reference object 60 may be, for example, a sphere or may have another shape.

[0057] The reference object 60 is placed at a position that is included in the field of view of the site information acquirer 20 when the work machine 100 is placed near the work target WT, for example, as shown in Figures 3 and 4. In the specific example shown in Figure 4, the reference object 60 is placed next to the work target WT, but the placement of the reference object 60 is not limited to the specific example shown in Figure 4.

[0058] When a reference object 60 is placed at the work site WS, the controller 50 may identify a reference position RP (reference point), which is the position of the reference object 60, using the point cloud data input from the site information acquirer 20. The controller 50 may calculate the coordinates of the reference position RP using the point cloud data input from the site information acquirer 20. The coordinates of the reference position RP may be, for example, coordinates corresponding to the center of the reference object 60, coordinates corresponding to the upper end of the reference object 60, or coordinates corresponding to another part of the reference object 60.

[0059] Specifically, for example, the controller 50 may identify the coordinates of the reference position RP using point cloud data input from the site information acquirer 20 (e.g., LiDAR) and characteristic information related to the characteristics of the reference object 60. The characteristic information may include, for example, at least one of information related to the size (e.g., outer diameter) of the reference object 60, information related to the shape (e.g., spherical shape) of the reference object 60, information related to the installation height (height from the ground) of the reference object 60, and information related to the reflectance or color of the reference object 60. The characteristic information may be stored in advance in the controller 50 before the position correction control is started.

[0060] Next, an example of the assist control will be described. In the specific example shown in Figures 3 and 4, the work machine 100 is placed at a work site WS and performs a predetermined task on a work target WT set at the work site WS. The predetermined task may be, for example, loading work, ground leveling work, or some other task. The controller 50 performs the assist control so that the work machine 100 performs the predetermined task.

[0061] Specifically, for example, the controller 50 performs automatic driving control or semi-automatic driving control using the point cloud data input from the site information acquirer 20 and the attitude information input from the attitude information acquirer 80. 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 stored in advance in the assist data memory 53.

[0062] The loading operation includes an excavation step, a lifting and swinging step, a soil discharge step, and a return swinging step. The excavation step, lifting and swinging step, soil discharge step, and return swinging step are performed in this order. The excavation step is an operational step for excavating a work target WT, such as the ground. The work target WT may be, for example, a target excavation area indicated by a dashed-dotted line frame in FIG. 4. The lifting and swinging step is an operational step for moving the bucket 6 holding the excavated soil from the work target WT to directly above the soil discharge area. The soil discharge area may be, for example, the bed of a dump truck (not shown), or may be an area for soil discharge formed at the work site WS. The soil discharge step is an operational step for discharging soil from the bucket 6 to the soil discharge area. The return swinging step is an operational step for returning the bucket 6 from directly above the soil discharge area to the work target WT.

[0063] The teaching data corresponding to the loading operation including a plurality of operation steps may be stored in the assist data storage device 53, or may be stored in an external device that is separate from the work machine 100.

[0064] FIG. 5 is a flowchart showing the calculation process for the position correction control performed by the controller 50 of the work machine control device 40.

[0065] As shown in the upper diagram (A) of Figure 3, when the work machine 100 is placed near the work object WT and the cab 14 is placed in the initial setting position, the controller 50 acquires the coordinates of the reference position RP (first coordinates C1) (step S11 of Figure 5).

[0066] Specifically, in step S11, the controller 50 calculates a first coordinate C1 of the reference position RP using point cloud data input from the site information acquirer 20 (e.g., LiDAR) with the cab 14 positioned at the lowest position Pa as the initial setting position. Then, the controller 50 stores the calculated first coordinate C1 (step S12).

[0067] Next, the controller 50 controls the operation of the lifting actuator 10 so as to raise or lower the cab 14 (step S13). Specifically, when the initial setting position is the lowest position Pa, the controller 50 controls the operation of the lifting actuator 10 so as to raise the cab 14 from the lowest position Pa to the target height position.

[0068] The target height position may be, for example, a working position Px as shown in the central diagram (B) of Fig. 3. The working position Px is the position of the cab 14 when the work machine 100 is performing work at the work site. The working position Px is determined appropriately depending on various conditions such as the type of work to be performed at the work site and the specifications of the work machine 100. In the specific example shown in the central diagram (B) of Fig. 3, the working position Px is a position above the lowest position Pa and below the highest position Pb. However, the working position Px may be either the highest position Pb or the lowest position Pa.

[0069] The target height position (e.g., working position Px) may be set based on an input operation by a person involved in the work. The input operation may be, for example, an operation on an input device in the cab 14, or an operation on an external device that is separate from the work machine 100. The input operation may include, for example, an input for specifying the target height position, which is any height position between the lowest position Pa and the highest position Pb. In this case, the cab 14 continues to move up and down from the lowest position Pa, which is the initial setting position, to the working position Px, which is the target height position.

[0070] Furthermore, the target height position (for example, the working position Px) may be a position determined in response to a lifting / lowering operation given by a worker to the operating device 16 in the cab 14, or may be a position determined in response to a lifting / lowering operation given by a worker to the remote operating device. In this case, the cab 14 continues to lift / lower while a lifting / lowering operation is given to the operating device 16 or the remote operating device.

[0071] When the cab 14 has been raised and lowered and is positioned at a target height (e.g., at the work position Px), the controller 50 acquires the coordinates of the reference position RP (second coordinates C2) (step S14). Specifically, in step S14, the controller 50 calculates the second coordinates C2 of the reference position RP using the point cloud data input from the site information acquirer 20 while the cab 14 is positioned at the work position Px.

[0072] Next, the controller 50 compares the first coordinate C1 with the second coordinate C2 to determine whether a predetermined condition for determining whether position correction is necessary is satisfied (step S15). The condition for determining whether position correction is necessary may be, for example, the condition that the first coordinate C1 and the second coordinate C2 do not match (ΔC=C1-C2≠0) as shown in step S15 of FIG. 5, or the condition that the difference ΔC between the first coordinate C1 and the second coordinate C2 is not included in a predetermined allowable range Th (|C1-C2|>Th).

[0073] If the condition for determining whether or not the position correction is necessary is satisfied (YES in step S15), the controller 50 uses the difference ΔC between the first coordinate C1 and the second coordinate C2 as a correction value to correct the position of the site information acquirer 20 (step S16). Specifically, when the first coordinate C1 is (x1, y1, z1) and the second coordinate C2 is (x2, y2, z2), the difference ΔC is expressed, for example, by the following relational expression (1):

[0074] ΔC=(Δx, Δy, Δz) ...(1) (Δx=x1-x2, Δy=y1-y2, Δz=z1-z2)

[0075] The controller 50 pre-stores the acquirer initial coordinates C0 (x0, y0, z0) of the site information acquirer 20 when the cab 14 is placed at the lowest position Pa (the initial setting position).

[0076] In step S16, the controller 50 obtains the corrected coordinates C0′ of the acquirer by correcting the initial coordinates C0 of the acquirer using the difference ΔC. Specifically, for example, the controller 50 may calculate the corrected coordinates C0′ (x0′, y0′, z0′) of the acquirer by substituting the initial coordinates C0 and the difference ΔC into the following relational expression (2):

[0077] C0'=C0+ΔC...(2) (x0'=x0+Δx, y0'=y0+Δy, z0'=z0+Δz)

[0078] Next, the controller 50 performs the process of step S14 again. That is, the controller 50 acquires the coordinates (second coordinates C2) of the reference position RP again (step S14). Specifically, in the second execution of step S14, the controller 50 calculates the second coordinates C2 of the reference position RP using the point cloud data input from the site information acquirer 20, with the cab 14 positioned at the work position Px.

[0079] Next, the controller 50 compares the first coordinate C1 with the second coordinate C2 to determine whether the position correction necessity determination condition is met (step S15). The first coordinate C1 is calculated using the coordinates stored in step S12, i.e., the acquirer initial coordinate C0 (the initial relative position information), and the second coordinate C2 is calculated using the coordinates calculated in the second step S14, i.e., the acquirer corrected coordinate C0'. Therefore, in the comparison between the first coordinate C1 and the second coordinate C2 in the second step S15, the difference ΔC between the first coordinate C1 and the second coordinate C2 is smaller than in the first step S15.

[0080] Next, if the condition for determining whether or not the position correction is necessary is not satisfied (NO in step S15), the controller 50 terminates the position correction control. Specifically, for example, the controller 50 may terminate the position correction control if the first coordinate C1 and the second coordinate C2 match (ΔC=0) or if the difference ΔC is within the allowable range Th (|C1-C2|≦Th).

[0081] On the other hand, if the position correction necessity determination condition is also satisfied in the second step S15 (YES in step S15), the controller 50 again corrects the position of the site information acquirer 20 using the difference ΔC between the first coordinate C1 and the second coordinate C2 (step S16). That is, in the second step S16, specifically, for example, the controller 50 may again calculate the acquirer corrected coordinates C0' (x0', y0', z0') by substituting the acquirer initial coordinates C0 and the difference ΔC into the above relational expression (2). This further improves the accuracy of the position correction of the site information acquirer 20.

[0082] The controller 50 repeats the processes from step S14 onwards until the condition for determining whether or not the position correction is necessary is no longer satisfied in step S15.

[0083] [Modification of First Embodiment] FIG. 6 is a diagram showing a work machine system 300 equipped with a work machine control device 40 according to a modification of the first embodiment.

[0084] A work machine system 300 according to a modified example shown in Figure 6 includes a work machine 100 and an external device 200 (external device for a work machine). In this modified example, the work machine 100 is equipped with a communication device 91, and the external device 200 is equipped with a communication device 92, so that the work machine 100 and the external device 200 can send and receive data to and from each other via wireless or wired communication.

[0085] The work machine control device 40 in this modified example has the same configuration and functions as the work machine control device 40 according to the embodiment described with reference to Figures 1 to 5. In this modified example, the work machine control device 40 may be included in the work machine 100 or the external device 200.

[0086] Also, in this modified example, the work machine 100 may include a portion of the configuration of the work machine control device 40, and the external device 200 may include the remaining configuration of the work machine control device 40. In this case, one of the correction controller 51 and the operation control controller 52 of the controller 50 shown in FIG. 3 may be mounted on the work machine 100, and the other may be mounted on the external device 200. Also, the assist data storage device 53 of the controller 50 shown in FIG. 3 may be mounted on the work machine 100 or on the external device 200.

[0087] The external device 200 may be, for example, a remote operation device for remotely operating 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 that is provided as a service over a network such as the Internet.

[0088] In the work machine system 300 according to this modified example, the controller 50 of the work machine control device 40 may perform position correction control, for example, as shown in the flowchart of FIG.

[0089] The cab 14 of the work machine 100 in the work machine system 300 according to the modified example shown in Figure 6 does not have to be an elevator cab that can rise and fall relative to the machine body, but may be a cab that can rotate relative to the machine body as in the second embodiment described below. In this case, the controller 50 in the work machine system 300 may perform position correction control, for example, as shown in the flowchart of Figure 8, as in the second embodiment described below.

[0090] Second Embodiment FIG. 7 is a diagram showing a work machine 100 equipped with a work machine control device 40 according to a second embodiment.

[0091] The work machine 100 according to the second embodiment differs from the work machine 100 according to the first embodiment in that a movable part (for example, the cab 14) rotates relative to the machine body rather than moves up and down relative to the machine body. The basic configuration of the work machine 100 according to the second embodiment is similar to the basic configuration of the work machine 100 according to the first embodiment. Therefore, the main features of the second embodiment that differ from the first embodiment will be described below, and a detailed description of the configuration of the second embodiment that is similar to that of the first embodiment will be omitted.

[0092] The work machine 100 according to the second embodiment shown in Figure 7 comprises a lower traveling body 1, an upper rotating body 2, a work implement 3, a plurality of actuators, an attitude information acquirer 80, a site information acquirer 20, and a work machine control device 40.

[0093] The upper revolving body 2 includes a revolving frame 11 and a cab 14. The cab 14 is rotatably supported by the revolving frame 11. The revolving frame 11 in the second embodiment is an example of a machine body. That is, in the second embodiment, the machine body includes the revolving frame 11.

[0094] The plurality of actuators in the second embodiment include a rotation actuator 17 instead of the lifting actuator 10 in the first embodiment. The rotation actuator 17 operates to rotate the cab 14 around a rotation axis A1 shown in FIG. 7 . The rotation axis A1 may be located, for example, at the rear of the cab 14. Specifically, the rotation axis A1 may be located at the rear and lower part of the cab 14 as shown in FIG. 7 . In this case, when the cab 14 rotates around the rotation axis A1 from a first position indicated by a solid line in FIG. 7 , the height of the front part of the cab 14 gradually increases, and the cab 14 reaches, for example, a second position indicated by a two-dot chain line in FIG. 7 . The first position may be, for example, a position when the rotation angle of the cab 14 with respect to the machine body (swivel frame 11) is zero degrees, specifically, a position where the floor of the cab 14 is approximately horizontal. The second position may be, for example, a position where the rotation angle of the cab 14 relative to the machine body (swivel frame 11) is greater than zero (for example, an acute angle).

[0095] The rotary actuator 17 may be, for example, a cylinder such as a hydraulic cylinder or an electric cylinder, or may be a motor such as a hydraulic motor or an electric motor. When the rotary actuator 17 is, for example, a hydraulic actuator such as a hydraulic cylinder or a hydraulic motor, the plurality of proportional valves 71 of the flow regulator may further include a pair of rotary proportional valves 71 for controlling the operation of the rotary actuator 17.

[0096] The attitude information acquirer 80, site information acquirer 20, and work machine control device 40 in the second embodiment are similar to the attitude information acquirer 80, site information acquirer 20, and work machine control device 40 in the first embodiment described with reference to Figures 1 to 5. In the second embodiment, the attitude information acquirer 80 also includes a plurality of attitude detectors 81 to 84, similar to the attitude information acquirer 80 in the first embodiment, the site information acquirer 20 is attached to the cab 14 (an example of a movable part), and the work machine control device 40 includes a controller 50 similar to the controller 50 shown in Figure 2.

[0097] In the second embodiment, the controller 50 may also store in advance an initial setting position for the cab 14. This initial setting position is a position of the cab 14 that is set in advance as a reference position when correcting the position of the site information acquirer 20. The initial setting position may be, for example, the first position shown in FIG.

[0098] The controller 50 may store in advance information (initial relative position information) regarding the relative position of the site information acquirer 20 with respect to the specific position SP when the cab 14 is disposed at the initial setting position (first position). Specifically, for example, the controller 50 may store, as the initial relative position information, acquirer initial coordinates C0, which are coordinates in the reference coordinate system with the specific position SP as the origin and are coordinates of the site information acquirer 20 when the cab 14 is disposed at the first position.

[0099] When the cab 14 rotates from a first position (the initial setting position) shown by the solid line in Figure 7 to a second position shown by the dotted line in Figure 7, and the relative position of the site information acquirer 20 with respect to the machine body (swivel frame 11) changes, the controller 50 may correct the position of the site information acquirer 20 as follows.

[0100] That is, the controller 50 may identify, as the first position information, a first coordinate C1 that is the coordinate of the reference position RP using work site information acquired by the work site information acquirer 20 when the cab 14 is disposed at the first position, and may identify, as the second position information, a second coordinate C2 that is the coordinate of the reference position RP using work site information acquired by the work site information acquirer 20 when the cab 14 is disposed at the second position. The controller 50 may also acquire first reference plane information that is information about the ground of the work site WS when the cab 14 is disposed at the first position, and acquire second reference plane information that is information about the ground of the work site WS when the cab 14 is disposed at the second position.

[0101] The first coordinate C1 may be the coordinate of a reference position RP identified by the controller 50 based on point cloud data input from the site information acquirer 20 to the controller 50 when the cab 14 is located at a first position. Similarly, the second coordinate C2 may be the coordinate of a reference position RP identified by the controller 50 based on point cloud data input from the site information acquirer 20 to the controller 50 when the cab 14 is located at a second position.

[0102] The first reference plane information may be information about the ground of the work site WS (e.g., information about the ground of the work target WT) identified by the controller 50 based on point cloud data input from the site information acquirer 20 to the controller 50 when the cab 14 is placed at the first position. Specifically, for example, the first reference plane information may include information about the first reference plane S1 as follows. The controller 50 may identify a plane corresponding to the ground as the first reference plane S1 based on the point cloud data input from the site information acquirer 20 when the cab 14 is placed at the first position. It is preferable that the first reference plane S1 is a horizontal plane.

[0103] The second reference plane information may be information about the ground surface of the work site WS (e.g., information about the ground surface of the work target WT) identified by the controller 50 based on point cloud data input from the site information acquirer 20 to the controller 50 when the cab 14 is disposed at the second position. Specifically, for example, the second reference plane information may include information about the second reference plane S2 as follows. The controller 50 may identify a plane corresponding to the ground surface as the second reference plane S2 based on the point cloud data input from the site information acquirer 20 when the cab 14 is disposed at the second position.

[0104] In addition, the first reference plane information may include information on the angle θ1 of the first reference plane S1 (e.g., the angle θ1 of the first reference plane S1 relative to a horizontal plane), and the second reference plane information may include information on the angle θ2 of the second reference plane S2 (e.g., the angle θ2 of the second reference plane S2 relative to a horizontal plane).

[0105] The controller 50 may identify the first reference surface S1 and the second reference surface S2 from the point cloud data using an algorithm for shape fitting, such as RANSAC (Random sample consensus) or MSAC (M-estimator sample consensus).

[0106] The reference position RP does not fluctuate at least during the time period when position correction control is performed. Meanwhile, the first coordinate C1 and the second coordinate C2 are each calculated using the initial relative position information (e.g., the acquirer initial coordinate C0). Therefore, even though the reference position RP does not fluctuate, the first coordinate C1 and the second coordinate C2 are different from each other. The difference ΔC between the first coordinate C1 and the second coordinate C2 corresponds to the change in the coordinate of the site information acquirer 20 that occurs as the cab 14 rotates from the first position (the initial setting position) to the second position. Moreover, in the second embodiment, because the cab 14 rotates around the rotation axis A1, the angle θ1 of the first reference plane S1 and the angle θ2 of the second reference plane S2 are different from each other.

[0107] Therefore, the controller 50 may correct the angle of the site information acquirer 20 using the angle θ1 of the first reference plane S1 and the angle θ2 of the second reference plane S2 (or the difference Δθ therebetween), and may also correct the position of the site information acquirer 20 using the difference ΔC between the first coordinate C1 and the second coordinate C2. Specifically, the controller 50 may calculate the acquirer corrected coordinate C0′ by substituting the acquirer initial coordinate C0 and the difference ΔC into a predetermined relational expression that is set to correct the position of the site information acquirer 20.

[0108] The calculated acquirer corrected coordinates C0' are coordinates in the reference coordinate system with the specific position SP as the origin, and are the coordinates of the site information acquirer 20 when the cab 14 is disposed at the second position. Therefore, the controller 50 can appropriately perform the assist control after the position correction control by using the acquirer corrected coordinates C0' corrected in the position correction control, the difference Δθ, and the point cloud data acquired by the site information acquirer 20. In other words, the assist control for the predetermined work that is performed with the cab 14 disposed at the second position is appropriately performed.

[0109] FIG. 8 is a flowchart showing the calculation process performed by the controller 50 of the work machine control device 40 according to the second embodiment.

[0110] As shown in FIG. 7, when the work machine 100 is positioned near the work object WT and the cab 14 is positioned in the initial setting position (first position), the controller 50 acquires the coordinates of the reference position RP (first coordinates C1) and the first reference plane S1 (step S21 in FIG. 8).

[0111] Specifically, in step S21, with the cab 14 positioned at the first position as the initial setting position, the controller 50 calculates a first coordinate C1 of the reference position RP and an angle θ1 of a first reference plane S1, which is a plane corresponding to the ground surface of the work site WS, using the point cloud data input from the site information acquirer 20. Then, the controller 50 stores the calculated first coordinate C1 and the angle θ1 of the first reference plane S1 (step S22).

[0112] Next, the controller 50 controls the operation of the rotation actuator 17 so as to rotate the cab 14 (step S23). Specifically, when the initial setting position is the first position, the controller 50 controls the operation of the rotation actuator 17 so as to rotate the cab 14 from the first position to the second position.

[0113] The second position is the position of the cab 14 when the work machine 100 performs work at a work site. The second position is determined appropriately depending on various conditions such as the type of work to be performed at the work site and the specifications of the work machine 100. The second position may be set, for example, based on an input operation by a person involved in the work. The input operation may be, for example, an operation on an input device in the cab 14, or an operation on an external device that is separate from the work machine 100. The second position may also be a position determined in response to a rotation operation applied by a person involved in the work to the operating device 16 in the cab 14, or a position determined in response to a rotation operation applied by a person involved in the work to the remote operating device. In this case, the cab 14 continues to rotate while a rotation operation is applied to the operating device 16 or the remote operating device.

[0114] When the rotation of the cab 14 is completed and the cab 14 is disposed at the second position, the controller 50 acquires the coordinates of the reference position RP (second coordinates C2) and the second reference plane S2 (step S24). Specifically, in step S24, with the cab 14 disposed at the second position, the controller 50 calculates the second coordinates C2 of the reference position RP and the angle θ2 of the second reference plane S2, which is a plane corresponding to the ground surface of the work site WS, using the point cloud data input from the site information acquirer 20.

[0115] Next, the controller 50 compares the angle θ1 of the first reference surface S1 with the angle θ2 of the second reference surface S2 to determine whether a predetermined condition for determining whether angle correction is necessary is satisfied (step S25). The condition for determining whether angle correction is necessary may be, for example, the condition that the angle θ1 of the first reference surface S1 and the angle θ2 of the second reference surface S2 do not match (Δθ=θ1-θ2≠0) as shown in step S25 of FIG. 8, or the condition that the difference Δθ between the angles θ1 and θ2 is not included in a predetermined allowable range Thθ (|θ1-θ2|>Thθ).

[0116] If the angle correction necessity determination condition is satisfied (YES in step S25), the controller 50 corrects the angle of the site information acquirer 20 using the difference Δθ between the angle θ1 and the angle θ2 as a correction value (step S26). Specifically, the controller 50 may correct the angle of the site information acquirer 20 by, for example, converting the point cloud data in the acquirer coordinate system input from the site information acquirer 20 so as to rotate it around the origin of the acquirer coordinate system by the difference Δθ.

[0117] Next, the controller 50 performs the process of step S24 again. That is, the controller 50 acquires the coordinates of the reference position RP (second coordinates C2) and the second reference plane S2 again (step S24). Specifically, in the second execution of step S24, the controller 50, with the cab 14 disposed at the second position, calculates the second coordinates C2 of the reference position RP and the angle θ2′ of the second reference plane S2, which is a plane corresponding to the ground surface of the work site WS, using the point cloud data input from the site information acquirer 20.

[0118] Next, the controller 50 compares the angle θ1 with the angle θ2' and determines whether the angle correction necessity determination condition is met (step S25). The angle θ1 is the angle of the first reference plane S1 stored in step S22, and the angle θ2' is the angle calculated in the second step S24. Therefore, in the comparison of the angle θ1 with the angle θ2 in the second step S25, the difference Δθ between the angle θ1 and the angle θ2 is smaller than in the first step S25.

[0119] Next, if the angle correction necessity determination condition is not satisfied (NO in step S25), the controller 50 performs the process of step S27. Specifically, for example, the controller 50 performs the process of step S27 if the angle θ1 and the angle θ2 are the same (Δθ=0) or if the difference Δθ is within the allowable range Thθ (|θ1−θ2|≦Thθ).

[0120] In step S27, the controller 50 compares the first coordinate C1 with the second coordinate C2 and determines whether the condition for determining whether position correction is necessary is satisfied. The condition for determining whether position correction is necessary may be, for example, the condition that the first coordinate C1 and the second coordinate C2 do not match (ΔC=C1-C2≠0) as shown in step S27 of FIG. 8, or the condition that the difference ΔC between the first coordinate C1 and the second coordinate C2 is not included in a predetermined allowable range Th (|C1-C2|>Th).

[0121] If the condition for determining whether or not the position correction is necessary is satisfied (YES in step S27), the controller 50 uses the difference ΔC between the first coordinate C1 and the second coordinate C2 as a correction value to correct the position of the site information acquirer 20 (step S28). Specifically, when the first coordinate C1 is (x1, y1, z1) and the second coordinate C2 is (x2, y2, z2), the difference ΔC is expressed, for example, by the above-mentioned relational expression (1).

[0122] The controller 50 stores in advance the acquirer initial coordinates C0 (x0, y0, z0) of the site information acquirer 20 when the cab 14 is placed at the first position (the initial setting position).

[0123] In step S28, the controller 50 obtains the acquirer corrected coordinates C0′ by correcting the acquirer initial coordinates C0 using the difference ΔC. Specifically, for example, the controller 50 may calculate the acquirer corrected coordinates C0′ (x0′, y0′, z0′) by substituting the acquirer initial coordinates C0 and the difference ΔC into the above relational expression (2).

[0124] Next, the controller 50 performs the processes from step S24 onward again. When the controller 50 reaches step S27, it compares the first coordinate C1 with the second coordinate C2 to determine whether the position correction necessity determination condition is met. The first coordinate C1 is calculated using the coordinates stored in step S22, i.e., the acquirer initial coordinate C0 (the initial relative position information), and the second coordinate C2 is calculated using the acquirer corrected coordinate C0'. Therefore, in the comparison between the first coordinate C1 and the second coordinate C2 in the second step S27, the difference ΔC between the first coordinate C1 and the second coordinate C2 is smaller than in the first step S27.

[0125] Next, if the condition for determining whether or not the position correction is necessary is not satisfied (NO in step S27), the controller 50 terminates the position correction control. Specifically, for example, the controller 50 may terminate the position correction control if the first coordinate C1 and the second coordinate C2 match (ΔC=0) or if the difference ΔC is within the allowable range Th (|C1-C2|≦Th).

[0126] On the other hand, if the position correction necessity determination condition is also satisfied in the second step S27 (YES in step S27), the controller 50 again corrects the position of the site information acquirer 20 using the difference ΔC between the first coordinate C1 and the second coordinate C2 (step S28). That is, in the second step S28, specifically, for example, the controller 50 may again calculate the acquirer corrected coordinates C0' (x0', y0', z0') by substituting the acquirer initial coordinates C0 and the difference ΔC into the above relational expression (2). This further improves the accuracy of the position correction of the site information acquirer 20.

[0127] The controller 50 repeats the processes from step S24 onwards until the condition for determining whether or not the position correction is necessary is no longer satisfied in step S27.

[0128] [Modification of the Second Embodiment] In the second embodiment shown in Fig. 7, the site information acquirer 20 is attached to the cab 14 that rotates about a rotation axis A1 relative to the machine body, but the site information acquirer 20 may also be attached to a working implement 3 (an example of a movable part) that is rotatably supported relative to the machine body. In the specific example of Fig. 7, the site information acquirer 20 is attached to the boom 4 (for example, the underside of the boom 4) that is rotatably supported on the machine body (the swivel frame 11 and the center section 15), as indicated by the dashed-dotted square in Fig. 7.

[0129] The controller 50 of the work machine control device 40 according to this modified example of the second embodiment may perform the same control as the controller 50 according to the second embodiment described with reference to FIGS. 7 and 8, specifically, for example, the position correction control shown in the flowchart of FIG. 8.

[0130] Furthermore, in a modified example of the second embodiment, instead of correcting the position of the site information acquirer 20 using the difference ΔC between the first coordinate C1 and the second coordinate C2 of the reference position RP, the controller 50 may correct the position of the site information acquirer 20 using the posture information of the work device 3 input to the controller 50 from the posture information acquirer 80.

[0131] [Other Modifications] 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 modifications.

[0132] (A) Modification 1 In the above embodiment, the controller 50 corrects the position of the site information acquirer 20 using the difference ΔC between the first coordinate C1 and the second coordinate C2 of the reference position RP, but the work machine 100 may be equipped with a lift sensor that detects the degree of elevation of the cab 14 (elevator cab), and the controller 50 may correct the position of the site information acquirer 20 based on the detection results input from the lift sensor.

[0133] The lifting sensor may be, for example, a sensor that detects the posture (e.g., the angle of the link member) of a link member (not shown) that moves in conjunction with the lifting and lowering of the cab 14 (elevator cab). In this case, the posture (angle of the link member) of the link member is a parameter correlated with the position of the site information acquirer 20. The first position information includes a first posture value (e.g., a first link angle) related to the posture of the link member input from the sensor when the cab 14 is located at a first position (e.g., the lowest position Pa). The second position information includes a second posture value (e.g., a second link angle) related to the posture of the link member input from the sensor when the cab 14 is located at a second position (e.g., the work position Px). The controller 50 may then correct the coordinates of the site information acquirer 20 using the difference between the first posture value and the second posture value.

[0134] The elevation sensor may also be, for example, a surveying instrument. The surveying instrument can acquire position information correlated with the position of the site information acquirer 20. It is preferable that a reflective member such as a prism is attached to the site information acquirer 20. In this case, the first position information includes position information (e.g., height information) of the site information acquirer 20 input from the surveying instrument when the cab 14 is located at a first position (e.g., the lowest position Pa), and the second position information includes position information (e.g., height information) of the site information acquirer 20 input from the surveying instrument when the cab 14 is located at a second position (e.g., the work position Px). The controller 50 may then correct the coordinates of the site information acquirer 20 using the difference between the first position information and the second position information.

[0135] (B) Modification 2 In the first embodiment, the work machine control device 40 is provided on the work machine 100, but the work machine control device in the present disclosure may be provided on an external device other than a work machine. Furthermore, in the specific example shown in Fig. 2, the controller 50 of the work machine control device 40 includes a correction controller 51, an operation control controller 52, and an assist data storage device 53, and the work machine 100 is provided with the controller 50, but the work machine 100 may be provided with some of the functions of the controller 50 of the work machine control device 40 (for example, the functions of the correction controller 51), and the external device 200 may be provided with other parts of the functions of the controller 50 of the work machine control device 40 (for example, the functions of the operation control controller 52). Furthermore, the controller 50 of the work machine control device 40 may be provided with the correction controller 51, and may not be provided with at least one of the operation control controller 52 and the assist data storage device 53.

[0136] (C) Modification 3 The autonomous driving data does not necessarily have to be stored in the assist data storage device 53, but may be stored in an external device separate from the work machine 100. In this case, the controller 50 may acquire the autonomous driving data stored in the external device by wireless or wired communication via a communication device, and perform the assist control using the acquired autonomous driving data.

[0137] (D) Modification 4 In the above embodiment, the reference position RP is the position of the reference object 60 placed at the work site WS, but this is not limited to this. The reference position RP may be, for example, a predetermined position on the machine body. In this case, the machine body is a part that is not linked to the raising / lowering or rotation of the cab 14. Specifically, the machine body may be the undercarriage 1 or a part of the upper rotating body 2 other than the cab 14. The predetermined position may be a position that is set in advance on the undercarriage 1 or a position that is set in advance on a part of the upper rotating body 2 other than the cab 14. For example, a reflective material may be placed at the predetermined position.

[0138] Furthermore, the reference position RP may be the position of a reference object 60 supported by the machine body, for example, as shown in Fig. 9 . Specifically, the machine body may be the lower traveling body 1, or a portion of the upper rotating body 2 other than the cab 14. As in the specific example of Fig. 9 , the reference object 60 may be supported by a frame (not shown) of the lower traveling body 1, or may be supported at the rear of the upper rotating body 2 (for example, an outer wall defining a machine room). The reference object 60 may be supported by the machine body via, for example, a rod-shaped support member.

[0139] 5, step S15 may be omitted. That is, after calculating the second coordinate C2 of the reference position RP in step S14, the controller 50 may correct the position of the site information acquirer 20 using the difference ΔC between the first coordinate C1 and the second coordinate C2 as a correction value in step S16 without performing the processing of step S15, and then end the position correction control.

[0140] (F) Modification 6 In the above embodiment, the reference coordinate system used when correcting the position of the site information acquirer 20 is a three-dimensional coordinate system, but if, for example, only information regarding coordinates on vertical coordinate axes and information regarding coordinates on front-rear coordinate axes is required for the correction, the reference coordinate system may be a two-dimensional coordinate system (for example, a two-dimensional coordinate system including vertical coordinate axes and front-rear coordinate axes). Also, if, for example, only information regarding coordinates on vertical coordinate axes (height direction) is required for the correction, the reference coordinate system may be a one-dimensional coordinate system (for example, a one-dimensional coordinate system including vertical coordinate axes).

[0141] (G) Modification 7 In the above embodiment, the site information acquirer 20 is a three-dimensional position information acquirer configured to acquire three-dimensional position information (e.g., point cloud data) of objects present at the work site, but is not limited to this. The site information acquirer in the present disclosure may be any device that is attached to a movable part that can change its position relative to the machine body and acquires work site information, which is information about the work site, and may be, for example, an imaging device such as a camera that is attached to a movable part such as a cab and captures images of the periphery of the work machine.

[0142] 10 is a diagram showing a work machine system equipped with a work machine control device according to a reference example. In this reference example, the work machine system includes a work machine 100 and a site information acquirer 20, and this site information acquirer 20 is not attached to a movable part such as the cab 14 or work implement 3 of the work machine 100, but is located at the work site WS.

[0143] In this reference example, for example, when the work machine 100 travels through the work site WS, the relative position between the work machine 100 and the site information acquirer 20 (specifically, the relative position between the specific position SP of the work machine 100 and the site information acquirer 20) changes. In this case, the controller 50 of the work machine control device 40 may correct the position of the site information acquirer 20 using first position information that correlates with the position of the site information acquirer 20 when the work machine 100 is located at an initial position (first position) at the work site WS, and second position information that correlates with the position of the site information acquirer 20 when the work machine 100 is located at a second position (position different from the first position) at the work site WS.

[0144] In this reference example, each of the first position information and the second position information may be, for example, position information of the work machine 100 contained in the point cloud data input from the site information acquirer 20 to the controller 50, or may be position information of the work machine 100 contained in the measurement results input to the controller 50 from a measuring device other than the site information acquirer 20.

[0145] As described above, a work machine control device, a work machine, an external device for a work machine, a work machine system, and a position correction method are provided that are capable of appropriately controlling a work machine using work site information acquired by a site information acquirer.

[0146] The work machine control device of the first aspect is a work machine control device for controlling a work machine that includes a machine main body, a movable part that can change its relative position with respect to the machine main body, and a site information acquirer that is attached to the movable part and acquires work site information, which is information about the work site, and includes a controller that corrects the position of the site information acquirer using first position information that correlates with the position of the site information acquirer when the movable part is positioned at a first position, and second position information that correlates with the position of the site information acquirer when the movable part is positioned at a second position different from the first position.

[0147] In the work machine control device according to this first aspect, even if the relative position between the site information acquirer attached to the movable part and the work object at the work site changes as the movable part displaces relative to the machine body, the controller corrects the position of the site information acquirer using the first position information and the second position information, so that the work machine is appropriately controlled using the work site information acquired by the site information acquirer.

[0148] A second aspect preferably includes the following configuration in addition to the work machine control device according to the first aspect. That is, in the work machine control device according to the second aspect, the controller is preferably configured to identify first coordinates, which are coordinates of a reference position, as the first position information, using the work site information acquired by the site information acquirer when the movable part is disposed at the first position, and to identify second coordinates, which are coordinates of the reference position, as the second position information, using the work site information acquired by the site information acquirer when the movable part is disposed at the second position. In this second aspect, the first position information and the second position information can be acquired using the work site information acquired by the site information acquirer when the movable part is disposed at the first position and the second position, respectively.

[0149] In a third aspect, it is preferable that the work machine control device according to the second aspect further comprises the following configuration: That is, in the work machine control device according to the third aspect, it is preferable that the controller corrects the position of the site information acquirer using the difference between the first coordinates and the second coordinates.

[0150] A fourth aspect preferably provides the work machine control device according to the second or third aspect further comprising the following configuration. That is, in the work machine control device according to the fourth aspect, the reference position is preferably the position of a reference object that is an object placed at the work site, a predetermined position on the machine body, or the position of a reference object that is an object supported by the machine body. When the reference object is placed at the work site, it is more preferable that the reference object is placed at a position higher than the ground at the work site. In this fourth aspect, the reference position for correcting the position of the site information acquirer can be easily set.

[0151] In a fifth aspect, it is preferable that the work machine control device according to any one of the second to fourth aspects further comprises the following configuration. That is, in the work machine control device according to the fifth aspect, it is preferable that the site information acquirer is a three-dimensional position information acquirer capable of acquiring three-dimensional position information of the work site, and the controller uses the three-dimensional position information input from the three-dimensional position information acquirer to control the operation of the work machine and perform assist control to assist people involved in the work. In this fifth aspect, the work site information (the three-dimensional position information) acquired by the site information acquirer (the three-dimensional position information acquirer) is used both to identify the first position information and the second position information and for the assist control. This makes it possible to prevent an increase in devices such as sensors.

[0152] In a sixth aspect, it is preferable that the construction machine control device according to any one of the first to fifth aspects further comprises the following configuration. That is, in the construction machine control device according to the sixth aspect, it is preferable that the movable part is a cab that can be raised and lowered relative to the machine body. In this sixth aspect, even if the cab is a so-called elevator cab, it becomes possible to attach the site information acquirer to the cab.

[0153] A seventh aspect may further include the following configuration in the construction machine control device according to any one of the first to fifth aspects. That is, in the construction machine control device according to the seventh aspect, the movable part may be a cab that is rotatable relative to the machine body. In this seventh aspect, even if the cab rotates relative to the machine body, it becomes possible to attach the site information acquirer to the cab.

[0154] An eighth aspect is preferably the work machine control device according to the seventh aspect, further comprising the following configuration. That is, in the work machine control device according to the eighth aspect, it is preferable that the controller corrects the angle of the site information acquirer using first reference plane information, which is information about the ground surface of the work site when the movable part is disposed at the first position, and second reference plane information, which is information about the ground surface of the work site when the movable part is disposed at the second position. In this eighth aspect, since the angle of the site information acquirer can also be corrected, when the site information acquirer is attached to a cab that is rotatable relative to the machine body, the work machine can be controlled more appropriately using the work site information acquired by the site information acquirer.

[0155] A ninth aspect may be the construction machine control device according to any one of the first to fifth aspects, further comprising the following configuration. That is, in the construction machine control device according to the ninth aspect, the movable part may be a work device that is rotatable relative to the machine body. In this ninth aspect, it becomes possible to attach the site information acquirer to a work device that is rotatable relative to the machine body.

[0156] A work machine according to a tenth aspect comprises a machine main body, a movable part that is capable of changing its position relative to the machine main body, a site information acquirer attached to the movable part, and the work machine control device according to any one of aspects 1 to 9. In the work machine according to this tenth aspect, even if the relative position of the site information acquirer attached to the movable part and the work target at the work site changes as the movable part is displaced relative to the machine main body, the controller corrects the position of the site information acquirer using the first position information and the second position information, so that the work machine can be appropriately controlled using the work site information acquired by the site information acquirer.

[0157] An external device for a work machine according to an eleventh aspect includes the work machine control device according to any one of aspects 1 to 9. Even if the relative position of the site information acquirer attached to the movable part and the work target at the work site changes as the movable part displaces with respect to the machine main body, in the external device for a work machine according to the eleventh aspect, the controller corrects the position of the site information acquirer using the first position information and the second position information, so that the work machine is appropriately controlled using the work site information acquired by the site information acquirer.

[0158] A twelfth aspect is a work machine system comprising a work machine and an external device, the work machine system including the work machine control device according to any one of aspects 1 to 9. In the work machine system according to this twelfth aspect, even if the relative position of the site information acquirer attached to the movable part and the work target at the work site changes as the movable part displaces with respect to the machine body, the controller corrects the position of the site information acquirer using the first position information and the second position information, so that the work machine is appropriately controlled using the work site information acquired by the site information acquirer.

[0159] A position correction method according to a thirteenth aspect is a position correction method for a work machine including a machine main body, a movable unit capable of changing its position relative to the machine main body, and a site information acquirer attached to the movable unit and acquiring work site information, which is information about the work site, the position correction method including a controller correcting the position of the site information acquirer using first position information correlating with the position of the site information acquirer when the movable unit is located at a first position, and second position information correlating with the position of the site information acquirer when the movable unit is located at a second position different from the first position. In this position correction method according to the thirteenth aspect, even if the relative position of the site information acquirer attached to the movable unit and a work object at the work site changes as the movable unit displaces with respect to the machine main body, the controller corrects the position of the site information acquirer using the first position information and the second position information, so that the work machine can be appropriately controlled using the work site information acquired by the site information acquirer.

Claims

1. A work machine control device for controlling a work machine comprising a machine body, a movable part whose position relative to the machine body can be changed, and a site information acquirer attached to the movable part and which acquires work site information, which is information about the work site, the work machine control device comprising a controller which corrects the position of the site information acquirer using first position information which correlates with the position of the site information acquirer when the movable part is located at a first position, and second position information which correlates with the position of the site information acquirer when the movable part is located at a second position different from the first position.

2. A work machine control device as described in claim 1, wherein the controller is configured to identify first coordinates, which are coordinates of a reference position, as the first position information using the work site information acquired by the work site information acquirer when the movable part is placed at the first position, and to identify second coordinates, which are coordinates of the reference position, as the second position information using the work site information acquired by the work site information acquirer when the movable part is placed at the second position.

3. The work machine control device according to claim 2, wherein the controller corrects the position of the site information acquirer using the difference between the first coordinates and the second coordinates.

4. A work machine control device as described in claim 2 or 3, wherein the reference position is the position of a reference object that is an object placed at the work site, a predetermined position on the machine body, or the position of a reference object that is an object supported by the machine body.

5. A work machine control device according to any one of claims 2 to 4, wherein the site information acquirer is a three-dimensional position information acquirer capable of acquiring three-dimensional position information of the work site, and the controller uses the three-dimensional position information input from the three-dimensional position information acquirer to control the operation of the work machine and perform assist control to assist people involved in the work.

6. A work machine control device according to any one of claims 1 to 5, wherein the movable part is a cab that can be raised and lowered relative to the machine body.

7. A work machine control device according to any one of claims 1 to 5, wherein the movable part is a cab that is rotatable relative to the machine body.

8. A work machine control device as described in claim 7, wherein the controller corrects the angle of the site information acquirer using first reference plane information, which is information about the ground surface of the work site when the movable part is positioned at the first position, and second reference plane information, which is information about the ground surface of the work site when the movable part is positioned at the second position.

9. A work machine control device according to any one of claims 1 to 5, wherein the movable part is a work device that is rotatable relative to the machine body.

10. A work machine comprising: a machine body; a movable part whose relative position with respect to the machine body can be changed; a site information acquirer attached to the movable part; and a work machine control device according to any one of claims 1 to 9.

11. An external device for a work machine, comprising the work machine control device according to any one of claims 1 to 9.

12. A work machine system comprising a work machine and an external device, the work machine system including a work machine control device according to any one of claims 1 to 9.

13. A position correction method for a work machine comprising a machine body, a movable part that can change its position relative to the machine body, and a site information acquirer that is attached to the movable part and acquires work site information, which is information about the work site, the position correction method including a controller correcting the position of the site information acquirer using first position information that correlates with the position of the site information acquirer when the movable part is located at a first position, and second position information that correlates with the position of the site information acquirer when the movable part is located at a second position different from the first position.

Images