Technical Field
[0001] The present invention relates to a work machine.
Background Art
[0002] 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.
[0003] 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.
[0004] 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
Summary of Invention
Technical Problem
[0006] 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.
[0007] 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.
[0008] 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
[0009] 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
[0010] 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.
[0011] The problems, configurations and effects other than the above will be clarified by
the description of the following embodiments.
Brief Description of Drawings
[0012]
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
[0013] 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.
[0014] 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]
[0015] Figs. 1 to 15 are used to describe the hydraulic excavator 1 of Embodiment 1.
<Exterior Configuration of Hydraulic Excavator>
[0016] 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.
[0017] 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.
[0018] 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."
[0019] 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.
[0020] 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.
[0021] 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.
[0022] 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.
[0023] 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.
[0024] 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."
[0025] 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.
[0026] 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.
[0027] 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.
[0028] 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.
[0029] 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>
[0030] Fig. 2 is a block diagram illustrating a hydraulic system and a control system mounted
on the hydraulic excavator 1 illustrated in Fig. 1.
[0031] 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.
[0032] 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.
[0033] 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.
[0034] 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>
[0035] Fig. 3 is a diagram illustrating an example of an operation of the hydraulic excavator
1 illustrated in Fig. 2.
[0036] 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.
[0037] 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.
[0038] 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.
[0039] Fig. 4 is a flowchart illustrating an example of the operation of the hydraulic excavator
1 illustrated in Fig. 2.
[0040] In Step S111, the task acquisition device 58 of the hydraulic excavator 1 acquires
an excavation task to excavate the ground to be excavated.
[0041] 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.
[0042] 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.
[0043] 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.
[0044] 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.
[0045] 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.
[0046] 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.
[0047] 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.
[0048] 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.
[0049] 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.
[0050] 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>
[0051] 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.
[0052] 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.
[0053] 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.
[0054] 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>
[0055] 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.
[0056] 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>
[0057] 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.
[0058] 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.
[Math. 1]

[Math. 2]

[Math. 3]

[0059] 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.
[0060] 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>
[0061] 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>
[0062] 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>
[0063] 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.
[0064] 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.
[0065] In the present embodiment, the position, the posture, and the presence area 210 of
the dump truck 200 are defined as follows.
[0066] 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.
[0067] 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>
[0068] 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.
[0069] 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).
[0070] 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.
[Math. 4]

[Math. 5]

[Math. 6]

[0071] 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.
[0072] 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.
[0073] 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>
[0074] 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>
[0075] 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.
[0076] 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>
[0077] 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.
[0078] In Step S121, the verification section 86 of the information processing device 54
acquires the task acquired by the task acquisition section 80.
[0079] In Step S122, the verification section 86 of the information processing device 54
acquires the recognition area calculated by the recognition section 84.
[0080] In Step S123, the verification section 86 of the information processing device 54
acquires the estimated area calculated by the area estimation section 85.
[0081] 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).
[Math. 7]

[0082] 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.
[0083] 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.
[0084] 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.
[0085] 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.
[0086] 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.
[0087] 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.
[0088] 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.
[0089] 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.
[0090] 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.
[Math. 8]

[Math. 9]

[0091] Δ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.
[0092] Δ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.
[0093] 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).
[Math. 10]

[0094] 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.
[0095] 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.
[0096] 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.
[0097] 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).
[0098] 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.
[0099] 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.
[0100] 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>
[0101] 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.
[0102] 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.
[0103] 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>
[0104] 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.
[0105] 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.
[0106] 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.
[0107] 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.
[0108] 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.
[0109] 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.
[0110] 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.
[0111] 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.
[0112] 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.
[0113] 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.
[0114] 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.
[0115] 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.
[0116] 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.
[0117] 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.
[0118] 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.
[0119] 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.
[0120] 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.
[0121] 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.
[0122] 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.
[0123] 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.
[0124] 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.
[0125] 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]
[0126] 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.
[0127] 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.
[0128] 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.
[0129] 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.
[0130] 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.
[0131] 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.
[0132] 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.
[0133] 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.
[0134] 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.
[0135] 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]
[0136] 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.
[0137] Fig. 18 is a block diagram illustrating a functional configuration of an information
processing device 54 of Embodiment 3.
[0138] 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.
[0139] 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.
[0140] 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]
[0141] 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.
[0142] 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.
[0143] 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
[0144]
- 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