WORK MACHINE

Abstract

Provided is a work machine capable of appropriately controlling a loading work onto a carrier machine by verifying validity of a recognition result of the carrier machine. A hydraulic excavator includes an external measuring device that measures a surrounding environment, an information processing device that recognizes a dump truck present around the hydraulic excavator based on a measurement result of the external measuring device, a control device that controls an operation of the hydraulic excavator based on a recognition result of the information processing device, and a truck information acquisition device that acquires a position and vehicle class information of the dump truck through external communication. The information processing device corrects the recognition result of the dump truck based on the information acquired by the truck information acquisition device. The control device controls the operation of the hydraulic excavator based on the corrected recognition result of the dump truck.

Description

TECHNICAL FIELD

The present invention relates to a work machine.

BACKGROUND ART

Articulated work machines (for example, hydraulic excavators) with front work devices (for example, booms, arms, and attachments such as buckets) driven by hydraulic actuators are known. This type of work machine performs loading works to load excavated target objects such as earth and sand onto carrier machines (for example, dump trucks), which are machines to be loaded.

When performing the loading works, if the front work device is swinged in a position where its height (for example, a bucket height) is lower than a height of the carrier machine, there is a possibility that the front work device may collide with the carrier machine. Therefore, there is a need for a function to assist an operation of an operator of a work machine performing the loading works and for technology that allows the work machine to perform the loading works automatically. When a work machine performs semi-automatic or fully automatic (hereinafter collectively referred to as “automatic”) loading works, it is necessary for the work machine to accurately recognize a position and a posture of the carrier machine.

As a conventional technology for recognizing the carrier machines, there is, for example, the technology described in Patent Literature 1. Patent Literature 1 discloses an image processing system including a data acquisition section configured to acquire a captured image showing a loading/unloading target of a transporting material of a work machine: an area-identifying section configured to identify an area including the loading/unloading target from the captured image; and a loading/unloading target-identifying section configured to identifies at least one predetermined surface of the loading/unloading target from the area including the loading/unloading target.

CITATION LIST

Patent Literature

• Patent Literature 1: JP 2020-126363 A

SUMMARY OF INVENTION

Technical Problem

The technology disclosed in Patent Literature 1 uses an image recognition system with machine learning to detect the position and the posture of the carrier machine from the image captured by a camera attached to the work machine in order to identify the carrier machine. However, it is difficult for the recognition system using the machine learning to guarantee validity of a recognition result and a recognition accuracy for sites or carrier machines for which no training data has been collected.

In addition, if a third-party system is incorporated as the recognition system for the carrier machine, details of an algorithm of the recognition system may not be disclosed to a development company of the work machine. It is not easy for the work machine developer to verify the recognition results of the recognition system. It is difficult for the work machine developer to determine in advance whether the recognition results of the recognition system can be used to properly control the loading work without colliding with the carrier machine.

The present invention is made in view of the above problems to provide a work machine capable of appropriately controlling the loading work onto a carrier machine by accurately recognizing the position and the posture of the carrier machine in various situations.

Solution to Problem

In order to achieve the above-described objective, a work machine according to the present invention is for loading a target object onto a carrier machine. The work machine includes an external measuring device, an information processing device, a control device, and a carrier machine information acquisition device. The external measuring device measures a surrounding environment of a body of the work machine. The information processing device recognizes the carrier machine present around the body based on a measurement result of the external measuring device. The control device controls an operation of the body based on a recognition result of the information processing device. The carrier machine information acquisition device acquires a position and vehicle class information of the carrier machine from an external source. The information processing device corrects a recognition result of the carrier machine based on the position and the vehicle class information of the carrier machine acquired by the carrier machine information acquisition device. The control device controls the operation of the body based on the corrected recognition result of the carrier machine.

Advantageous Effects of Invention

According to the present invention, it is possible to provide the work machine capable of appropriately controlling the loading works onto the carrier machines by accurately recognizing the position and the posture of the carrier machine in various situations.

The problems, configurations and effects other than the above will be clarified by the description of the following embodiments.

BRIEF DESCRIPTION OF DRAWINGS

FIG. 1 is a schematic side view of an exterior configuration of a hydraulic excavator as an example of a work machine of Embodiment 1.

FIG. 2 is a block diagram illustrating a hydraulic system and a control system mounted on the hydraulic excavator illustrated in FIG. 1.

FIG. 3 is a diagram illustrating an example of an operation of the hydraulic excavator illustrated in FIG. 2.

FIG. 4 is a flowchart illustrating an example of the operation of the hydraulic excavator illustrated in FIG. 2.

FIG. 5 is a block diagram illustrating a functional configuration of an information processing device illustrated in FIG. 2.

FIG. 6 is a view illustrating respective coordinate systems set up on the hydraulic excavator, viewed from side.

FIG. 7 is a view illustrating respective coordinate systems illustrated in FIG. 6, viewed from above.

FIG. 8 is a view of a body coordinate system of a dump truck, viewed from side.

FIG. 9 is a view illustrating the body coordinate system illustrated in FIG. 8, viewed from above.

FIG. 10 is a flowchart illustrating an example of a recognition result verification process.

FIG. 11 is a view illustrating an overlap degree of a recognition area and an estimated area.

FIG. 12 is a view illustrating a table that defines criteria for determining validities of recognition results and methods of correction of recognition areas for respective tasks of the hydraulic excavator.

FIG. 13 is a view illustrating a method of correcting the recognition area when acquiring a loading task.

FIG. 14 is illustrating a method of correcting the recognition area when acquiring a reaching task.

FIG. 15 is a view illustrating an example of a display device when a confidence of a recognition result is equal to or lower than a threshold.

FIG. 16 a block diagram illustrating a functional configuration of an information processing device of Embodiment 2.

FIG. 17 is a view illustrating a process of a truck posture estimation section illustrated in FIG. 16.

FIG. 18 is a block diagram illustrating a functional configuration of an information processing device of Embodiment 3.

DESCRIPTION OF EMBODIMENTS

The embodiments of the invention will be described below using the drawings. Unless otherwise mentioned, the same configuration with the same numeral reference in each embodiment has the same function in each embodiment, and its description is omitted.

A work machine according to the present embodiment is a work machine that performs loading works to load excavated target objects such as earth and sand onto the carrier machine, which is a machine to be loaded. In the following exemplary description, a hydraulic excavator including a bucket is used as the work machine, and a dump truck is used as the carrier machine. However, the work machine according to the present embodiment may be a hydraulic excavator including an attachment other than the bucket, or a work machine other than the hydraulic excavator. The carrier machine according to the present embodiment may be a carrier machine other than the dump truck.

Embodiment 1

FIGS. 1 to 15 are used to describe the hydraulic excavator 1 of Embodiment 1.

<Exterior Configuration of Hydraulic Excavator>

FIG. 1 is a schematic side view of an exterior configuration of a hydraulic excavator 1 as an example of a work machine of Embodiment 1.

The hydraulic excavator 1 includes an articulated front work device 2 that holds the target object and turns in the vertical or front-back direction, and a machine main body 3 that includes the front work device 2.

The machine main body 3 includes a lower traveling body 5 that is driven by a right traveling hydraulic motor 4a and a left traveling hydraulic motor 4b provided on the right and left parts of the lower traveling body 5, and an upper swing body 7 that is attached to an upper part of the lower traveling body 5 via a swinging device and swinged by a swinging hydraulic motor 6 of the swinging device. In the present embodiment, the right traveling hydraulic motor 4a and the left traveling hydraulic motor 4b are also collectively referred to as “traveling hydraulic motors 4a and 4b.”

The front work device 2 is an articulated work apparatus constituted of a plurality of front members attached to a front of the upper swing body 7. The upper swing body 7 on which the front work device 2 is mounted swings. The front work device 2 includes a boom 8 vertically turnably connected to the front of the upper swing body 7, an arm 9 vertically turnably connected to a distal part of the boom 8, and a bucket 10 vertically turnably connected to a distal part of the arm 9.

The boom 8 is connected to the upper swing body 7 by a boom pin 8a and is turned by expansion and contraction of a boom cylinder 11. The arm 9 is connected to the distal part of the boom 8 by an arm pin 9a and is turned by expansion and contraction of an arm cylinder 12. The bucket 10 is connected to the distal part of the arm 9 by a bucket pin 10a and a bucket link 16, and is turned by expansion and contraction of a bucket cylinder 13.

A boom angle sensor 14 is attached to the boom pin 8a to detect a turn angle of the boom 8. An arm angle sensor 15 is attached to the arm pin 9a to detect a turn angle of the arm 9. A bucket angle sensor 17 is attached to the bucket link 16 to detect a turn angle of the bucket 10.

Each turn angle of the boom 8, the arm 9, and the bucket 10 may be acquired by detecting each angle of the boom 8, the arm 9, and the bucket 10 with respect to a reference plane such as the horizontal plane using an inertial measurement device and converting it to each of the turn angles. Each turn angle of the boom 8, the arm 9, and the bucket 10 may be acquired by detecting each stroke of the boom cylinder 11, the arm cylinder 12, and the bucket cylinder 13 with a stroke sensor and converting it to each of the turn angles.

