Control system for loading machine, control method for loading machine, and remote control system for loading machine

Abstract

In the present invention, when it is determined that automatic control is to be started, a control unit controls a turning body and a work machine so that the lowest point of a work tool is at an intermediate target height higher than a loading target and lower than a target point, before the turning body faces a second direction in which the work machine does not interfere with the loading target in plan view from above from a first direction in which the turning body faces the start point. The control unit controls the turning body and the work machine so that the lowest point of the work tool is at the height of the target point before the turning body faces a third direction facing the target point from the second direction.

Description

Loading machine control system, loading machine control method, and loading machine remote control system

[0001] This disclosure relates to a control system for a loading machine, a control method for a loading machine, and a remote operation system for a loading machine. This application claims priority to Japanese Patent Application No. 2023-141696, filed on August 31, 2023, the contents of which are incorporated herein by reference.

[0002] Patent Document 1 discloses a technology for automatically controlling a loading machine in which the implement is moved to an interference avoidance point to avoid contact with the transport vehicle that is the loading target, and then the implement is moved to a discharge point only by rotating the rotating body. The interference avoidance point in Patent Document 1 is a position that has the same height as the discharge point, is the same distance from the rotation center of the rotating body as the distance from the rotation center to the discharge point, and where there is no loading target below.

[0003] Japanese Patent Application Laid-Open No. 2022-079773

[0004] When a loading machine has a clam bucket, opening the clam allows the bucket to unload soil while holding the load. On the other hand, when unloading soil by rotating the bucket, the height of the bucket's lowest point decreases as the bucket rotates. Therefore, according to the method described in Patent Document 1, the height of the interference avoidance point is set too high relative to the height of the object being loaded, which can result in a long time required for rotation. The object of the present disclosure is to provide a loading machine control system, a loading machine control method, and a loading machine remote control system that can shorten the time required for automatic control.

[0005] According to one aspect of the present invention, a control system for a loading machine is a control device for a loading machine that includes a rotating body that rotates around a rotation center, a support unit that supports the rotating body, and a work machine that has a work implement attached to the rotating body, and includes a control point determination unit that, when the work implement is moved by automatic control to a target point above a loading object, determines a control point for the automatic control that is lower than the height of the target point and in a direction that does not cause the work implement to interfere with the loading object in a planar view from above, and a control unit that controls the rotating body and the work implement via the control point when the automatic control is started.

[0006] According to the above aspect, the control system for the loading machine can reduce the time required for automatic control.

[0007] FIG. 1 is a schematic diagram showing the configuration of a remote control system according to the first embodiment. FIG. 2 is a schematic diagram showing the configuration of a loading machine according to the first embodiment. FIG. 3 is a schematic block diagram showing the configuration of a control device according to the first embodiment. FIG. 4 is a diagram showing an example of a travel route according to the first embodiment. FIG. 5 is a schematic block diagram showing the configuration of a control device for a loading machine according to the first embodiment. FIG. 6 is a diagram showing an example of the movement of the loading machine during a first swing according to the first embodiment. FIG. 7 is a diagram showing an example of the movement of the loading machine during a second swing according to the first embodiment. FIG. 8 is a flowchart (part 1) showing an automatic control method for a work system according to the first embodiment. FIG. 9 is a flowchart (part 2) showing an automatic control method for a work system according to the first embodiment. FIG. 10 is a flowchart (part 3) showing an automatic control method for a work system according to the first embodiment.

[0008] <First embodiment> <Work system> Fig. 1 is a schematic diagram showing the configuration of a remote operation system according to a first embodiment. The work system 1 includes a loading machine 100, one or more transport vehicles 300 to be loaded, a control device 500, and a remote operator's cab 700. The loading machine 100 and the transport vehicles 300 operate at a work site (e.g., a mine or a quarry). The remote operator's cab 700 is provided at a location away from the work site (e.g., in a city or within the work site).

[0009] The loading machine 100 operates at a construction site, excavates construction objects such as soil and sand, and loads them as cargo onto the bed of the transport vehicle 300. Examples of the loading machine 100 include a face shovel, a backhoe shovel, and a rope shovel. The loading machine 100 may be electrically driven or hydraulically driven. The loading machine 100 according to the first embodiment is a backhoe shovel. The loading machine 100 is remotely controlled based on an operation signal transmitted from a remote operator's cab 700. The loading machine 100 and the remote operator's cab 700 are connected by communication via an access point AP1. The operation device 730 of the remote operator's cab 700 receives an operation of the loading machine 100 from an operator, and the remote control device 800 transmits the operation signal to the control device 500. The loading machine 100 operates based on the operation signal received from the remote operator's cab 700. That is, the work system 1 includes a remote operation system made up of the loading machine 100 and the remote operator's cab 700. The access point AP1 is used for communication in the remote operation system.

[0010] The haulage vehicle 300 travels unmanned based on control information received from the control device 500. The haulage vehicle 300 and the control device 500 are connected by communication via an access point AP2. The control device 500 acquires the position and direction of the haulage vehicle 300 from the haulage vehicle 300, and generates course information to be used for the travel of the haulage vehicle 300 based on this information. The control device 500 transmits the course information to the haulage vehicle 300. The haulage vehicle 300 travels unmanned based on the received course information. In other words, the work system 1 includes an unmanned guided vehicle system including the haulage vehicle 300 and the control device 500. The access point AP2 is used for communication of the unmanned guided vehicle system.

[0011] The control device 500 receives instruction signals for the transport vehicle 300 from the loading machine 100 and the remote cab 700 and transmits these to the transport vehicle 300. The loading machine 100 and the control device 500 are connected by communication via an access point AP2. The remote cab 700 and the control device 500 are also connected via a network. Examples of instruction signals for the transport vehicle 300 received from the loading machine 100 and the remote cab 700 include an approach instruction signal and a departure instruction signal. The approach instruction signal is a signal that instructs the transport vehicle 300 to approach from the waiting point P1 to the loading point P3. The departure instruction signal is a signal that instructs the transport vehicle 300 to depart from the loading point P3 upon completion of loading and to exit the loading site A1.

[0012] <<Transportation Vehicle>> The transportation vehicle 300 according to the first embodiment is an unmanned dump truck that travels unmanned along a set travel route. Note that the transportation vehicle 300 according to other embodiments may be a transporter other than a dump truck. The transportation vehicle 300 includes a position and orientation detector 310 and a transport control device 400.