An inclination angle sensor 18 is attached to the upper swing body 7 to detect an inclination angle of the machine main body 3 with respect to the reference plane such as the horizontal plane. A swinging device between the lower traveling body 5 and the upper swing body 7 includes a swing angle sensor 19 to detect a swing angle, which is a relative angle of the upper swing body 7 with respect to the lower traveling body 5. An angular speed sensor (not illustrated) is attached to the upper swing body 7 to detect an angular speed of the upper swing body 7. In the present embodiment, the boom angle sensor 14, the arm angle sensor 15, the bucket angle sensor 17, the inclination angle sensor 18, and the swing angle sensor 19 are also collectively referred to as a “posture detection device 53.” The posture detection device 53 detects the respective turn angles of the front work device 2, the swing angle of the upper swing body 7, and the like.

In a cab provided on the upper swing body 7, a display device 55 constituted of a touch screen or the like that can accept operator input is installed. In addition, an operating device for operating a plurality of hydraulic actuators 4a, 4b, 6, 11, 12, and 13 is installed in the cab provided on the upper swing body 7. Specifically, the operating devices include a traveling right lever 23a for operating the right traveling hydraulic motor 4a, a traveling left lever 23b for operating the left traveling hydraulic motor 4b, an operation right lever 22a for operating the boom cylinder 11 and the bucket cylinder 13, and an operation left lever 22b for operating the arm cylinder 12 and the swinging hydraulic motor 6. In the present embodiment, the traveling right lever 23a, the traveling left lever 23b, the operation right lever 22a, and the operation left lever 22b are also collectively referred to as “operation levers 22, 23.”

An external measuring device 70 is also attached to the upper swing body 7 to measure a surrounding environment of a body of the hydraulic excavator 1. The external measuring device 70 measures a depth (a distance to an object) of an object present around the hydraulic excavator 1. The external measuring device 70 acquires depth information of the object as a measurement result. The external measuring device 70 may be, for example, a light detection and ranging (LiDAR) or a stereo camera. A plurality of the external measuring device 70 may be installed on the hydraulic excavator 1.

A positioning device 60 is also attached to the upper swing body 7 to measure a position and an orientation of the hydraulic excavator 1 at a site. The positioning device 60 acquires positioning information including the position and the orientation of the hydraulic excavator 1 at the site as the measurement result. The positioning device 60 may be, for example, a GNSS receiver, a total station (TS), or other surveying devices. The positioning device 60 may be, but is not limited to, for example, a camera fixed at the site. In this case, the positioning device 60 may measure the position and the orientation of the hydraulic excavator 1 at the site based on the information calculated from the detected image of the hydraulic excavator 1. In this case, at least two of the positioning devices 60 preferred to be provided to accurately measure the orientation of the hydraulic excavator 1.

A truck information acquisition device 56 is also attached to the upper swing body 7 to acquire truck information, which includes position, posture, and vehicle class information of the dump truck 200, from an external source. The vehicle class information includes information on a vehicle type and dimensions of the dump truck 200. The truck information acquisition device 56 may be a communication terminal that performs wireless communication with a position and dispatch management system of the dump trucks 200, such as a fleet management system (FMS), for example. The truck information acquisition device 56 can acquire truck information by receiving the truck information of the dump trucks 200 transmitted from the position and dispatch management system of the dump trucks 200. The truck information acquisition device 56 may be configured as software implementing functions of the truck information acquisition device 56 and may be embedded in an information processing device 54.

Most of the position and dispatch management systems of the dump trucks 200, such as FMSs, have an adjustment function to match the positional information of the dump truck 200 acquired from the GNSS receiver of the dump truck 200 with a route on a map. The truck information acquisition device 56 can acquire information regarding the position adjustment amount of the dump truck 200 based on the adjustment function and the truck information of the dump truck 200 at the same time from the position and dispatch management system.

A task acquisition device 58 is also attached to the upper swing body 7 to acquire a task indicating the next operation contents (or the work contents) to be performed by the hydraulic excavator 1. The task acquisition device 58 may be, for example, a communication terminal that performs wireless communication with a management device that manages the work site. The task acquisition device 58 can acquire the tasks by receiving the tasks of the hydraulic excavator 1 transmitted from the management device. The task acquisition device 58 may be configured by a communication terminal shared with the truck information acquisition device 56. The task acquisition device 58 may be configured as software that implements functions of the task acquisition device 58 and may be embedded in the information processing device 54. The task acquisition device 58 may also acquire the task by automatically determining the task from the operation of the operation levers 22, 23 by the operator. The task acquisition device 58 may be an input terminal that can be operated by the operator, and may acquire the task by accepting the operator input. The method of acquiring the tasks is not limited in the present embodiment.

<Internal Configuration of Hydraulic Excavator>

FIG. 2 is a block diagram illustrating a hydraulic system and a control system mounted on the hydraulic excavator 1 illustrated in FIG. 1.

An engine 103, which is a prime mover mounted on the upper swing body 7, drives a hydraulic pump 102 and a pilot pump 104. The control device 40 controls a turning movement of the front work device 2, a traveling movement of the lower traveling body 5, and a swinging movement of the upper swing body 7 (that is, the movement of the body of the hydraulic excavator 1 constituted thereof) according to the operation information (operation amount and operation direction) of the operation levers 22, 23 by the operator. Specifically, the control device 40 detects the operation information (operation amount and operation direction) of the operation levers 22, 23 by the operator using sensors 52a to 52f such as rotary encoders or potentiometers, and outputs control commands to solenoid proportional valves 47a to 471 in accordance with the detected operation information. The solenoid proportional valves 47a to 471 are installed in a pilot line 100 and are activated when the control commands from the control device 40 is input, and output pilot pressures to a flow control valve 101 to activate the flow control valve 101.

The flow control valve 101 controls a pressure oil supplied from the hydraulic pump 102 to each of the swinging hydraulic motor 6, the arm cylinder 12, the boom cylinder 11, the bucket cylinder 13, the right traveling hydraulic motor 4a, and the left traveling hydraulic motor 4b according to the pilot pressures from the solenoid proportional valves 47a to 471. The solenoid proportional valves 47a, 47b output a pilot pressure to the flow control valve 101 to control the pressure oil supplied to the swinging hydraulic motor 6. The solenoid proportional valves 47c, 47d output a pilot pressure to the flow control valve 101 to control the pressure oil supplied to the arm cylinder 12. The solenoid proportional valves 47e, 47f output a pilot pressure to the flow control valve 101 to control the pressure oil supplied to the boom cylinder 11. The solenoid proportional valves 47g, 47h output a pilot pressure to the flow control valve 101 to control the pressure oil supplied to the bucket cylinder 13. The solenoid proportional valves 47i, 47j output a pilot pressure to the flow control valve 101 to control the pressure oil supplied to the traveling right traveling hydraulic motor 4a. The solenoid proportional valves 47k, 471 output a pilot pressure to the flow control valve 101 to control the pressure oil supplied to the traveling left traveling hydraulic motor 4b.

The boom cylinder 11, the arm cylinder 12, and the bucket cylinder 13 expand and contract by the supplied pressure oils to rotate the boom 8, the arm 9, and the bucket 10, respectively. This changes the position and the posture of the bucket 10. The swinging hydraulic motor 6 is rotated by the supplied pressure oil to swing the upper swing body 7. The right traveling hydraulic motor 4a and the left traveling hydraulic motor 4b are rotate by the supplied pressure oils for causing the lower traveling body 5 to travel.

The control device 40 can automatically (semi-automatically or fully automatically) control the movements of the body of the hydraulic excavator 1 (the turning movement of the front work device 2, the traveling movement of the lower traveling body 5, and the swinging movement of the upper swing body 7) based on the recognition results of the information processing device 54. The information processing device 54 recognizes the dump truck 200 present around the hydraulic excavator 1 based on the measurement result of the external measuring device 70. The information processing device 54 is constituted of a computer including a Central Processing Unit (CPU) 73, a Random Access Memory (RAM) 72, a Read Only Memory (ROM) 71, and an external I/F (Interface) 74, and the like connected to each other by a bus 75. The control device 40, the display device 55, the external measuring device 70, the positioning device 60, the posture detection device 53, the task acquisition device 58, the truck information acquisition device 56, and a storage device 57 (for example, hard disk drive or large capacity flash memory) are connected to an external I/F 74.

<Outline of Operation of Hydraulic Excavator>

FIG. 3 is a diagram illustrating an example of an operation of the hydraulic excavator 1 illustrated in FIG. 2.

The dump truck 200 stops at a predetermined position where the hydraulic excavator 1 can load the target object. The task acquisition device 58 of the hydraulic excavator 1 acquires a loading task for the next task, which is to load the excavated target objects such as earth and sand onto the dump truck 200. When the loading task is acquired, first, the external measuring device 70 of the hydraulic excavator 1 measures a vessel of the dump truck 200. Subsequently, the information processing device 54 of the hydraulic excavator 1 calculates a recognition area and an estimated area described below for a presence area 210 of the dump truck 200. The information processing device 54 of the hydraulic excavator 1 calculates the position of the bucket 10 when loading the target object from the bucket 10 onto the vessel of the dump truck 200 (hereinafter also referred to as “loading position”). Based on the calculated recognition area and estimated area of the dump truck 200 and the loading position, the control device 40 of the hydraulic excavator 1 outputs the control commands to move the bucket 10 to the loading position such that the front work device 2 does not collide with the dump truck 200. This allows the hydraulic excavator 1 to automatically control the loading work appropriately without colliding with the dump truck 200.

In the present embodiment, as illustrated in FIG. 3, the dump truck 200 is assumed to be parked at a predetermined position where the hydraulic excavator 1 can load the target objects. Specifically, it is assumed that the dump truck 200 of the present embodiment has a position of the dump truck 200 at the work site controlled by the position and dispatch management system of the dump trucks 200, such as FMS. However, there is no limitation on how the dump truck 200 is controlled until the dump truck 200 stops at a predetermined position. For example, the dump truck 200 may be stopped at a predetermined position by the operator of the dump truck 200. In the present embodiment, the operator of the hydraulic excavator 1 may visually confirm that the dump truck 200 has stopped at the predetermined position, or the information processing device 54 may recognize that the dump truck 200 has stopped at the predetermined position based on the measurement result of the external measuring device 70.

The external measuring device 70 of FIG. 3 is mounted to face the left side of the hydraulic excavator 1, but may be mounted to face the front of the hydraulic excavator 1. Furthermore, the hydraulic excavator 1 may further include the external measuring device 70 mounted to face the right side or rear of the hydraulic excavator 1.

FIG. 4 is a flowchart illustrating an example of the operation of the hydraulic excavator 1 illustrated in FIG. 2.

In Step S111, the task acquisition device 58 of the hydraulic excavator 1 acquires an excavation task to excavate the ground to be excavated.

In Step S112, the control device 40 of the hydraulic excavator 1 controls the turning movement of the front work device 2 to cause the hydraulic excavator 1 to perform the excavation operation according to the acquired excavation task.

In Step S113, the task acquisition device 58 of the hydraulic excavator 1 acquires a loading task for loading the excavated target object such as earth and sand onto the dump truck 200.

In Step S114, the control device 40 of the hydraulic excavator 1 controls the turning movement of the front work device 2 and the swinging movement of the upper swing body 7 to cause the hydraulic excavator 1 to perform the loading operation according to the acquired loading task.

In Step S115, the control device 40 of the hydraulic excavator 1 determines whether or not to terminate the loading onto the dump truck 200. The operator of the hydraulic excavator 1 may notify the control device 40 that the loading onto the dump truck 200 is terminated by operating the certain operation levers 22, 23 or by entering information on the display device 55, after visual confirmation. The control device 40 may determine to terminate the loading onto the dump truck 200 by the notification of these operations from the operator. Alternatively, the control device 40 may determine to terminate the loading onto the dump truck 200 based on the determination result of a load determination device that measures the load of the target object loaded onto the dump truck 200 to determine that the load is appropriate. When the loading onto the dump truck 200 is determined to be terminated, the control device 40 proceeds to Step S118. When the loading onto the dump truck 200 is determined not to be terminated, the control device 40 proceeds to Step S116.

In Step S116, the task acquisition device 58 of the hydraulic excavator 1 acquires a reaching task for moving the front work device 2 to the next ground to be excavated.

In Step S117, the control device 40 of the hydraulic excavator 1 controls the turning movement of the front work device 2, the traveling movement of the lower traveling body 5, and the swinging movement of the upper swing body 7 to cause the hydraulic excavator 1 to perform a reaching operation according to the acquired reaching task. Thereafter, the control device 40 proceeds to Step S111.

In Step S118, the control device 40 of the hydraulic excavator 1 determines whether or not to terminate the work. The control device 40 may determine that the work is terminated when the task acquisition device 58 acquires a work end notification. Alternatively, the control device 40 may determine that the work is terminated when the operator or a manager stops the engine 103 of the hydraulic excavator 1. When the work is determined to be terminated, the control device 40 interrupts the operation of the hydraulic excavator 1 to terminate the work. When the work is determined not to be terminated, the control device 40 proceeds to Step S116. The hydraulic excavator 1 continues the reaching operation, the excavation operation, and the loading operation.

The tasks and the operations of the hydraulic excavator 1 are not limited to those illustrated in FIG. 4, and may include tasks and operations not illustrated in FIG. 4, such as moving or leveling, for example.

In the operation of the hydraulic excavator 1, when the task acquisition device 58 acquires each task, information such as the position, the posture and a shape of the dump truck 200 may be required. In this case, the information processing device 54 recognizes the dump truck 200 based on the measurement result of the external measuring device 70 each time the task acquisition device 58 acquires each task. The information processing device 54 then verifies whether the recognition result of the dump truck 200 is not valid to the extent that it cannot be corrected, or whether the recognition result of the dump truck 200 is valid to the extent that it can be corrected (hereinafter referred to as “verifying validity”). When the recognition result of the dump truck 200 is valid, the information processing device 54 corrects the recognition result.

In the present embodiment, a process of verifying the validity of the recognition result of the dump truck 200 and correcting the recognition result is also referred to as the “recognition result verification process.” The functions of the information processing device 54 that performs the recognition result verification process are described below.

<Functional Configuration of Information Processing Device>

FIG. 5 is a block diagram illustrating a functional configuration of the information processing device 54 illustrated in FIG. 2. FIG. 6 is a view illustrating respective coordinate systems 300 to 500 set up on the hydraulic excavator 1, viewed from side. FIG. 7 is a view illustrating the respective coordinate systems 300 to 500 illustrated in FIG. 6, viewed from above.

The information processing device 54 includes a posture calculation section 81, a coordinate transformation section 82, a positioning information calculation section 83, a task acquisition section 80, a recognition section 84, an area estimation section 85, a verification section 86, and a correction section 87.

In the information processing device 54, the body coordinate system 400 illustrated in FIGS. 6 and 7 is preset as a reference coordinate system for identifying the positions and the postures of components of the hydraulic excavator 1. The body coordinate system 400 of the hydraulic excavator 1 in the present embodiment is defined as a right-hand coordinate system with the origin at the point where the lower traveling body 5 contact the ground G in a swing center line 120 of the upper swing body 7. The body coordinate system 400 of the hydraulic excavator 1 is defined with a forward direction of the lower traveling body 5 as a positive direction of the X-axis. The body coordinate system 400 of the hydraulic excavator 1 is defined with a direction in which the swing center line 120 extends upward as a positive direction of the Z-axis. The body coordinate system 400 of the hydraulic excavator 1 is defined as orthogonal to each of the X- and Z-axes, with a left direction as a positive direction of the Y-axis. In the body coordinate system 400 of the hydraulic excavator 1, the swing angle θsw of the upper swing body 7 is defined as 0 degrees when the front work device 2 is parallel to the X-axis.

The present embodiment also defines a sensor coordinate system 300, as illustrated in FIGS. 6 and 7, as the reference coordinate system for the external measuring device 70. The present embodiment defines the site coordinate system 500, as illustrated in FIGS. 6 and 7, as the reference coordinate system for the site.

<Posture Calculation Section>

The posture calculation section 81 calculates the postures and the like of the components of the hydraulic excavator 1 in the body coordinate system 400 of the hydraulic excavator 1 from detection signals of the posture detection device 53. Specifically, the posture calculation section 81 calculates a turn angle θbm of the boom 8 with respect to the X-axis from the detection signal of the turn angle of the boom 8 output from the boom angle sensor 14. The posture calculation section 81 calculates the turn angle θam of the arm 9 with respect to the boom 8 from the detection signal of the turn angle of the arm 9 output from the arm angle sensor 15. The posture calculation section 81 calculates the turn angle θbk of the bucket 10 with respect to the arm 9 from the detection signal of the turn angle of the bucket 10 output from the bucket angle sensor 17. The posture calculation section 81 calculates the swing angle θsw of the upper swing body 7 with respect to the X-axis (the lower traveling body 5) from the detection signal of the swing angle of the upper swing body 7 output from the swing angle sensor 19. Furthermore, the posture calculation section 81 calculates a turning angular velocity ωsw of the upper swing body 7 from the swing angle θsw of the upper swing body 7.

Furthermore, the posture calculation section 81 calculates the inclination angle of the machine main body 3 (the lower traveling body 5) with respect to a reference plane DP from the detection signal of the inclination angle of the machine main body 3 output from the inclination angle sensor 18. The reference plane DP is, for example, a horizontal plane orthogonal to the direction of gravity. The inclination angle includes a rotation angle θp about the Y-axis and a rotation angle θr about the X-axis.

<Coordinate Transformation Section>

The coordinate transformation section 82 transforms the coordinate system expressing the depth information acquired by the external measuring device 70 from the sensor coordinate system 300 to the body coordinate system 400 of the hydraulic excavator 1 using the posture information of the hydraulic excavator 1 output from the posture calculation section 81. The depth information acquired by the external measuring device 70 is given as a set of three-dimensional point data (that is, point cloud data) expressed in the sensor coordinate system 300.

For example, the following Formulae (1) to (3) are used to convert point data Ps (Xs, Ys, Zs) in the sensor coordinate system 300 to point data Pv (Xv, Yv, Zv) in the body coordinate system 400 of the hydraulic excavator 1.

$\begin{array}{cc}\left[\mathrm{Math}.1\right]& \\ P_v=R_{\mathrm{sv}}·P_s+T_{\mathrm{sv}}& \left(1\right)\end{array}$ $\begin{array}{cc}\left[\mathrm{Math}.2\right]& \\ R_{\mathrm{sv}}=\left(\begin{array}{ccc}1& 0& 0\\ 0& \cos \alpha s& -\sin \alpha s\\ 0& \sin \alpha s& \cos \alpha s\end{array}\right)\left(\begin{array}{ccc}\cos \beta s& 0& \sin \beta s\\ 0& 1& 0\\ -\sin \beta s& 0& \cos \beta s\end{array}\right)\left(\begin{array}{ccc}\cos \left(\gamma s+{\theta }_{\mathrm{sw}}\right)& -\sin \left(\gamma s+{\theta }_{\mathrm{sw}}\right)& 0\\ \sin \left(\gamma s+{\theta }_{\mathrm{sw}}\right)& \cos \left(\gamma s+{\theta }_{\mathrm{sw}}\right)& 0\\ 0& 0& 1\end{array}\right)& \left(2\right)\end{array}$ $\begin{array}{cc}\left[\mathrm{Math}.3\right]& \\ T_{\mathrm{sv}}=\left(\mathrm{Lsx},\mathrm{Lsy},\mathrm{Lsz}\right)& \left(3\right)\end{array}$