[0013] The position and orientation detector 310 detects the position and orientation of the haulage vehicle 300. The position and orientation detector 310 includes two receivers that receive positioning signals from satellites that make up the Global Navigation Satellite System (GNSS). The two receivers are installed at different positions on the haulage vehicle 300. The position and orientation detector 310 detects the position of a representative point of the haulage vehicle 300 in a site coordinate system based on the positioning signals received by the receivers. The position and orientation detector 310 calculates the orientation of the haulage vehicle 300 as the relationship between the installation position of one receiver and the installation position of the other receiver using the positioning signals received by the two receivers. Note that this is not limited to this, and in other embodiments, the haulage vehicle 300 may include an inertial measurement unit (IMU), and the orientation may be calculated based on the measurement results of the IMU. In this case, drift of the IMU may be corrected based on the travel trajectory of the haulage vehicle 300. When the heading is calculated using an inertial measurement unit, the transport vehicle 300 only needs to be equipped with one receiver.

[0014] The transportation control device 400 transmits the position and direction detected by the position and direction detector 310 to the control device 500. The transportation control device 400 receives course information and instruction signals from the control device 500. The transportation control device 400 causes the transportation vehicle 300 to travel or raises and lowers the vessel of the transportation vehicle 300 based on the received course information and instruction signals.

[0015] 2 is a schematic diagram showing the configuration of the loading machine 100 according to the first embodiment. The loading machine 100 includes a traveling body 110, a revolving body 120, and a work machine 130.

[0016] The running body 110 supports the loading machine 100 so that it can travel. The running body 110 includes two caterpillar tracks 111 provided on the left and right sides, and two travel motors 112 for driving each caterpillar track 111. The running body 110 is an example of a support unit. The rotating body 120 is supported on the running body 110 so that it can rotate about a rotation center. The working implement 130 is hydraulically driven. The working implement 130 is supported on the front part of the rotating body 120 so that it can be driven in the vertical direction. Here, the part of the rotating body 120 to which the working implement 130 is attached is referred to as the front part. Furthermore, with respect to the rotating body 120, the part opposite the front part is referred to as the rear part, the part on the left side is referred to as the left part, and the part on the right side is referred to as the right part.

[0017] The revolving unit 120 includes an engine 121, a hydraulic pump 122, a control valve 123, and a swing motor 124. The engine 121 is a prime mover that drives the hydraulic pump 122. The engine 121 is an example of a power source. The hydraulic pump 122 is a variable displacement pump that is driven by the engine 121. The hydraulic pump 122 supplies hydraulic oil to each actuator (boom cylinder 131C, arm cylinder 132C, bucket cylinder 133C, travel motor 112, and swing motor 124) via a control valve 123. The control valve 123 controls the flow rate of hydraulic oil supplied from the hydraulic pump 122. The swing motor 124 is driven by hydraulic oil supplied from the hydraulic pump 122 via the control valve 123, causing the revolving unit 120 to swing.

[0018] The work machine 130 includes a boom 131, an arm 132, a bucket 133 as a work implement, a boom cylinder 131C, an arm cylinder 132C, and a bucket cylinder 133C. Other examples of the work implement include tip attachments such as a tilt bucket and a tilt rotate bucket.

[0019] The base end of the boom 131 is rotatably attached to the revolving unit 120 via a boom pin. In the loading machine 100 shown in FIG. 2 , the boom 131 is provided at the center of the front of the revolving unit 120, but this is not limiting. The boom 131 may be attached offset in the left-right direction. In this case, the center of rotation of the revolving unit 120 is not located on the operating plane of the work implement 130. The arm 132 connects the boom 131 and the bucket 133. The base end of the arm 132 is rotatably attached to the tip of the boom 131 via an arm pin. The bucket 133 is rotatably attached to the tip of the arm 132 via a pin. The boom 131 and the arm 132 are members that support the bucket 133. The bucket 133 functions as a container for collecting excavated soil and sand. The bucket 133 is attached with its opening facing the revolving unit 120 (rearward). That is, the loading machine 100 , which is a backhoe excavator, performs excavation by pulling the bucket 133 toward the front side of the rotating body 120 .

[0020] The boom cylinder 131C is a hydraulic cylinder for operating the boom 131. A base end of the boom cylinder 131C is attached to the revolving unit 120. A tip end of the boom cylinder 131C is attached to the boom 131. The arm cylinder 132C is a hydraulic cylinder for driving the arm 132. A base end of the arm cylinder 132C is attached to the boom 131. A tip end of the arm cylinder 132C is attached to the arm 132. The bucket cylinder 133C is a hydraulic cylinder for driving the bucket 133. A base end of the bucket cylinder 133C is attached to the arm 132. A tip end of the bucket cylinder 133C is attached to a link mechanism that rotates the bucket 133.

[0021] As shown in FIG. 2 , the loading machine 100 includes a position and orientation calculator 151 , an inclination measuring device 152 , a boom stroke sensor 153 , an arm stroke sensor 154 , a bucket stroke sensor 155 , an imaging device 156 , and a loading control device 200 .

[0022] The position and orientation calculator 151 calculates the position of the revolving unit 120 and the orientation in which the revolving unit 120 faces. The position and orientation calculator 151 includes two receivers that receive positioning signals from satellites that make up the GNSS. The two receivers are installed at different positions on the revolving unit 120. The position and orientation calculator 151 detects the position of a representative point of the revolving unit 120 in the on-site coordinate system (the origin of the vehicle body coordinate system) based on the positioning signals received by the receivers. The position and orientation calculator 151 uses the positioning signals received by the two receivers to calculate the orientation in which the revolving unit 120 faces as the relationship between the installation position of one receiver and the installation position of the other receiver. The orientation in which the revolving unit 120 faces is the direction perpendicular to the front of the revolving unit 120. The direction in which the rotating body 120 faces is equal to the horizontal component of the extension direction of a straight line extending from the boom 131 to the bucket 133 of the work implement 130 .

[0023] The inclinometer 152 measures the acceleration and angular velocity of the rotating unit 120, and detects the attitude (e.g., roll angle, pitch angle, yaw angle) and rotation speed of the rotating unit 120 based on the measurement results. The inclinometer 152 is installed, for example, on the underside of the rotating unit 120. The inclinometer 152 can be, for example, an inertial measurement unit (IMU).

[0024] The boom stroke sensor 153 is attached to the boom cylinder 131C and detects the cylinder length of the boom cylinder 131C. The cylinder length of the boom cylinder 131C can be converted into the relative angle of the boom 131 with respect to the revolving unit 120. The arm stroke sensor 154 is attached to the arm cylinder 132C and detects the cylinder length of the arm cylinder 132C. The cylinder length of the arm cylinder 132C can be converted into the relative angle of the arm 132 with respect to the boom 131. The bucket stroke sensor 155 is attached to the bucket cylinder 133C and detects the cylinder length of the bucket cylinder 133C. The cylinder length of the bucket cylinder 133C can be converted into the relative angle of the bucket 133 with respect to the arm 132. The loading machine 100 according to the first embodiment uses the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155 to identify the angles of the link components of the work implement 130, but this is not limited to this in other embodiments. For example, in other embodiments, instead of the stroke sensor, a potentiometer that detects the relative rotation angle of the link parts may be provided, or an inclination sensor that detects the angle of each link part relative to the ground may be provided.