In the above-described Formulae (1) to (3), Rsv is a rotation matrix from the sensor coordinate system 300 to the body coordinate system 400. αs, βs, and γs are the angles formed by respective axes of the external measuring device 70 (respective axes of the sensor coordinate system 300) in the body coordinate system 400. When the external measuring device 70 is fixed to the hydraulic excavator 1, for example, the angles formed by these angles can be measured in advance by measuring the attitude of the external measuring device 70 in the body coordinate system 400 and storing them in the storage device 57 in advance. When the external measuring device 70 performs measurement while changing its posture with respect to the hydraulic excavator 1, a posture measuring sensor may be attached to the external measuring device 70 or the like, and the angle detected by the posture measuring sensor may be used to calculate a coordinate transformation matrix. θsw is the swing angle of the upper swing body 7 and is output from the posture calculation section 81.

In the above-described Formulae (1) to (3), Tsv is a translational vector from the origin of the body coordinate system 400 to the origin of the sensor coordinate system 300. Lsx, Lsy, and Lsz are equal to the origin coordinates of the sensor coordinate system 300 as viewed from the body coordinate system 400. A mounting position of the external measuring device 70 is often fixed on the hydraulic excavator 1. Therefore, in such cases, the mounting position of the external measuring device 70 on the hydraulic excavator 1 can be measured in advance and stored in the storage device 57 in advance.

<Positioning Information Calculation Section>

The positioning information calculation section 83 calculates the position of the origin of the body coordinate system 400 in the site coordinate system 500 of the hydraulic excavator 1 and an orientation θdir in the site coordinate system 500 of the front work device 2 from the positioning information acquired by the positioning device 60.

<Task Acquisition Section>

The task acquisition section 80 acquires the next task to be performed by the hydraulic excavator 1 from the task acquisition device 58. In the present embodiment, the tasks to be performed by the hydraulic excavator 1 include the excavation task, the loading task, and the reaching task. The excavation task is a task that specifies the excavation operation until the hydraulic excavator 1 excavates the ground to be excavated and holds the target object such as earth and sand in the bucket 10. The loading task is a task that specifies the loading operation from a state in which the hydraulic excavator 1 terminates the excavation operation until the bucket 10 is moved to above the vessel of the dump truck 200 and the target object is released from the bucket 10 onto the vessel. The reaching task is a task that specifies the reaching operation in which the hydraulic excavator 1 moves the bucket 10 from the state in which the loading operation is terminated to the position in which the ground to be excavated next is located. The tasks performed by the hydraulic excavator 1 are not limited to these tasks. For example, a leveling task that specifies a leveling operation in which the hydraulic excavator 1 levels the surrounding ground until the dump truck 200 stops at a predetermined position at the site, and/or a leveling task that specifies a moving operation in which the hydraulic excavator 1 changes the ground to be excavated may be included.

<Recognition Section>

The recognition section 84 recognizes the dump truck 200 from the measurement results of the external measuring device 70. Specifically, the recognition section 84 recognizes the position, the posture, and the shape of the dump truck 200 using the point cloud data, which are acquired as the measurement result of the external measuring device 70 and converted to the body coordinate system 400 by the coordinate transformation section 82. The recognition section 84 then calculates a recognition area, which is an area where the recognized dump truck 200 is present. In other words, the recognition area is the recognition result of the recognition section 84 for the presence area 210 of the dump truck 200.

A method of calculating the recognition area of the dump truck 200 by the recognition section 84 is, for example, to maintain a 3-D mesh model of the dump truck 200 measured in advance in the storage device 57. Then, the position, the posture, and the shape are collated between the point cloud data converted to the body coordinate system 400 acquired from the coordinate transformation section 82 and the 3D mesh model. As a result, the recognition section 84 can calculate the position, the posture, and the shape of the target dump truck 200, and thus can calculate the recognition area of the dump truck 200. The method of calculating the recognition area of the dump truck 200 is not limited thereto, and may be, for example, a method of calculating the recognition area of the dump truck 200 by a process of extracting a specific plane of the dump truck 200 from the point cloud data acquired from the external measuring device 70. Alternatively, a neural network that calculates the recognition area of the dump truck 200 from the point cloud data including the dump truck 200 may be constructed in advance, and the features of the dump truck 200 to be recognized may be calculated using a discriminator that has been machine-learned.

In the present embodiment, the position, the posture, and the presence area 210 of the dump truck 200 are defined as follows.

FIG. 8 is a view of a body coordinate system 600 of the dump truck 200, viewed from side. FIG. 9 is a view illustrating the body coordinate system 600 illustrated in FIG. 8, viewed from above.

In the present embodiment, the body coordinate system 600 of the dump truck 200 has the center of the rear axle of the dump truck 200 as the origin, and the X-axis is a direction from the rear wheels to the front wheels, the Y-axis is a direction where the rear axle extends, and the Z-axis is a direction of the height of the dump truck 200. Assume that the position of the dump truck 200 designates the origin Pd (Xd, Yd, Zd) of the body coordinate system 600. Assume that the posture of the dump truck 200 refers to the angle θd (θroll, θpitch, θyaw) formed by the respective axes of the site coordinate system 500 and the respective axes of the body coordinate system 600 of the dump truck 200. Assume that the presence area 210 of the dump truck 200 refers to a rectangular area Sd (Pd1 to Pd4) with the points Pd1 to Pd4 at the four corners of the vessel of the dump truck 200 as vertices. The presence area 210 of the dump truck 200 is not limited thereto, and may be, for example, a hexahedron (for example, a rectangle or cube) that encompasses the entire dump truck 200. In the present embodiment, assume that the recognition area of the dump truck 200, which is the recognition result of the recognition section 84 for the presence area 210 of the dump truck 200, is Sdr (Pdr1 to Pdr4).

<Area Estimation Section>

The area estimation section 85 calculates an estimated area, which is an area where the dump truck 200 is estimated to be present, from the position and the vehicle class information (truck information) of the dump truck 200 acquired by the truck information acquisition device 56. In other words, the estimated area is an estimation result of the area estimation section 85 for the presence area 210 of the dump truck 200. The estimated area is calculated for comparison with the recognition area of the dump truck 200 calculated by the recognition section 84 in order to verify validity of the recognition result of the dump truck 200.

The method of calculating the estimated area of the dump truck 200 by the area estimation section 85 stores, for example, a method of calculating the estimated area of the dump truck 200 from the truck information in the storage device 57 in advance for each vehicle type. Then, using the truck information acquired by the truck information acquisition device 56 and the calculation method corresponding to the truck information, the estimated area in the site coordinate system 500 of the target dump truck 200 is calculated and converted to the body coordinate system 400 of the hydraulic excavator 1. This allows the area estimation section 85 to calculate the estimated area of the dump truck 200 that can be compared with the recognition area of the dump truck 200 calculated by the recognition section 84. In the present embodiment, assume that the estimated area of the dump truck 200, which is the estimation result of the area estimation section 85 for the presence area 210 of the dump truck 200, is Sde (Pde1 to Pde4).

The transformation from the site coordinate system 500 to the body coordinate system 400 of the hydraulic excavator 1 can be performed using the following formulae. For example, the following Formulae (4) to (6) are used to convert from the point data Pv (Xv, Yv, Zv) in the body coordinate system 400 of the hydraulic excavator 1 to the point data Pg (Xg, Yg, Zg) in the site coordinate system 500.

$\begin{array}{cc}\left[\mathrm{Math}.4\right]& \\ P_v=R_{\mathrm{vg}}^{-1}·\left(P_g-T_{\mathrm{vg}}\right)-T_{\mathrm{sv}}& \left(4\right)\end{array}$ $\begin{array}{cc}\left[\mathrm{Math}.5\right]& \\ R_{\mathrm{vg}}=\left(\begin{array}{ccc}1& 0& 0\\ 0& \cos \theta r& -\sin \theta r\\ 0& \sin \theta r& \cos \theta r\end{array}\right)\left(\begin{array}{ccc}\cos \theta p& 0& \sin \theta p\\ 0& 1& 0\\ -\sin \theta p& 0& \cos \theta p\end{array}\right)\left(\begin{array}{ccc}\cos \theta y& -\sin \theta y& 0\\ \sin \theta y& \cos \theta \theta y& 0\\ 0& 0& 1\end{array}\right)& \left(5\right)\end{array}$ $\begin{array}{cc}\left[\mathrm{Math}.6\right]& \\ T_{\mathrm{vg}}=\left(x0,y0,z0\right)& \left(6\right)\end{array}$

In the above-described Formulae (4) to (6), Rvg is a rotation matrix from the body coordinate system 400 to the site coordinate system 500. θr, θp, and θy are the angles formed by respective axes of the body coordinate system 400 in the site coordinate system 500. These angles can be calculated using the values calculated by the posture calculation section 81, the swing angle, the inclination angle of the machine main body 3, and the orientation calculated by the positioning information calculation section 83.

In the above-described Formulae (4) to (6), Tvg is a translational vector from the origin of the site coordinate system 500 to the origin of the body coordinate system 400. X0, y0, z0 are equal to the origin coordinates of the body coordinate system 400 as viewed from the site coordinate system 500. For Tvg, a calculation result of the positioning information calculation section 83 can be used.