[0025] The imaging device 156 is installed in a portion of the loading machine 100 that corresponds to the driver's cab. The imaging device 156 captures an image of the area in front of the loading machine 100. Examples of the imaging device 156 include imaging devices that use a CCD (Charge Coupled Device) sensor and a CMOS (Complementary Metal Oxide Semiconductor) sensor. Note that in other embodiments, the imaging device 156 does not necessarily have to be installed in a portion that corresponds to the driver's cab, and it is sufficient that the imaging device 156 is installed in a position that allows at least an image of the work target and the work implement 130 to be captured.

[0026] The loading control device 200 transmits to the remote operator's cab 700 measurement data including images captured by the imaging device 156, the rotation speed, position, and orientation of the revolving unit 120, the traveling speed of the traveling unit 110, the attitude of the revolving unit 120, and the tilt angles of the boom 131, arm 132, and bucket 133. Note that measurement data in other embodiments is not limited to this. For example, measurement data in other embodiments may not include any of the rotation speed, position, orientation, tilt angle, traveling speed, and attitude, and may include values ​​measured by other sensors, or may include values ​​calculated from the measured values. The loading control device 200 receives operation signals from the remote operator's cab 700. The loading control device 200 drives the traveling unit 110, the revolving unit 120, or the work implement 130 based on the received operation signals.

[0027] <<Control Device>> Figure 3 is a schematic block diagram showing the configuration of a control device according to the first embodiment. The control device 500 manages the traveling of the haulage vehicle 300. The control device 500 is a computer including a processor 510, a main memory 520, a storage 530, and an interface 540. The storage 530 stores a control program. The processor 510 reads the control program from the storage 530, loads it into the main memory 520, and executes processing in accordance with the control program. The control device 500 is connected to a network via the interface 540. An access point AP2 is connected to the interface 540. The control device 500 is wirelessly connected to the loading machine 100 and the haulage vehicle 300 via the access point AP2.

[0028] The storage 530 has storage areas serving as a travel route storage unit 531 and a position and orientation storage unit 532. Examples of the storage 530 include a hard disk drive (HDD), a solid state drive (SSD), a magnetic disk, a magneto-optical disk, a compact disc read only memory (CD-ROM), a digital versatile disc read only memory (DVD-ROM), and a semiconductor memory. The storage 530 may be an internal medium directly connected to the common communication line of the control device 500, or may be an external medium connected to the control device 500 via an interface 540. The storage 530 is a non-transitory tangible storage medium.

[0029] The travel route storage unit 531 stores a travel route R for each transport vehicle 300. FIG. 4 is a diagram showing an example of a travel route. The travel route R includes a predetermined connecting route R1 connecting two areas A (e.g., a loading site A1 and a dumping site A2), as well as an entrance route R2, an approach route R3, and an exit route R4, which are routes within area A. The entrance route R2 connects a waiting point P1, which is one end of the connecting route R1, to a predetermined turning point P2 within area A. The approach route R3 connects the turning point P2 within area A to a loading point P3 or a dumping point P4. The exit route R4 connects a loading point P3 or a dumping point P4 within area A to an exit point P5, which is the other end of the connecting route R1. The loading point P3 is a point set by the operator of the loading machine 100. The turning point P2 is a point set by the control device 500 in accordance with the position of the loading point P3.

[0030] The position and direction storage unit 532 stores the position information and direction information of each of the transport vehicles 300 .

[0031] The processor 510 includes a position and direction collection unit 511 and a driving course generation unit 512 by executing a control program.

[0032] The position and orientation collection unit 511 receives the position information and orientation information of the delivery vehicle 300 from the delivery vehicle 300 via the access point AP2. The position and orientation collection unit 511 stores the received position information and orientation information in the position and orientation storage unit 532.

[0033] The travel course generation unit 512 generates course information including information on areas in which the transport vehicle 300 is permitted to move, based on the travel route stored in the travel route storage unit 531 and the position information and direction information stored in the position direction storage unit 532. The generated course information is transmitted to the transport vehicle 300. The course information includes position information of points set at predetermined intervals on the travel route, target speed information at those points, and information on permitted travel areas that do not overlap with permitted travel areas of other transport vehicles 300.

[0034] The travel course generation unit 512 does not include the approach route R2 and the approach route R3 in the area indicated by the course information until it receives an approach instruction signal from the remote driver's cab 700. As a result, the haulage vehicle 300 waits at the waiting point P1 until it receives the approach instruction signal. When the travel course generation unit 512 receives the approach instruction signal, it generates course information that includes the approach route R2 and the approach route R3 but does not include the exit route R4. As a result, the haulage vehicle 300 starts from the waiting point P1, travels to the loading point P3, and stops at the loading point P3. When the travel course generation unit 512 receives the departure instruction signal, it generates course information that includes the exit route R4. Note that in the work system 1 according to this embodiment, the haulage vehicle 300 waits at the waiting point P1 until it receives the approach instruction signal, but this is not limited to this. For example, in other embodiments, the waiting position of the haulage vehicle 300 may be the turning point P2 or a point along the approach route R2 or the approach route R3.

[0035] <<Remote Operator's Cabin>> The remote operator's cab 700 includes a driver's seat 710, a display device 720, an operation device 730, an operation terminal 740, and a remote control device 800. The display device 720 is disposed in front of the driver's seat 710. The display device 720 is located in front of the operator when the operator sits in the driver's seat 710. The display device 720 may be configured with multiple displays arranged side by side as shown in FIG. 1 , or may be configured with one large display. The display device 720 may also be configured to project an image onto a curved or spherical surface using a projector or the like.

[0036] The operation device 730 is an operation device for the remote operation system. In response to operation by the operator, the operation device 730 generates operation signals for the boom cylinder 131C, the arm cylinder 132C, the bucket cylinder 133C, operation signals for swinging the revolving body 120 left and right, and travel operation signals for moving the traveling body 110 forward and backward, and outputs these to the remote control device 800. The operation device 730 is composed of, for example, a lever, a knob switch, and a pedal. An automatic control instruction signal for instructing the start of automatic control is generated by operating the knob switch.