The area estimation section 85 can adjust the position of the dump truck 200 included in the truck information using the position adjustment amount of the dump truck 200 that was simultaneously acquired with the truck information by the truck information acquisition device 56. The area estimation section 85 can then calculate the estimated area of the dump truck 200 from the adjusted position of the dump truck 200.

<Verification Section>

The verification section 86 verifies the validity of the recognition result of the dump truck 200 based on the recognition area calculated by the recognition section 84 and the estimated area calculated by the area estimation section 85. Specifically, the verification section 86 calculates a confidence of the recognition result of the dump truck 200 by comparing the recognition area with the estimated area, and verifies the validity of the recognition result of the dump truck 200 according to the calculated confidence. In detail, the verification section 86 calculates an overlap degree, which indicates a degree of an overlap between the recognition area and the estimated area, as the confidence of the recognition result of the dump truck 200. When the calculated overlap degree is higher than a threshold, the verification section 86 determines that the recognition result of the dump truck 200 is valid (correctable). In this case, the verification section 86 can change the threshold of the overlap degree, which is a criterion for determining the validity of the recognition result, according to the task acquired by the task acquisition section 80.

<Correction Section>

The correction section 87 corrects the recognition area calculated by the recognition section 84 based on the estimated area calculated by the area estimation section 85. Specifically, the correction section 87 compares the recognition area calculated by the recognition section 84 with the estimated area calculated by the area estimation section 85 and corrects the recognition area calculated by the recognition section 84. Accordingly, the correction section 87 corrects the recognition result of the dump truck 200. At this time, the correction section 87 can change the correction method of the recognition area (the recognition result) calculated by the recognition section 84 according to the task acquired by the task acquisition section 80.

The information processing device 54 uses the verification section 86 and the correction section 87 to verify the validity of the recognition result of the dump truck 200, and performs the recognition result verification process to correct the recognition result. The recognition result verification process is described in detail below.

<Recognition Result Verification Process>

FIG. 10 is a flowchart illustrating an example of the recognition result verification process. FIG. 11 is a view illustrating the overlap degree of the recognition area and the estimated area. FIG. 12 is a view illustrating a table that defines criteria for determining the validities of the recognition results and the methods of correction of the recognition areas for the respective tasks of the hydraulic excavator 1. FIG. 13 is a view illustrating the method of correcting the recognition area when acquiring the loading task. FIG. 14 is illustrating a method of correcting the recognition area when acquiring the reaching task. FIG. 15 is a view illustrating an example of the display device 55 when the confidence of the recognition result is equal to or lower than the threshold.

In Step S121, the verification section 86 of the information processing device 54 acquires the task acquired by the task acquisition section 80.

In Step S122, the verification section 86 of the information processing device 54 acquires the recognition area calculated by the recognition section 84.

In Step S123, the verification section 86 of the information processing device 54 acquires the estimated area calculated by the area estimation section 85.

In Step S124, the verification section 86 of the information processing device 54 calculates the confidence of the recognition result of the dump truck 200. As illustrated in FIG. 11, in the present embodiment, the verification section 86 calculates the overlap degree Acover, which indicates the overlap between the recognition area calculated by the recognition section 84 and the estimated area calculated by the area estimation section 85, as the confidence of the recognition result of the dump truck 200. The overlap degree Acover is given by the following Formula (7).

$\begin{array}{cc}\left[\mathrm{Math}.7\right]& \\ A_{\mathrm{cover}}=S_{\mathrm{cover}}/S_{\mathrm{de}}& (7)\end{array}$

In the above-described Formula (7), Sde indicates an area of the estimated area calculated by the area estimation section 85. Scover indicates an area of the area where the recognition area (Sdr) calculated by the recognition section 84 and the estimated area (Sde) calculated by the area estimation section 85 overlap. Scover can be attributed, for example, to a problem of finding an area of an intersection of two convex polygons, for example, and can be solved as a numerical calculation problem.

In Step S125, the verification section 86 of the information processing device 54 determines whether the calculated overlap degree Acover is higher than a threshold Ath. Accordingly, the verification section 86 verifies the validity of the recognition result of the dump truck 200. When the calculated overlap degree Acover is higher than the threshold Ath, the verification section 86 determines that the recognition result of the dump truck 200 is valid (correctable) and proceeds to Step S126. When the calculated overlap degree Acover is equal to or lower than the threshold Ath, the verification section 86 determines that the recognition result of the dump truck 200 is not valid (not correctable) and proceeds to Step S127.

Here, the verification section 86 can change the threshold Ath of the overlap degree Acover, which is the criterion for determining the validity of the recognition result, according to the task acquired by the task acquisition section 80, as illustrated in FIG. 12. The table illustrated in FIG. 12 is stored in the storage device 57 in advance. As illustrated in Column 1201 of the table illustrated in FIG. 12, when the task acquired by the task acquisition section 80 is the loading task, the verification section 86 sets Ath1 as the threshold Ath. When the task acquired by the task acquisition section 80 is the reaching task, the verification section 86 sets Ath2 as the threshold Ath. Ath1 and Ath2 are preferred to be determined with the calculation accuracy of the respective areas of the area estimation section 85 and the recognition section 84 during the functional verification conducted in advance, the presence or absence of the target object in the bucket 10 when the task is acquired, the distance between the front work device 2 and the dump truck 200, and other factors taken into account.

In the loading operation specified by the loading task, the hydraulic excavator 1 starts in a state where the target object is in the bucket 10 and the distance between the front work device 2 and the dump truck 200 is large. As a result, the damage caused when the front work device 2 collides with the dump truck 200 is considered to be greater during the loading operation than during the reaching operation. Therefore, the threshold Ath1 set when the loading task is acquired preferred to be the same value or higher than the threshold Ath2 set when the reaching task is acquired.

In Step S126, the correction section 87 of the information processing device 54 corrects the recognition result of the dump truck 200. Specifically, the correction section 87 corrects the recognition area calculated by the recognition section 84. The correction section 87 then outputs the determination result that the recognition result of the dump truck 200 is valid (correctable), the confidence (the overlap degree) of the recognition result, and the recognition area after the correction, to the control device 40. Furthermore, the correction section 87 may display the information output to the control device 40 on the display device 55 to notify the operator, or transmit the information to the management device that manages the work site to notify the manager. The information processing device 54 then terminates the recognition result verification process illustrated in FIG. 10.

Here, the correction section 87 can change the correction method of the recognition area calculated by the recognition section 84 according to the task acquired by the task acquisition section 80, as illustrated in FIG. 12. As indicated in Column 1202 of the table illustrated in FIG. 12, when the task acquired by the task acquisition section 80 is the loading task, the correction section 87 corrects the recognition area calculated by the recognition section 84 to be an area (Sdc) that encompasses the recognition area (Sdr) and the estimated area (Sde) as illustrated in FIG. 13. The area encompassing the recognition area (Sdr) and the estimated area (Sde) is the area (Sdc) that encompasses an OR (Union) area occupied by the recognition area (Sdr) or the estimated area (Sde). In an example of FIG. 13, the correction section 87 corrects the recognition area (Sdr) calculated by the recognition section 84 to a rectangular area (Sdc) that encompasses the recognition area (Sdr) and the estimated area (Sde) and has the smallest area.

In the loading operation specified by the loading task, the hydraulic excavator 1 moves the bucket 10 from the ground outside the dump truck 200 toward above the vessel inside of the dump truck 200 to the loading position. Therefore, when the recognition area calculated by the recognition section 84 is corrected to an area that encompasses the recognition area and the estimated area, the risk of the front work device 2 moving from the outside to the inside of the dump truck 200 colliding with the dump truck 200 during the loading operation is reduced. Therefore, when the task acquired by the task acquisition section 80 is the loading task, the correction section 87 corrects the recognition area calculated by the recognition section 84 to be the area that encompasses the recognition area and the estimated area.

The correction section 87 can calculate the position in the height direction (the Z-axis direction) of the recognition area after the correction as follows. That is, the correction section 87 can use the maximum value of the Z-axis component of the coordinates of respective vertices of the recognition area and the estimated area as the position of the recognition area in the height direction after the correction, in order to avoid the collision between the front work device 2 and the dump truck 200.

The correction section 87 can calculate the orientation vdc of the recognition area after the correction, using the orientation vector vdr of the recognition area and the orientation vector vde of the estimated area, for example, from Formulae (8) to (9) below.

$\begin{array}{cc}\left[\mathrm{Math}.8\right]& \\ v_{dc}=v_{\mathrm{dr}}+G_k\left(v_{\mathrm{de}}-v_{\mathrm{dr}}\right)& \left(8\right)\end{array}$ $\begin{array}{cc}\left[\mathrm{Math}.9\right]& \\ G_k=\left(\begin{array}{ccc}\frac{\Delta x_{\mathrm{de}}}{\Delta x_{\mathrm{dr}}+\Delta x_{\mathrm{de}}}& 0& 0\\ 0& \frac{\Delta y_{\mathrm{de}}}{\Delta y_{\mathrm{dr}}+\Delta y_{\mathrm{de}}}& 0\\ 0& 0& \frac{\Delta z_{\mathrm{de}}}{\Delta z_{\mathrm{dr}}+\Delta z_{\mathrm{de}}}\end{array}\right)& \left(9\right)\end{array}$

Δdr (Δxdr, Δydr, Δzdr) used in the calculation of the gain Gk in the above-described Formula (9) is information on the calculation accuracy of the recognition area in the recognition section 84. As Δdr, for example, the measurement accuracy of the external measuring device 70 and the calculation accuracy of the recognition section 84, which are measured in advance can be used. When the discriminator using the machine learning is used in the recognition algorithm of the recognition section 84, the information on the recognition confidence output by the discriminator may be used as Δdr.

Δde (Δxde, Δyde, Δzde) used in the calculation of the gain Gk in the above-described Formula (9) is information on the calculation accuracy of the estimated area in the area estimation section 85. As Δde, the position adjustment amount of the dump truck 200 that can be acquired simultaneously with the truck information by the truck information acquisition device 56 can be used. In other words, the correction section 87 can correct the recognition area calculated by the recognition section 84 using the position adjustment amount of the dump truck 200 acquired by the truck information acquisition device 56. When the truck information acquisition device 56 is unable to acquire the position adjustment amount, as Δde, the result of a prior investigation of the error of the positioning information acquired by the positioning device 60 at the site of the hydraulic excavator 1 can be used.

The correction section 87 also calculates the loading position Pdc (Xdc, Ydc, Zdc) of the bucket 10. Specifically, the correction section 87 calculates, for example, the center position Pdr0 of the vessel in the recognition area calculated by the recognition section 84 and the center position Pde0 of the vessel in the estimated area calculated by the area estimation section 85. The correction section 87 can then use the center position Pdr0 of the vessel in the recognition area and the center position Pde0 of the vessel in the estimated area to calculate, for example, from the following Formula (10).

$\begin{array}{cc}\left[\mathrm{Math}.10\right]& \\ P_{dc}=P_{\mathrm{dr}}+G_k\left(P_{\mathrm{de}}-P_{\mathrm{dr}}\right)& \left(10\right)\end{array}$

In the above-described Formula (10), the gain Gk is given by the above-described Formula (9) including Δde. In other words, the correction section 87 can calculate the loading position of the bucket 10 based on the position adjustment amount of the dump truck 200 acquired by the truck information acquisition device 56, the recognition area, and the estimated area. The correction section 87 outputs the calculated loading position of the bucket 10 to the control device 40.

On the other hand, when the task acquired by the task acquisition section 80 is the reaching task, the correction section 87 corrects the recognition area (Sdr) calculated by the recognition section 84 such that the recognition area (Sdr) becomes the area (Sdc) encompassed by the overlapping area of the recognition area (Sdr) and the estimated area (Sde) as illustrated in FIG. 14. The area (Sdc) encompassed by the area where the recognition area (Sdr) and the estimated area (Sde) overlap is the area (Sdc) encompassed by an AND area occupied by both the recognition area (Sdr) and the estimated area (Sde). In an example in FIG. 14, the correction section 87 corrects the recognition area (Sdr) calculated by the recognition section 84 to the rectangular area (Sdc) that encompasses the recognition area (Sdr) and the estimated area (Sde) and has the largest area.

In the reaching operation specified by the reaching task, the hydraulic excavator 1 moves the bucket 10 from the loading position above the vessel inside the dump truck 200 to the ground outside the dump truck 200. Therefore, when the recognition area calculated by the recognition section 84 is corrected to the area encompassed by the overlapping area of the recognition area and the estimated area, the risk of the front work device 2 moving from the inside to the outside of the dump truck 200 colliding with the dump truck 200 during the reaching operation is reduced. Therefore, when the task acquired by the task acquisition section 80 is the reaching task, the correction section 87 corrects the recognition area calculated by the recognition section 84 such that the recognition area becomes the area encompassed by the area overlapping the recognition area and the estimated area.

Similarly to when the loading task is acquired, the correction section 87 can use the maximum value of the Z-axis component of the coordinates of respective vertices of the recognition area and the estimated area as the position of the recognition area in the height direction (Z-axis direction) after the correction. Similarly to when the loading task is acquired, the correction section 87 can calculate the orientation of the recognition area after the correction from the above-described Formulae (8) to (9).

In Step S127, the verification section 86 of the information processing device 54 outputs the determination result that the recognition result of the dump truck 200 is not valid (not correctable), the confidence (the overlap degree) of the recognition result, the recognition area, and the estimated area, to the control device 40. Furthermore, the verification section 86 notifies the operator by displaying the information output to the control device 40 on the display device 55, and/or notifies the manager by transmitting the information to the management device that manages the work site. At this time, the verification section 86 confirms with the operator or a user such as the manage whether or not the hydraulic excavator 1 is allowed to be continued to operate.

For example, as illustrated in FIG. 15, the verification section 86 displays a screen 551 on the display device 55 to notify the user of the determination result that the recognition result of the dump truck 200 is not valid (not correctable) and to confirm with the user whether the operation of the hydraulic excavator 1 is allowed to be continued. The screen 551 includes a message 552 to notify the user of the determination result that the recognition result of the dump truck 200 is not valid (not correctable) and to confirm with the user whether the operation of the hydraulic excavator 1 is allowed to be continued. The screen 551 includes a button 553 for the user to input the confirmation result that the operation of the hydraulic excavator 1 is to be continued. The screen 551 includes a button 554 for the user to input the confirmation result that the operation of the hydraulic excavator 1 is not to be continued. The screen 551 includes a button 555 for the user to input that the hydraulic excavator 1 is to be switched from the automatic control to the manual operation by the operator. The screen 551 also notifies the user of the positional relationship between the dump truck 200 and the hydraulic excavator 1 by indicating the calculation results of the recognition area (Sdr) and the estimated area (Sde) of the dump truck 200.

When the verification section 86 receives the confirmation result from the user as to whether or not the continuation is allowed, it outputs the confirmation result to the control device 40. The information processing device 54 then terminates the recognition result verification process illustrated in FIG. 10.

<Operation Control of Control Device>

The control device 40 controls the movements of the body of the hydraulic excavator 1 (for example, the turning movement of the front work device 2, the traveling movement of the lower traveling body 5, and the swinging movement of the upper swing body 7) based on the result of the validation of the recognition result of the dump truck 200 by the information processing device 54.

When the recognition result is valid (correctable), the control device 40 controls the operation of the hydraulic excavator 1 based on the task acquired by the task acquisition device 58 and the corrected recognition area output from the information processing device 54. Specifically, when the loading task is acquired, the control device 40 controls the loading operation of the hydraulic excavator 1 such that the front work device 2 moves on a trajectory where it does not collide with the dump truck 200 before the bucket 10 reaches the loading position from the ground. When the reaching task is acquired, the control device 40 controls the reaching operation of the hydraulic excavator 1 such that the front work device 2 moves on a trajectory where it does not collide with the dump truck 200 before the bucket 10 reaches the ground to be excavated next from the loading position.

When the recognition result is not valid (not correctable), the control device 40 controls the operation of the hydraulic excavator 1 upon the confirmation result output from the information processing device 54 as to whether the operation of the hydraulic excavator 1 is allowed to be continued.

<Action Effect>

As described above, the hydraulic excavator 1 of Embodiment 1 is the work machine that loads the target object onto the dump truck 200. The hydraulic excavator 1 includes the external measuring device 70 that measures the surrounding environment of the body of the hydraulic excavator 1. The hydraulic excavator 1 includes the information processing device 54 that recognizes the dump truck 200 present around the body of the hydraulic excavator 1 based on the measurement result of the external measuring device 70. The hydraulic excavator 1 includes the control device 40 that controls the operation of the body of the hydraulic excavator 1 based on the recognition result of the information processing device 54. The hydraulic excavator 1 includes the truck information acquisition device 56 that acquires the position and the vehicle class information of the dump truck 200 from the external source. The information processing device 54 corrects the recognition result of the dump truck 200 based on the position and the vehicle class information of the dump truck 200 acquired by the truck information acquisition device 56. The control device 40 controls the operation of the body of the hydraulic excavator 1 based on the corrected recognition result of the dump truck 200.

As a result, the hydraulic excavator 1 of Embodiment 1 can control the loading operation and the like for the dump truck 200 using the accurate recognition result of the dump truck 200 in various situations. Thus, according to Embodiment 1, it is possible to provide the work machine that can appropriately control the loading work onto the carrier machine by accurately recognizing the position and the posture of the carrier machine in various situations.

Conventionally, when the hydraulic excavator 1 performs the loading operation for the dump truck 200, it was difficult to verify the recognition result of the dump truck 200 from the measurement result of the external measuring device 70. In particular, with the recognition system using machine learning, it is difficult to properly evaluate uncertainty of the recognition result for the site or the dump truck 200 for which no training data has been collected. Furthermore, when the development company of the hydraulic excavator 1 and the recognition system development company are different, details of the recognition system algorithm might not be disclosed to the development company of the hydraulic excavator 1. It is difficult for the development company of the hydraulic excavator 1 to perform a sufficient risk assessment in advance to determine whether the recognition result of the recognition system can be used to properly control the loading work without colliding with the dump truck 200.

In contrast, the hydraulic excavator 1 of Embodiment 1 can verify the validity of the recognition result of the dump truck 200 based on information from a third party acquired by the truck information acquisition device 56, and can correct the recognition result. Then, the hydraulic excavator 1 of Embodiment 1 can appropriately control the loading operation and the like based on the corrected recognition result. In other words, the hydraulic excavator 1 of Embodiment 1 can control the movement of the body of the hydraulic excavator 1 based on the accurate recognition result of the position, the posture, and the like of the dump truck 200. Therefore, the hydraulic excavator 1 of Embodiment 1 can reduce the risk of the collision with the dump truck 200, and control the loading operation and the reaching operation, thereby improving the safety and productivity of the loading work. Thus, according to Embodiment 1, it is possible to provide the hydraulic excavator 1 that can appropriately control the loading work onto the dump truck 200 by accurately recognizing the position and the posture of the dump truck 200 in various situations.