[0037] The automatic control is a control in which the loading machine 100 autonomously controls the drive of the work implement 130 and the rotating body 120 to achieve a predetermined operation. The automatic control in the first embodiment is a control that the loading machine 100 autonomously performs the following operations: a first rotation ( FIG. 6 ) which is a series of operations in which the loading machine 100 rotates from a state in which the bucket 133 is positioned outside the transport vehicle 300 due to excavation of the excavation target to a direction facing the transport vehicle 300 while raising the boom 131; a loading operation in which the bucket 133 is rotated to load a load onto the transport vehicle 300; and a second rotation ( FIG. 7 ) which is a series of operations in which the loading machine 100 rotates from a state in which the bucket 133 is positioned above the transport vehicle 300 due to the loading operation to a predetermined direction while lowering the boom 131 to move the bucket 133 outside the transport vehicle 300. Note that in the example shown in FIGS. 6 and 7 , the height of the transport vehicle 300 is higher than the excavation height, so the boom 131 is raised in the first rotation and lowered in the second rotation, but the present invention is not limited to this. For example, if the height of the transport vehicle 300 is lower than the excavation height, the boom 131 is lowered during the first rotation and raised during the second rotation. Note that automatic control according to other embodiments may only perform the first rotation. Note that the excavation target is usually located at a position lower than the height of the transport vehicle 300. Therefore, the loading machine 100 controls the drive of the work implement 130 during the first rotation and the second rotation so that the transport vehicle 300 and the work implement 130 do not come into contact with each other. Details of the automatic control will be described later.

[0038] The operation terminal 740 transmits a start instruction signal to the control device 500 in response to an operation by the operator. The operation terminal 740 is configured, for example, with a touch panel or the like. The operation device 730 and the operation terminal 740 are arranged near the driver's seat 710. The operation device 730 and the operation terminal 740 are located within a range that the operator can operate when sitting in the driver's seat 710.

[0039] The remote control device 800 displays the image received from the loading machine 100 on the display device 720 , and transmits an operation signal representing the operation of the operation device 730 to the loading machine 100 .

[0040] <<Control Device of Loading Machine 100>> Figure 5 is a schematic block diagram showing the configuration of the control device of the loading machine according to the first embodiment. The loading control device 200 is a computer including a processor 210, a main memory 220, a storage 230, and an interface 240. The storage 230 stores a loading control program. The processor 210 reads the loading control program from the storage 230, loads it into the main memory 220, and executes processing in accordance with the loading control program. The loading control device 200 is connected to a network via the interface 240.

[0041] Examples of storage 230 include HDD, SSD, magnetic disk, magneto-optical disk, CD-ROM, DVD-ROM, semiconductor memory, etc. Storage 230 may be an internal medium directly connected to the common communication line of loading control device 200, or may be an external medium connected to loading control device 200 via interface 240. Storage 230 is a non-transitory tangible storage medium.

[0042] The processor 210 includes an acquisition unit 211, a display control unit 212, an operation signal input unit 213, a posture identification unit 214, a control point determination unit 215, and a control unit 216 by executing the loading control program.

[0043] The acquisition unit 211 acquires measurement data of the loading machine 100 and each transport vehicle 300. The measurement data of each transport vehicle 300 is acquired from the control device 500 or the remote control device 800.

[0044] The display control unit 212 generates a display signal for displaying the image acquired by the acquisition unit 211 from the imaging device 156 and transmits the signal to the remote control device 800 .

[0045] The operation signal input unit 213 receives an input of an operation signal for the operation device 730 from the remote control device 800. The operation signals include an operation signal for the boom 131, an operation signal for the arm 132, an operation signal for the bucket 133, a rotation operation signal for the revolving unit 120, a travel operation signal for the traveling unit 110, and an automatic control instruction signal for the loading machine 100. When an automatic control instruction signal is input, the operation signal input unit 213 determines to perform automatic control. In other words, the operation signal input unit 213 is an example of an automatic control determination unit that determines whether to start automatic control.

[0046] The posture identifying unit 214 identifies the posture of the loading machine 100 based on the measurement data received by the acquisition unit 211. Specifically, the posture identifying unit 214 identifies at least the position of the tip of the arm 132 in the vehicle body coordinate system. The posture identifying unit 214 determines the vertical and horizontal components of the length of the boom 131 based on the tilt angle of the boom 131 and the known length of the boom 131 (the distance from the pin at the base end to the pin at the tip end). Similarly, the posture identifying unit 214 determines the vertical and horizontal components of the length of the arm 132. The posture identifying unit 214 identifies, as the position of the tip of the arm 132, a position that is away from the position of the loading machine 100 in a direction identified from the orientation and posture of the loading machine 100 by the sum of the vertical and horizontal components of the lengths of the boom 131 and the arm 132.

[0047] The control point determination unit 215 determines multiple control points for automatic control when an automatic control instruction signal is input to the operation signal input unit 213. The control points may be represented in a polar coordinate system based on the attitude of the revolving unit 120 when the automatic control instruction signal is input. In other words, the position of a control point is represented by the deflection angle from the direction in which the revolving unit 120 is facing when the automatic control instruction signal is input, a radius vector which is the distance from the center of rotation of the revolving unit 120, and a height. The control point determination unit 215 determines the positions of a start point p1, a first interference avoidance point p2a, a second interference avoidance point p2b, and a discharge point p3 as control points. The start point p1 is a target point for the tip of the arm 132 during the second swing. The first interference avoidance point p2a is a control point used to prevent contact between the work implement 130 and the transport vehicle 300 during the first swing. The second interference avoidance point p2b is a control point for controlling the second swing so that the work implement 130 does not come into contact with the transport vehicle 300. The earth unloading point p3 is a target point for the tip of the arm 132 during the first swing.

[0048] The control point determination unit 215 identifies the position of the tip of the arm 132 when the automatic control instruction signal is input as the position of the start point p1.

[0049] The control point determination unit 215 identifies the position of the unloading point p3 based on the measurement data of the position and orientation of the haulage vehicle 300 acquired by the acquisition unit 211. The unloading point p3 is a point located at the center of the vessel of the haulage vehicle 300 in a plan view from above. The height of the unloading point p3 is the height of the haulage vehicle 300 plus the length from the pin of the bucket 133 to the farthest point of the bucket 133 and a first margin. The length from the pin of the bucket 133 to the farthest point of the bucket 133 is, for example, the length from the pin of the bucket 133 to the cutting edge of the bucket 133. The first margin is a constant set so that the load loaded on the haulage vehicle 300 does not interfere with the bucket 133. The first margin may be a value determined in advance depending on the model of the haulage vehicle 300.

[0050] The control point determiner 215 identifies the positions of the first interference avoidance point p2a and the second interference avoidance point p2b based on the position and orientation of the loading machine 100 and the position and orientation of the haulage vehicle 300 acquired by the acquirer 211. The interference avoidance point p2 is a position whose distance from the center of rotation of the revolving unit 120 is equal to the distance from the center of rotation to the earth unloading point p3 and below which the haulage vehicle 300 is not present. The control point determiner 215, for example, identifies a circle related to the radius of the earth unloading point p3 and identifies the angle on the circle at which the outline of the bucket 133 does not interfere with the haulage vehicle 300 in a plan view and is closest to the deflection angle of the earth unloading point p3 as the deflection angle of the interference avoidance points p2a and p2b. The radius of the interference avoidance points p2a and p2b is equal to the radius of the earth unloading point p3. The control point determination unit 215 can determine whether the haulage vehicle 300 and the bucket 133 will interfere with each other based on the position, orientation, and known outer shape of the haulage vehicle 300, as well as the known shape of the bucket 133. Here, "same height" and "equal distance" do not necessarily mean a perfect match in height or distance, but rather allow for some error or margin. The height of the first interference avoidance point p2a is the height of the haulage vehicle 300 plus the height of the bucket 133 when it is in a load-holding position, plus a second margin. The height of the bucket 133 when it is in a load-holding position is, for example, the length from the pin of the bucket 133 to the bottom of the bucket 133. The second margin is a constant set so that the haulage vehicle 300 and the bucket 133 do not interfere with each other. The second margin may be a smaller value than the first margin. The height of the second interference avoidance point p2b may be the same as the height of the earth unloading point p3.

[0051] The control unit 216 generates operation signals for executing the first rotation, the loading operation, and the second rotation, based on the positions of the control points identified by the control point determination unit 215. The control unit 216 determines the control amount of each actuator according to the operation signal input to the operation signal input unit 213 or the operation signal it has generated, and outputs a control signal to the control valve 123.

[0052] <<Operation During Automatic Control>> Here, the movement of the loading machine 100 during automatic control according to the first embodiment will be described with reference to the drawings. Fig. 6 is a diagram showing an example of the movement of the loading machine 100 during a first swing according to the first embodiment. Fig. 7 is a diagram showing an example of the movement of the loading machine 100 during a second swing according to the first embodiment.

[0053] When automatic control is started, the control unit 216 first causes the loading machine 100 to execute a first swing. As shown in Fig. 6 , the loading machine 100 first starts driving the work implement 130 (boom 131, arm 132, and bucket 133), and raises the boom 131 to move the bucket 133 upward. After a delay, the loading control device 200 starts swinging the revolving unit 120. The loading control device 200 adjusts the swing start timing so that the height of the tip of the arm 132 reaches the height of the first interference avoidance point p2 (the intermediate target height for the first swing) and the distance from the swing center to the tip of the arm 132 is equal to the distance of the first interference avoidance point p2 by the time the swing angle of the revolving unit 120 matches the first interference avoidance angle θ1 (the deflection angle of the first interference avoidance point p2a). Note that if the height of the work implement 130 reaches the intermediate target height for the first swing by the time the swing angle of the swing unit 120 matches the first interference avoidance angle θ1, that is, if the lowest point of the bucket 133 is higher than the upper end of the vessel wall of the transport vehicle 300, the swing of the swing unit 120 will not cause the work implement 130 to come into contact with the transport vehicle 300. When the swing angle of the swing unit 120 reaches the first interference avoidance angle θ1, the loading control device 200 drives the swing unit 120 and the work implement 130 so that the position of the tip of the arm 132 matches the earth unloading point p3.

[0054] When the tip of the arm 132 reaches the discharge point p3, the loading control device 200 rotates the bucket 133 in the dumping direction. To improve work efficiency, the loading control device 200 may rotate the bucket 133 in the dumping direction at a timing that is earlier than the timing at which the bucket 133 reaches a point a certain angle before the discharge point p3, by a response delay time that is the time from when the discharge control command is issued until the soil falls. When a certain time has elapsed since the bucket 133 was rotated in the dumping direction, the control unit 216 causes the loading machine 100 to execute a second swing. As shown in FIG. 7 , the loading control device 200 rotates the rotating unit 120 without moving the work implement 130, maintaining the height of the lowest point of the bucket 133, until the swing angle of the rotating unit 120 exceeds the second interference avoidance angle θ2 (the difference between the deflection angle of the second interference avoidance point p2b and the deflection angle of the discharge point p3). When the rotation angle of the rotating unit 120 exceeds the second interference avoidance angle θ2, the loading control device 200 drives the boom 131, the arm 132, and the bucket 133. At this time, the loading control device 200 may drive all of the boom 131, the arm 132, and the bucket 133, or may drive only a portion of the boom 131, the arm 132, and the bucket 133, depending on the relationship between the posture at the start of the rotation and the target posture. When the position of the tip of the arm 132 reaches the start point p1, the loading control device 200 ends the automatic control of the loading machine 100. Note that in other embodiments, the posture of the work implement 130 at the end of the second rotation may not coincide with the posture at the start of the automatic control. In other embodiments, the position of the tip of the arm 132 may not coincide with the start point p1. For example, the posture of the work implement 130 at the end of the second rotation may be a predetermined posture that makes it easy to start excavation.

[0055] 6 and 7 show an example in which the positional relationship between the excavation position and the transport vehicle 300 is approximately 90 degrees around the rotating unit 120, but this is not limited to this in other embodiments. For example, in other embodiments, the positional relationship between the excavation position and the transport vehicle 300 may be another rotation angle position, such as approximately 180 degrees around the rotating unit 120.

[0056] <<Operation of the Loading Control Device 200>> The haulage vehicle 300 travels along the travel route R according to the course information generated by the control device 500, and stops at the waiting point P1. The operator of the loading machine 100 operates the operation terminal 740 (for example, by pressing a predetermined button) to input an entry instruction signal to the operation terminal 740. The entry instruction signal is transmitted from the operation terminal 740 to the control device 500. As a result, the control device 500 generates course information indicating the areas of the entry route R2 and the approach route R3. The haulage vehicle 300 travels along the approach route R3 and stops at the loading point P3. The operator operates the operation device 730 to scoop up earth and sand with the bucket 133 of the loading machine 100, and operates the knob switch of the operation device 730 to generate and output an automatic control instruction signal.

[0057] Fig. 8 is a flowchart (part 1) showing the automatic control method of the work system 1 according to the first embodiment. Fig. 9 is a flowchart (part 2) showing the automatic control method of the work system 1 according to the first embodiment. Fig. 10 is a flowchart (part 3) showing the automatic control method of the work system 1 according to the first embodiment. When the loading control device 200 receives an input of an automatic control instruction signal from the remote control device 800 by operation of the operator, it executes the automatic control shown in Figs. 8 to 10.

[0058] The acquisition unit 211 acquires measurement data of the loading machine 100 and the transport vehicle 300 (step S1). Specifically, the acquisition unit 211 acquires measurement data from the position and orientation calculator 151, the inclination measuring device 152, the boom stroke sensor 153, the arm stroke sensor 154, the bucket stroke sensor 155, and the imaging device 156. That is, the acquisition unit 211 acquires measurement data of the position and orientation of the revolving unit 120, the tilt angles of the boom 131, the arm 132, and the bucket 133, and the attitude of the revolving unit 120. The acquisition unit 211 also acquires measurement data of the position and orientation of the transport vehicle 300 from the control device 500.