Furthermore, the information processing device 54 includes the recognition section 84 that recognizes the dump truck 200 from the measurement result of the external measuring device 70 and calculates the recognition area, which is an area in which the recognized dump truck 200 is present. The information processing device 54 includes the area estimation section 85 that calculates the estimated area, which is an area where the dump truck 200 is estimated to be present, based on the position and the vehicle class information of the dump truck 200 acquired by the truck information acquisition device 56. The information processing device 54 includes the correction section 87 that corrects the recognition area based on the estimated area.

This allows the hydraulic excavator 1 of Embodiment 1 to correct the recognition result based on a relatively simple indicator, which is the presence area of the dump truck 200. Therefore, the hydraulic excavator 1 of Embodiment 1 can accurately and easily recognize the position and the posture of the dump truck 200. The hydraulic excavator 1 of Embodiment 1 can further improve the safety and productivity of the loading work. Thus, according to Embodiment 1, it is possible to easily provide the hydraulic excavator 1 that can appropriately control the loading work onto the dump truck 200 by accurately recognizing the position and the posture of the dump truck 200 in various situations.

Furthermore, the information processing device 54 (the verification section 86) calculates the confidence of the recognition result of the dump truck 200 by comparing the recognition area with the estimated area. The correction section 87 corrects the recognition area according to the calculated confidence.

As a result, the hydraulic excavator 1 of Embodiment 1 can quantitatively verify the validity of the recognition result of the dump truck 200, and can accurately and precisely correct the recognition area. The hydraulic excavator 1 of Embodiment 1 can further improve the safety and productivity of the loading work. Thus, according to Embodiment 1, it is possible to provide the hydraulic excavator 1 that can further appropriately control the loading work onto the dump truck 200 by accurately and precisely recognizing the position and the posture of the dump truck 200 in various situations.

Furthermore, the information processing device 54 (the verification section 86) calculates the overlap degree, which indicates the degree of overlap between the recognition area and the estimated area, as the confidence of the recognition result. The correction section 87 corrects the recognition area according to the calculated overlap degree.

As a result, the hydraulic excavator 1 of Embodiment 1 can calculate the confidence of the recognition result with a clear standard, and the recognition area can be corrected more accurately and precisely. The hydraulic excavator 1 of Embodiment 1 can further improve the safety and productivity of the loading work. Thus, according to Embodiment 1, it is possible to provide the hydraulic excavator 1 that can control the loading work onto the dump truck 200 more appropriately by recognizing the position and the posture of the dump truck 200 more accurately and precisely in various situations.

Furthermore, the truck information acquisition device 56 further acquires information on the position adjustment amount of the dump truck 200. The area estimation section 85 calculates the estimated area using the position adjustment amount acquired by the truck information acquisition device 56.

As a result, the hydraulic excavator 1 of Embodiment 1 can calculate the estimated area using values that are more realistic than the error in the positional information of the dump truck 200 acquired through prior verification and the like. Therefore, the hydraulic excavator 1 of Embodiment 1 can further accurately correct the recognition area. The hydraulic excavator 1 of Embodiment 1 can further improve the safety and productivity of the loading work. Thus, according to Embodiment 1, the hydraulic excavator 1 can further accurately recognize the position and the posture of the dump truck 200 in various situations, thereby enabling further appropriate control of the loading work onto the dump truck 200.

Furthermore, the information processing device 54 further includes the task acquisition section 80 that acquires the next task to be performed by the hydraulic excavator 1. The correction section 87 changes the correction method of the recognition area according to the acquired task.

As a result, the hydraulic excavator 1 of Embodiment 1 can correct it to the optimal recognition area for each of the acquired tasks, allowing the hydraulic excavator 1 to perform the optimal operation for each of the acquired tasks. The hydraulic excavator 1 of Embodiment 1 can further improve the safety and productivity of loading works. Thus, according to Embodiment 1, it is possible to provide the hydraulic excavator 1 that can further control the loading work onto the dump truck 200 more appropriately by further accurately recognizing the position and the posture of the dump truck 200 in various situations.

Furthermore, the correction section 87 corrects the recognition area to be an area that encompasses the recognition area and the estimated area when the loading task for loading the target object onto the dump truck 200 is acquired.

This allows the hydraulic excavator 1 of Embodiment 1 to further reduce the risk of the front work device 2, which moves from the outside to the inside of the dump truck 200 during the loading operation, colliding with the dump truck 200. The hydraulic excavator 1 of Embodiment 1 can further improve the safety and productivity of the loading work. Thus, according to Embodiment 1, it is possible to provide the hydraulic excavator 1 that can further appropriately control the loading work onto the dump truck 200 by accurately recognizing the position and the posture of the dump truck 200 in various situations.

Furthermore, the hydraulic excavator 1 further includes the bucket 10 that holds the target object. The truck information acquisition device 56 further acquires the position adjustment amount of the dump truck 200. When the loading task for loading the object onto the dump truck 200 is acquired, the correction section 87 calculates the position of the bucket 10 when loading the target object from the bucket 10 onto the dump truck 200 based on the position adjustment amount acquired by the truck information acquisition device 56, the recognition area, and the estimated area. The control device 40 controls the loading operation of the hydraulic excavator 1 based on the position of the bucket 10 calculated by the correction section 87.

As a result, the hydraulic excavator 1 of Embodiment 1 can make the control target value of the control device 40 as the loading position of the bucket 10 more reasonable. Therefore, the hydraulic excavator 1 of Embodiment 1 can further improve the safety and productivity of the loading work. Thus, according to Embodiment 1, it is possible to provide the hydraulic excavator 1 that can further appropriately control the loading work onto the dump truck 200 by accurately recognizing the position and the posture of the dump truck 200 in various situations.

Furthermore, the correction section 87 corrects the recognition area such that the recognition area becomes an area encompassed by the overlapping area between the recognition area and the estimated area when the reaching task, which is performed after the termination of the loading task for loading the target object onto the dump truck 200, is acquired.

As a result, the hydraulic excavator 1 of Embodiment 1 can further reduce the risk of the front work device 2, which moves from the inside to the outside of the dump truck 200 during the reaching operation, colliding with the dump truck 200. Therefore, the hydraulic excavator 1 of Embodiment 1 can further improve the safety and productivity of the loading work. Thus, according to Embodiment 1, it is possible to provide the hydraulic excavator 1 that can further appropriately control the loading work onto the dump truck 200 by accurately recognizing the position and the posture of the dump truck 200 in various situations.

Furthermore, when the information processing device 54 (the verification section 86) has determined that the recognition result of the dump truck 200 is not correctable, it notifies the user of the determination result that the recognition result is not correctable and displays the screen 551 on the display device 55 to confirm with the user whether the operation of the body of the hydraulic excavator 1 is allowed to be continued. When the information processing device 54 (the verification section 86) receives the confirmation result from the user as to whether or not the operation is allowed be continued, it outputs the confirmation result to the control device 40. The control device 40 controls the operation of the body of the hydraulic excavator 1 according to the confirmation result.

In the hydraulic excavator 1, there is a possibility that the recognition result of the dump truck 200 might be determined to be not correctable due to the influence of the site environment, such as sand and dust present in the surrounding environment, sensor malfunction, or the like. Even in such a case, the hydraulic excavator 1 of Embodiment 1 is allowed to be continued to operate the hydraulic excavator 1 under appropriate determination by seeking instructions from the operator or the manager. Thus, according to Embodiment 1, it is possible to provide the hydraulic excavator 1 that can properly control the loading work onto the dump truck 200 even when the recognition result of the dump truck 200 is not correctable.

Embodiment 2

The work machine of Embodiment 2 is described using FIGS. 16 and 17. In the work machine of Embodiment 2, the same configuration and operation as in Embodiment 1 will be omitted from the description.

FIG. 16 a block diagram illustrating a functional configuration of an information processing device 54 of Embodiment 2. FIG. 17 is a view illustrating a process of a truck posture estimation section 88 illustrated in FIG. 16.

The truck information acquisition device 56 of Embodiment 1 acquires the truck information including the position, the posture, and the vehicle class information of the dump truck 200. However, some of the position and dispatch management systems of the dump truck 200 may manage the two-dimensional position and the orientation of the dump truck 200 on the map, but not the posture of the dump truck 200.

Therefore, the hydraulic excavator 1 of Embodiment 2 estimates the posture of the dump truck 200 from terrain information around the hydraulic excavator 1. Specifically, the hydraulic excavator 1 of Embodiment 2 includes a terrain information acquisition device 59 that acquires the terrain information around the hydraulic excavator 1, as illustrated in FIG. 16. The information processing device 54 of Embodiment 2 includes the truck posture estimation section 88 that estimates the posture of the dump truck 200 based on the terrain information acquired by the terrain information acquisition device 59. The area estimation section 85 of Embodiment 2 calculates the estimated area using the posture estimation of the dump truck 200 estimated by the truck posture estimation section 88.

The terrain information acquisition device 59 may be attached to the upper swing body 7 of the hydraulic excavator 1. The terrain information acquisition device 59 may, for example, share a sensor with the external measuring device 70 to measure the terrain around the hydraulic excavator 1 and acquire the terrain information at the information processing device 54 from the measurement result. Alternatively, the terrain information acquisition device 59 may have a wireless communication function and acquire the terrain information by receiving the terrain information transmitted from an external system that measures the terrain of the site. The method of acquiring the terrain information is not limited in the present embodiment.