[0059] The posture identification unit 214 identifies the position of the tip of the arm 132 at the time of input of the automatic control instruction signal based on the measurement data acquired by the acquisition unit 211 (step S2). The control point determination unit 215 identifies the position of the tip of the arm 132 identified in step S2 as the position of the start point p1 (step S3).

[0060] The control point determiner 215 specifies the position of the unloading point p3 based on the position information and orientation information of the haulage vehicle 300 acquired by the acquirer 211 and the known shape of the haulage vehicle 300 (step S4). The control point determiner 215 specifies the planar position (deflection angle and radius vector) of the unloading point p3 based on the position information and orientation information of the haulage vehicle 300 and the known shape of the haulage vehicle 300. The control point determiner 215 also specifies the height of the unloading point p3 by adding the length from the pin to the cutting edge of the bucket 133 and the first margin to the known height of the haulage vehicle 300.

[0061] The control point determiner 215 identifies the positions of the interference avoidance points p2a and p2b based on the position information and orientation information of the haulage vehicle 300 acquired by the acquirer 211, the known shape of the haulage vehicle 300, and the position of the unloading point p3 (step S5). The control point determiner 215 identifies the radius vector of the unloading point p3 as the radius vector of the interference avoidance points p2a and p2b. The control point determiner 215 identifies the deflection angle at which the outer shape of the bucket 133 does not interfere with the haulage vehicle 300 in a planar view and is closest to the unloading point p3 as the deflection angle of the interference avoidance points p2a and p2b. The control point determiner 215 identifies the height of the first interference avoidance point p2a by adding the length from the pin to the bottom of the bucket 133 and the second margin to the known height of the haulage vehicle 300. The control point determiner 215 identifies the height of the unloading point p3 as the height of the second interference avoidance point p2b.

[0062] The loading control device 200 first executes the first swing control of the loading machine 100 (FIG. 9). The acquisition unit 211 acquires the position and orientation of the revolving unit 120, the tilt angles of the boom 131, arm 132, and bucket 133, and the attitude of the revolving unit 120 (step S6). The attitude identification unit 214 identifies the position of the tip of the arm 132 based on the measurement data (step S7).

[0063] The control unit 216 determines whether or not the swing angle of the loading machine 100 is smaller than the deflection angle of the first interference avoidance point p2a determined in step S5 (step S8). The swing angle of the loading machine 100 is the angle of difference between the direction in which the swing unit 120 faces when the automatic control instruction signal is input (initial direction) and the direction in which the swing unit 120 is currently facing.

[0064] If the rotation angle of the loading machine 100 is smaller than the deflection angle of the first interference avoidance point p2a (step S8: YES), that is, if the rotating body 120 is facing outward from the transport vehicle 300, the control unit 216 determines whether the difference between the radius vector and height of the tip of the arm 132 identified in step S7 when expressed in a polar coordinate system and the radius vector and height of the first interference avoidance point p2a is smaller than a predetermined threshold value (step S9).

[0065] If the difference between the radius vector and height of the tip of the arm 132 and the radius vector and height of the first interference avoidance point p2a is equal to or greater than the threshold (step S9: NO), the control unit 216 generates automatic operation signals for the boom 131 and the arm 132 so as to bring the tip of the arm 132 closer to the radius vector and height of the first interference avoidance point p2a (step S10). At this time, the control unit 216 generates the automatic operation signals based on the positions and speeds of the boom 131 and the arm 132 identified from the measurement data acquired in step S6.

[0066] Furthermore, the control unit 216 calculates the sum of the drive speeds of the boom 131 and the arm 132 based on the generated automatic operation signals for the boom 131 and the arm 132, and generates an automatic operation signal for driving the bucket 133 at a speed equal to the sum of the drive speeds (step S11). This allows the control unit 216 to generate an operation signal that maintains the ground angle of the bucket 133. In other words, the control unit 216 maintains a state in which the bottom surface of the bucket 133 is at its lowest point during the first swing. Note that in other embodiments, the control unit 216 may generate the automatic operation signal for the bucket 133 by feedback control based on the difference between the target ground angle of the bucket 133 (e.g., the ground angle of the bucket 133 at the start of automatic control) and the actual ground angle of the bucket 133 identified from the measurement data acquired in step S6.

[0067] The control unit 216 determines whether the work implement 130 is rotating (step S12). For example, the control unit 216 determines that the work implement 130 is rotating if the rotation speed of the revolving unit 120 is equal to or greater than a predetermined speed. If the work implement 130 is not rotating (step S12: NO), the control unit 216 calculates a completion time until the difference between the radius vector and height of the tip of the arm 132 and the radius vector and height of the first interference avoidance point p2a becomes equal based on the speeds of the boom 131 and the arm 132 (step S13). The control unit 216 also calculates an arrival time until the rotation angle of the revolving unit 120 reaches the deflection angle of the first interference avoidance point p2a identified in step S5 when the revolving unit 120 starts rotating (step S14). The control unit 216 determines whether the completion time calculated in step S13 is shorter than the arrival time calculated in step S14 (step S15). That is, the control unit 216 determines whether the radius vector and height of the tip of the arm 132 match the radius vector and height of the first interference avoidance point p2a when the rotation angle reaches the deflection angle of the first interference avoidance point p2a.

[0068] If the completion time is equal to or greater than the arrival time (step S15: NO), i.e., if the radius vector and height of the tip of the arm 132 do not match those of the first interference avoidance point p2a by the time the swing angle reaches the deflection angle of the first interference avoidance point p2a, the control unit 216 does not generate a swing operation signal for the swing unit 120. On the other hand, if the completion time is less than the arrival time (step S15: YES), i.e., if the radius vector and height of the tip of the arm 132 match those of the first interference avoidance point p2a by the time the swing angle reaches the deflection angle of the first interference avoidance point p2a, the control unit 216 generates a swing operation signal for the swing unit 120 (step S16). This allows the loading control device 200 to prevent the working implement 130 from swinging at a low height and coming into contact with the transport vehicle 300. Furthermore, because the height of the first interference avoidance point p2a is lower than the height of the earth unloading point p3, the time during which only the working implement 130 is driven without swinging can be shortened during the first swing.

[0069] The control section 216 outputs the generated automatic operation signal to the control valve 123 (step S17), thereby driving the loading machine 100. Then, the loading control device 200 returns the process to step S6 and continues control.

[0070] On the other hand, if it is determined in step S12 that the work implement 130 is swinging (step S12: YES), the control unit 216 generates a swing operation signal in step S16 and outputs the swing operation signal to the control valve 123 in step S17. Then, the loading control device 200 returns the process to step S6 and continues control.

[0071] On the other hand, if the rotation angle is greater than or equal to the deflection angle of the first interference avoidance point p2a (step S8: NO), that is, if the rotating body 120 is facing the transport vehicle 300, the control unit 216 determines whether the difference between the height of the tip of the arm 132 identified in step S7 when expressed in a polar coordinate system and the height of the discharge point p3 is smaller than a predetermined threshold value (step S18).

[0072] If the difference between the height of the tip of the arm 132 and the height of the earth unloading point p3 is equal to or greater than the threshold value (step S18: NO), the control unit 216 generates automatic operation signals for the boom 131 and the arm 132 so as to bring the height of the tip of the arm 132 closer to the height of the earth unloading point p3 (step S19). The control unit 216 also calculates the sum of the drive speeds of the boom 131 and the arm 132 based on the generated automatic operation signals for the boom 131 and the arm 132, and generates an automatic operation signal for driving the bucket 133 at a speed equal to the sum of the drive speeds (step S20). Note that in another embodiment, the control unit 216 may generate the automatic operation signal for the bucket 133 by feedback control based on the difference between the target ground angle of the bucket 133 and the actual ground angle of the bucket 133 identified from the measurement data acquired in step S6.

[0073] Next, the control unit 216 determines, based on the rotation speed of the rotating body 120, whether the rotation angle will reach the deflection angle of the unloading point p3 due to inertial rotation when the rotation operation signal is stopped (step S21). If the rotation angle does not reach the deflection angle of the unloading point p3 due to inertial rotation (step S21: NO), the control unit 216 generates a rotation operation signal (step S22). If the rotation angle reaches the deflection angle of the unloading point p3 due to inertial rotation (step S21: YES), the control unit 216 does not generate a rotation operation signal and instead sets a neutral signal. The control unit 216 outputs the generated operation signal for the work implement 130 and / or the rotation operation signal to the control valve 123 (step S23).

[0074] The control unit 216 determines whether the tip of the arm 132 has reached the unloading point p3 (step S24). If the tip of the arm 132 has not reached the unloading point p3 (step S24: NO), the control unit 216 returns to step S6 and continues the first swing control.

[0075] When the tip of the arm 132 reaches the discharge point p3 (step S24: YES), the control unit 216 generates an operation signal to rotate the bucket 133 in the dumping direction (step S25) and outputs it to the control valve 123 (step S26). Note that, in order to improve work efficiency, the control unit 216 may output an operation signal to rotate the bucket 133 in the dumping direction at a timing that is earlier than the timing at which the bucket 133 reaches a point a certain angle before the discharge point p3, and that is the response delay time from the discharge control command until the soil falls. When the loading operation onto the transport vehicle 300 is completed, the loading control device 200 executes the second swing control of the loading machine 100 ( FIG. 10 ).

[0076] The acquisition unit 211 acquires the measurement data of the loading machine 100 (step S27). The attitude identification unit 214 identifies the position of the tip of the arm 132 based on the measurement data (step S28).

[0077] The control unit 216 determines whether or not the swing angle of the loading machine 100 is greater than the deflection angle of the second interference avoidance point p2b determined in step S5 (step S29). The swing angle of the loading machine 100 at the start of the second swing is greater than the deflection angle of the second interference avoidance point p2b.

[0078] If the swing angle of the loading machine 100 is greater than the deflection angle of the second interference avoidance point p2b (step S29: YES), that is, if the swing unit 120 is facing the transport vehicle 300, the control unit 216 generates a swing operation signal for the swing unit 120 (step S30) and outputs the generated automatic operation signal to the control valve 123 (step S31). The loading control device 200 returns the process to step S27 and continues control.

[0079] On the other hand, if the rotation angle is less than the deflection angle of the second interference avoidance point p2b (step S29: NO), that is, if the rotating body 120 is facing outward from the transport vehicle 300, the control unit 216 determines whether the difference between the radius and height of the tip of the arm 132 identified in step S28 when expressed in a polar coordinate system and the radius and height of the starting point p1 is smaller than a predetermined threshold value (step S32).

[0080] If the difference between the radius vector and the height of the tip of the arm 132 and the radius vector and the height of the start point p1 is equal to or greater than the threshold value (step S32: NO), the control unit 216 generates automatic operation signals for the boom 131 and the arm 132 so as to bring the height of the tip of the arm 132 closer to the height of the start point p1 (step S33). The control unit 216 also calculates the sum of the drive speeds of the boom 131 and the arm 132 based on the generated automatic operation signals for the boom 131 and the arm 132, and generates an automatic operation signal for driving the bucket 133 at a speed equal to the sum of the drive speeds (step S34). Note that in another embodiment, the control unit 216 may generate the automatic operation signal for the bucket 133 by feedback control based on the difference between the target ground angle of the bucket 133 (e.g., the ground angle of the bucket 133 at the start of the second swing) and the actual ground angle of the bucket 133 identified from the measurement data acquired in step S27.

[0081] Next, the control unit 216 determines, based on the rotation speed of the rotating unit 120, whether the rotation angle reaches the deflection angle of the start point p1 due to inertial rotation when the rotation operation signal is stopped (step S35). If the rotation angle does not reach the deflection angle of the start point p1 due to inertial rotation (step S35: NO), the control unit 216 generates a rotation operation signal (step S36). If the rotation angle reaches the deflection angle of the start point p1 due to inertial rotation (step S36: YES), the control unit 216 does not generate a rotation operation signal and instead sets a neutral signal. The control unit 216 outputs the generated operation signal for the work implement 130 and / or the rotation operation signal to the control valve 123 (step S37).

[0082] The control unit 216 determines whether the tip of the arm 132 has reached the start point p1 (step S38). Note that, in another embodiment, the posture of the work implement 130 at the end of the second swing may be a predetermined posture that makes it easier to start excavation. In this case, the control unit 216 determines whether the tip of the arm 132 has reached a point whose swing angle is expressed by the deflection angle at the start point p1 and the radius vector when the work implement 130 assumes the predetermined posture. If the tip of the arm 132 has not reached the start point p1 (step S38: NO), the loading control device 200 returns to step S27 and continues the second swing control. On the other hand, if the tip of the arm 132 has reached the start point p1 (step S38: YES), the loading control device 200 ends the automatic control.

[0083] Through the above-described automatic control, the loading machine 100 can automatically discharge the soil scooped up by the bucket 133 onto the transport vehicle 300. The operator repeatedly performs excavation by the work implement 130 and automatic control by inputting an automatic control instruction signal to the extent that the load capacity of the transport vehicle 300 does not exceed the maximum load capacity. Then, the operator operates the operation terminal 740 to input a departure instruction signal to the operation terminal 740. The departure instruction signal is transmitted from the operation terminal 740 to the control device 500. As a result, the control device 500 generates course information including the area of ​​the exit route R4. The transport vehicle 300 starts from the loading point P3, travels along the exit route R4, and exits the loading site A1.