The terrain information of the present embodiment is assumed to be given as point cloud data. However, the terrain information is not limited to the point cloud data, but may be, for example, grid format data that divides the area around the hydraulic excavator 1 into a grid and holds height information for each grid.

The truck posture estimation section 88 acquires the position, the orientation, and the vehicle class information of the dump truck 200 included in the truck information acquired by the truck information acquisition device 56, and the terrain information acquired by the terrain information acquisition device 59. Based on the acquired information, the truck posture estimation section 88 extracts the terrain information within the presence area 210 of the dump truck 200. The truck posture estimation section 88 performs a plane estimation of the terrain within the presence area 210 from the extracted terrain information. For example, a least-squares approximation can be used as the plane estimation. The truck posture estimation section 88 then estimates the posture of the dump truck 200 by calculating the inclination angle of the plane acquired by the plane estimation. Specifically, the truck posture estimation section 88 calculates the angles θroll and θpitch indicating the posture of the dump truck 200 from the angles formed by the normal vector nt of the plane acquired by the plane estimation and the Y- and Z-axes of the site coordinate system 500, respectively.

The area estimation section 85 of Embodiment 2 calculates the estimated area of the dump truck 200 based on the position, the orientation, and the vehicle class information of the dump truck 200 acquired by the truck information acquisition device 56 and the posture of the dump truck 200 estimated by the truck posture estimation section 88. The method of calculating the estimated area is the same as in Embodiment 1.

As described above, the hydraulic excavator 1 of Embodiment 2 further includes the terrain information acquisition device 59. The information processing device 54 of Embodiment 2 includes the truck posture estimation section 88 that estimates the posture of the dump truck 200 based on the terrain information acquired by the terrain information acquisition device 59. The area estimation section 85 of Embodiment 2 calculates the estimated area using the posture of the dump truck 200 estimated by the truck posture estimation section 88.

As a result, the hydraulic excavator 1 of Embodiment 2 can accurately correct the recognition area even when the posture of the dump truck 200 is not managed by the position and dispatch management system of the dump truck 200. Thus, according to Embodiment 2, it is possible to provide the hydraulic excavator 1 that can appropriately control the loading work onto the dump truck 200 by accurately recognizing the position and the posture of the dump truck 200 in various situations.

Embodiment 3

The hydraulic excavator 1 of Embodiment 3 is described using FIG. 18. In the hydraulic excavator 1 of Embodiment 3, the same configuration and operation as in Embodiment 1 will be omitted.

FIG. 18 is a block diagram illustrating a functional configuration of an information processing device 54 of Embodiment 3.

The information processing device 54 of Embodiment 3 performs the recognition of the dump truck 200 using only the point cloud data of the dump truck 200 and its surroundings among the point cloud data acquired by the external measuring device 70.

Specifically, the information processing device 54 of Embodiment 3 further includes a filter section 89 that extracts the point cloud data within a predetermined area including the estimated area calculated by the area estimation section 85 from the point cloud data acquired by the external measuring device 70. The recognition section 84 of Embodiment 3 recognizes the dump truck 200 from the point cloud data extracted by the filter section 89 and calculates the recognition area of the dump truck 200. The method of calculating the recognition area is the same as in Embodiment 1.

When the point cloud data acquired by the external measuring device 70 includes data for other than the dump truck 200 (another work machine or ground), it may generally cause a decrease in the accuracy of the recognition process and a longer processing time. The hydraulic excavator 1 of Embodiment 3 can remove the point cloud data that is a disturbance using the estimated area calculated by the area estimation section 85. As a result, the hydraulic excavator 1 of Embodiment 3 can improve the accuracy of the recognition process and shorten the processing time. Thus, according to Embodiment 3, it is possible to provide the hydraulic excavator 1 that can accurately and quickly recognize the position and the posture of the dump truck 200 in various situations, thereby enabling appropriate and quick control of the loading work onto the dump truck 200.

[Others]

The present invention is not limited to the above embodiments, but includes various modifications. For example, the above embodiments are described in detail for the purpose of describing the invention in an easy-to-understand manner, and are not necessarily limited to those having all the described configurations. It is also possible to replace a part of a configuration of one embodiment with a configuration of another embodiment, and it is also possible to add a configuration of another embodiment to a configuration of one embodiment. It is also possible to add, delete, or replace some of configurations of each embodiment with other configurations.

In addition, each of the above components, functions, processing sections, processing means, and the like, may be realized in hardware by designing some or all of them, for example, in an integrated circuit. In addition, each of the above components, functions, and the like may be realized by software, in which a processor interprets and executes a program that realizes the respective function. Information such as programs, tapes, and files that realize each function can be placed in memory, hard disks, solid state drives (SSD), or other recording devices, or in recording media such as IC cards, SD cards, and DVDs.

In addition, control lines and information lines are those considered necessary for illustrative purposes, and not all the control line and information lines are necessarily illustrated in the product. In reality, almost all the components may be considered to be interconnected.

REFERENCE SIGNS LIST

• • 1 Hydraulic excavator (Work machine)
  • 54 Information processing device
  • 55 Display device
  • 56 Truck information acquisition device (Carrier machine information acquisition device)
  • 59 Terrain information acquisition device
  • 70 External measuring device
  • 80 Task acquisition section
  • 84 Recognition section
  • 85 Area estimation section
  • 86 Verification section
  • 87 Correction section
  • 88 Truck posture estimation section
  • 89 Filter section
  • 200 Dump truck (carrier machine)
  • Sde Estimated area
  • Sdr Recognition area

Claims

1. A work machine for loading a target object onto a carrier machine, comprising: an external measuring device that measures a surrounding environment of a body of the work machine;an information processing device that recognizes the carrier machine present around the body based on a measurement result of the external measuring device; anda control device that controls an operation of the body based on a recognition result of the information processing device; anda carrier machine information acquisition device that acquires a position and vehicle class information of the carrier machine from an external source, whereinwherein the information processing device corrects a recognition result of the carrier machine based on the position and the vehicle class information of the carrier machine acquired by the carrier machine information acquisition device,wherein the control device controls the operation of the body based on the corrected recognition result of the carrier machine.

2. The work machine according to claim 1, wherein the information processing device includes: a recognition section that recognizes the carrier machine from the measurement result of the external measuring device and calculates a recognition area as an area where the recognized carrier machine is present;an area estimation section that calculates an estimated area as an area where the carrier machine is estimated to be present based on the position and the vehicle class information of the carrier machine acquired by the carrier machine information acquisition device; anda correction section that corrects the recognition area based on the estimated area.

3. The work machine according to claim 2, wherein the information processing device calculates a confidence of the recognition result by comparing the recognition area with the estimated area,wherein the correction section corrects the recognition area according to the calculated confidence.

4. The work machine according to claim 3, wherein the information processing device calculates an overlap degree indicating a degree of overlap between the recognition area and the estimated area as the confidence,wherein the correction section corrects the recognition area according to the calculated overlap degree.

5. The work machine according to claim 2, wherein the carrier machine information acquisition device further acquires information on a position adjustment amount of the carrier machine,wherein the area estimation section calculates the estimated area using the position adjustment amount acquired by the carrier machine information acquisition device.

6. The work machine according to claim 2, wherein the information processing device further includes a task acquisition section that acquires a next task to be performed by the work machine,wherein the correction section changes a correction method of the recognition area according to the acquired task.

7. The work machine according to claim 6, wherein when a loading task for loading the target object onto the carrier machine is acquired, the correction section corrects the recognition area such that the recognition area becomes an area encompassing the recognition area and the estimated area.

8. The work machine according to claim 6, further comprising a bucket that holds the target object,wherein the carrier machine information acquisition device further acquires information regarding a position adjustment amount of the carrier machine,wherein when a loading task for loading the target object onto the carrier machine is acquired, the correction section calculates a position of the bucket when loading the target object from the bucket onto the carrier machine based on the position adjustment amount acquired by the carrier machine information acquisition device, the recognition area, and the estimated area,wherein the control device controls a loading operation of the target object onto the carrier machine based on the position of the bucket calculated by the correction section.

9. The work machine according to claim 6, wherein when a reaching task to be performed after the loading task for loading the target object onto the carrier machine is terminated is acquired, the correction section corrects the recognition area such that the recognition area becomes an area encompassed by an area where the recognition area and the estimated area overlap.

10. The work machine according to claim 2, when the recognition result of the carrier machine is determined to be not correctable, the information processing device notifies a user of that the recognition result is not correctable and displays a screen on the display device to allow the user to confirm whether or not the operation of the body is allowed to be continued:when a confirmation result on whether or not the operation of the body is allowed to be continued is received from the user, the information processing device outputs the confirmation result to the control device,wherein the control device controls the operation of the body according to the confirmation result.

11. The work machine according to claim 2, further comprising a terrain information acquisition device that acquires terrain information around the work machine,wherein the information processing device further includes a posture estimation section that estimates a posture of the carrier machine based on the terrain information acquired by the terrain information acquisition device,wherein the area estimation section calculates the estimated area using the posture of the carrier machine estimated by the posture estimation section.

12. The work machine according to claim 2, wherein the external measuring device acquires point cloud data of the surrounding environment as the measurement result,wherein the information processing device further includes a filter section that extracts the point cloud data within a predetermined area including the estimated area from the point cloud data acquired by the external measuring device,wherein the recognition section recognizes the carrier machine from the point cloud data extracted by the filter section and calculates the recognition area.