[0084] <<Actions and Effects>> According to the first embodiment, the loading control device 200 automatically controls the revolving unit 120 and the work unit 130 so that the lowest point of the bucket 133 is at an intermediate target height that is higher than the haul vehicle 300 and lower than the unloading point p3 by the time the revolving unit 120 turns from the first direction to a second direction in which the work unit 130 does not interfere with the haul vehicle 300 in a plan view from above. Thereafter, the loading control device 200 controls the revolving unit 120 and the work unit 130 so that the lowest point of the bucket 133 is at the height of the unloading point p3 by the time the revolving unit 120 turns from the second direction to a third direction. Note that the direction related to the deflection angle of the start point p1 is an example of the first direction, the direction related to the deflection angle of the first interference avoidance point p2a is an example of the second direction, and the direction related to the deflection angle of the unloading point p3 is an example of the third direction. As a result, the loading control device 200 can reduce the time required for the revolving unit 120 to turn from the first direction to the second direction, thereby shortening the time required for automatic control.

[0085] Other Embodiments Although one embodiment has been described in detail above with reference to the drawings, the specific configuration is not limited to the above, and various design modifications are possible. That is, in other embodiments, the order of the above-described processes may be changed as appropriate. Furthermore, some processes may be executed in parallel.

[0086] The loading control device 200 according to the embodiment described above determines the start point p1, the interference avoidance point p2, and the earth unloading point p3, and controls the revolving unit 120 and the work machine 130 to pass through these points, but other embodiments are not limited to this. For example, in other embodiments, the loading control device 200 may include a trajectory generating unit that generates a trajectory that passes through the start point p1, the interference avoidance point p2, and the earth unloading point p3, and the control unit 216 may control the revolving unit 120 and the work machine 130 to follow the generated trajectory.

[0087] The loading machine 100 according to the embodiment described above acquires the position information and orientation information of the haulage vehicle 300 from the control device 500, but is not limited to this. For example, the loading machine 100 according to another embodiment includes a detection device that detects the spatial position of an object present in the detection direction, and acquires the position information and orientation information of the haulage vehicle 300 based on the detection result of the detection device. In this way, the loading machine 100 may acquire the position information and orientation information of the haulage vehicle 300 without relying on the control device 500.

[0088] In the above-described embodiment, the loading machine 100 is remotely controlled via the remote control device 800, but this is not limiting. For example, the loading machine 100 according to other embodiments may be operated by an operator on board. In this case, the loading control device 200 of the loading machine 100 controls the loading machine 100 by an operation signal from an operation device (not shown) provided in the driver's seat. The operator may output an automatic digging and loading instruction to the loading control device 200 by pressing an automatic digging and loading button (not shown) provided in the driver's seat. Furthermore, in other embodiments, the loading machine 100 may transmit and receive signals via vehicle-to-vehicle communication instead of communication via an access point.

[0089] The control device according to the above-described embodiment (for example, the loading control device 200) may be configured by a single computer, or may be configured by distributing the control device among multiple computers that cooperate with each other to function as a control device. In this case, some of the components of the control device may be realized by the loading control device 200, the control device 500, the remote control device 800, etc.

[0090] According to the above aspect, the control system for the loading machine can reduce the time required for automatic control.

[0091] DESCRIPTION OF SYMBOLS 1...Work system 100...Loading machine 110...Traveling body 111...Crawler 112...Travel motor 120...Swinging body 121...Engine 122...Hydraulic pump 123...Control valve 124...Swing motor 130...Work machine 131...Boom 131C...Boom cylinder 132...Arm 132C...Arm cylinder 133...Bucket 133C...Bucket cylinder 151...Position and orientation calculator 152...Inclination measuring device 153...Boom stroke sensor 154...Arm stroke sensor 155...Bucket stroke sensor 156...Imaging device 200...Loading control device 300...Transportation vehicle 310...Position and orientation detector 400...Transportation control device 500...Control device 510...Processor 511...Position and orientation collection unit 512...Travel course generation unit 520...Main memory 530...Storage 531: Travel route storage unit 532: Position and orientation storage unit 540: Interface 700: Remote driver's cab 710: Driver's seat 720: Display device 730: Operation device 740: Operation terminal 800: Remote control device 210: Processor 211: Acquisition unit 212: Display control unit 213: Operation signal input unit 214: Attitude identification unit 215: Control point determination unit 216: Control unit 220: Main memory 230: Storage 240: Interface

Claims

1. A control device for a loading machine having a rotating body that rotates around a rotation center, a support unit that supports the rotating body, and a work machine attached to the rotating body having a working implement, comprising: a control point determination unit that, when the working implement is moved by automatic control to a target point above a loading object, determines, as a control point for the automatic control, a control point that is lower than the height of the target point and in a direction such that the work machine does not interfere with the loading object in a planar view from above; and a control unit that, when the automatic control is started, controls the rotating body and the work machine via the control point.

2. The control system for a loading machine as described in claim 1, wherein, when the automatic control is started, the control unit controls the swivel body and the work machine so that the lowest point of the work tool is at the height of the control point by the time the swivel body turns from a first orientation in which it faces at the start of the automatic control to a second orientation in which it faces the control point, and controls the swivel body and the work machine so that the lowest point of the work tool is at the height of the target point by the time the swivel body turns from the second orientation to a third orientation in which it faces the target point.

3. A control system for a loading machine as described in claim 1, wherein the work implement is rotatably mounted on the tip of the working machine around a rotation axis, the control unit controls the rotating body and the working machine so that the position of the rotation axis of the working machine moves to the target point via the control point, and the height of the target point is higher than the height of the loading object plus the length from the rotation axis to the farthest point.

4. A control system for a loading machine as described in claim 3, wherein the height of the target point is a height obtained by adding the height of the loading object, the length to the point of the work tool that is farthest from the rotation axis, and a predetermined margin value.

5. A control system for a loading machine according to claim 1, wherein the height of the control point is higher than the height of the loading target plus the height of the implement when it is in a position to hold a load.

6. A control system for a loading machine as described in claim 1, further comprising an acquisition unit that acquires measurement data indicating a position and attitude of the loading target, and the control point determination unit comprises a determination unit that determines the control point based on the measurement data.

7. A control system for a loading machine as described in claim 1, further comprising a trajectory generating unit that generates a trajectory passing through the control point and the target point, and the control unit controls the rotating body and the work implement so that the work implement moves according to the trajectory.

8. A control method for a loading machine including a rotating body that rotates around a rotation center, a support part that supports the rotating body, and a work machine attached to the rotating body having a working implement, comprising: when the work machine is moved by automatic control to a target point above a loading object, a step of determining, as a control point for the automatic control, a control point that is lower than the height of the target point and in an orientation where the work machine does not interfere with the loading object in a planar view from above; and when the automatic control is started, a step of controlling the rotating body and the work machine via the control point.

9. A remote control system for a loading machine, comprising: a control system for a loading machine according to any one of claims 1 to 7; and a display device and an operating device provided remotely from the control system for the loading machine.

Images