JP2025034983A - Control system for loading machine, control method for loading machine, and remote operation system for loading machine - Google Patents

Abstract

To reduce the time required for automatic control.SOLUTION: A control unit, when determining to start automatic control, controls a rotating body and a work machine so that the lowest point of a work tool is at an intermediate target height that is higher than a loading object and lower than a target point from a first orientation where the rotating body faces a starting point to a second orientation where the work machine does not interfere with the loading target when viewed from above. The control unit controls the rotating 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 when the rotating body moves from the second orientation to a third orientation facing the target.SELECTED DRAWING: Figure 6

Description

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.

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 the unloading 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 unloading point, is the same distance from the rotation center of the rotating body as the distance from the rotation center to the unloading point, and has no loading target below.

JP 2022-079773 A

Incidentally, when a loading machine has a clam bucket, by opening the clam, the bucket unloads the load while holding it in place. On the other hand, when unloading the load by rotating the bucket, the height of the lowest point of the bucket 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 loading target, which may result in a long time required for turning.
An object of the present disclosure is to provide a control system for a loading machine, a control method for a loading machine, and a remote operation system for a loading machine that can shorten the time required for automatic control.

According to one aspect of the present invention, the 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 tool attached to the rotating body, and includes a control point determination unit that determines, as a control point for the automatic control when the work tool is moved to a target point above a loading object by automatic control, a control point that is lower than the height of the target point and in a direction in which the work machine does not interfere with the loading object in a planar view from above, and a control unit that controls the rotating body and the work machine via the control point when the automatic control is started.

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

1 is a schematic diagram showing a configuration of a remote control system according to a first embodiment. 1 is a schematic diagram showing a configuration of a loading machine according to a first embodiment. FIG. FIG. 2 is a schematic block diagram showing the configuration of a control device according to the first embodiment. FIG. 2 is a diagram illustrating an example of a travel route according to the first embodiment. 1 is a schematic block diagram showing a configuration of a control device for a loading machine according to a first embodiment. FIG. 5A to 5C are diagrams illustrating an example of a movement of the loading machine in a first turning according to the first embodiment. 11A to 11C are diagrams illustrating an example of a movement of the loading machine in a second turning according to the first embodiment. 4 is a flowchart (part 1) showing an automatic control method for a work system according to the first embodiment. 4 is a flowchart (part 2) showing the automatic control method of the work system according to the first embodiment. 11 is a flowchart (part 3) showing the automatic control method of the work system according to the first embodiment.

First Embodiment
<Work System>
FIG. 1 is a schematic diagram showing the configuration of a remote control system according to the 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, a quarry). The remote operator's cab 700 is provided at a location away from the work site (e.g., in a city, within the work site).

The loading machine 100 operates at a construction site, excavates a construction target such as soil and sand, and loads the soil as cargo onto the bed of a 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 operated based on an operation signal transmitted from the 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 accepts an operation of the loading machine 100 by an operator, and the remote control device 800 transmits an 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. In other words, the work system 1 includes a remote operation system composed of the loading machine 100 and the remote operator's cab 700. The access point AP1 is used for communication of the remote operation system.

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

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 the 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 entry instruction signal and a departure instruction signal. The entry instruction signal is a signal that instructs the transport vehicle 300 to enter from the waiting point P1 to the loading point P3. The departure instruction signal is a signal that instructs the transport vehicle 300 to leave the loading point P3 and exit the loading site A1 upon completion of loading.

Transport Vehicle
The transport vehicle 300 according to the first embodiment is an unmanned dump truck that travels unmanned along a set travel route. Note that the transport vehicle 300 according to other embodiments may be a transport vehicle other than a dump truck.
The transportation vehicle 300 is equipped with a position and orientation detector 310 and a transportation control device 400 .

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

The transportation control device 400 transmits the position and orientation detected by the position and orientation 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 drives the transportation vehicle 300 or raises and lowers the vessel of the transportation vehicle 300 based on the received course information and instruction signals.

"Loading Machine 100"
FIG. 2 is a schematic diagram showing the configuration of the loading machine 100 according to the first embodiment.
The loading machine 100 includes a running body 110, a rotating body 120, and a work machine 130.

The running body 110 supports the loading machine 100 so that the loading machine 100 can travel. The running body 110 includes two endless tracks 111 provided on the left and right sides, and two travel motors 112 for driving each of the endless tracks 111. The running body 110 is an example of a support portion.
The rotating body 120 is supported by the running body 110 so as to be capable of rotating about a rotation center.
The work machine 130 is hydraulically driven and supported on the front part of the revolving body 120 so as to be drivable in the vertical direction.
Here, the part of the rotating body 120 to which the work machine 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 left part as the left part, and the right part as the right part.

The rotating body 120 is equipped with an engine 121, a hydraulic pump 122, a control valve 123, and a rotating 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 driven by the engine 121. The hydraulic pump 122 supplies hydraulic oil via a control valve 123 to each actuator (the boom cylinder 131C, the arm cylinder 132C, the bucket cylinder 133C, the travel motor 112, and the swing motor 124).
The control valve 123 controls the flow rate of the hydraulic oil supplied from the hydraulic pump 122 .
The swing motor 124 is driven by hydraulic oil supplied from a hydraulic pump 122 via a control valve 123 to swing the swing body 120 .

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

The base end of the boom 131 is rotatably attached to the revolving body 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 body 120, but the present invention is not limited to this and the boom 131 may be attached offset in the left-right direction. In this case, the center of rotation of the revolving body 120 is not located on the operating plane of the work machine 130.
The arm 132 connects the boom 131 and the bucket 133. A base end of the arm 132 is rotatably attached to a tip end of the boom 131 via an arm pin.
The bucket 133 is rotatably attached to the tip of the arm 132 via a pin.
Members for supporting the bucket 133 include a boom 131 and an arm 132. The bucket 133 functions as a container for storing excavated soil and sand. The bucket 133 is attached so that its opening faces the rotating body 120 (rear). In other words, the loading machine 100, which is a backhoe excavator, performs excavation by pulling the bucket 133 to the front side of the rotating body 120.

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 rotating body 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.

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.

The position and orientation calculator 151 calculates the position of the rotating body 120 and the orientation in which the rotating body 120 faces. The position and orientation calculator 151 includes two receivers that receive positioning signals from artificial satellites that constitute the GNSS. The two receivers are installed at different positions on the rotating body 120. The position and orientation calculator 151 detects the position of a representative point of the rotating body 120 in the 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 of the rotating body 120 as the relationship between the installation position of one receiver and the installation position of the other receiver. The orientation of the rotating body 120 is a direction perpendicular to the front of the rotating body 120. The orientation of the rotating body 120 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 machine 130.

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

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 a relative angle of the boom 131 with respect to the rotating body 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 a 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 a relative angle of the bucket 133 with respect to the arm 132.
The loading machine 100 according to the first embodiment specifies the angle of each link component of the work machine 130 using the boom stroke sensor 153, the arm stroke sensor 154, and the bucket stroke sensor 155, but other embodiments are not limited to this. For example, in other embodiments, instead of the stroke sensor, a potentiometer that detects the relative rotation angle of the link component may be provided, or an inclination sensor that detects the ground angle of each link component may be provided.

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 can capture an image of at least the work target and the work machine 130.

The loading control device 200 transmits to the remote operator's cab 700 the image captured by the imaging device 156, the rotation speed, position, and orientation of the rotating body 120, the traveling speed of the traveling body 110, the attitude of the rotating body 120, and the tilt angles of the boom 131, the arm 132, and the bucket 133. Note that the measurement data according to other embodiments is not limited to this. For example, the measurement data according to other embodiments may not include any of the rotation speed, position, orientation, tilt angle, traveling speed, and attitude, may include values measured by other sensors, or may include values calculated from measured values.
The loading control device 200 receives an operation signal from the remote operator's cab 700. The loading control device 200 drives the traveling body 110, the rotating body 120, or the work machine 130 based on the received operation signal.

Control Device
FIG. 3 is a schematic block diagram showing the configuration of the control device according to the first embodiment.
The control device 500 manages the traveling of the transport 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 out 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 transport vehicle 300 via the access point AP2.

Storage 530 has storage areas as a driving route memory unit 531 and a position/orientation memory unit 532. Examples of storage 530 include HDDs (Hard Disk Drives), SSDs (Solid State Drives), magnetic disks, magneto-optical disks, CD-ROMs (Compact Disc Read Only Memory), DVD-ROMs (Digital Versatile Disc Read Only Memory), and semiconductor memories. Storage 530 may be an internal medium directly connected to the common communication line of control device 500, or an external medium connected to control device 500 via interface 540. Storage 530 is a non-transitory tangible storage medium.

The travel route memory 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 connection route R1 connecting two areas A (for example, a loading site A1 and an unloading site A2), as well as an entry route R2, an approach route R3, and an exit route R4, which are routes within the area A. The entry route R2 is a route that connects a waiting point P1, which is one end of the connection route R1, to a predetermined turning point P2 within the area A. The approach route R3 is a route that connects the turning point P2 to a loading point P3 or a discharge land point P4 within the area A. The exit route R4 is a route that connects a loading point P3 or a discharge land point P4 within the area A to an exit point P5, which is the other end of the connection route R1. The loading point P3 is a point that is set by the operation of the operator of the loading machine 100. The turning point P2 is a point set by the control device 500 according to the position of the loading point P3.

The position and orientation memory unit 532 stores the position information and orientation information of each transport vehicle 300.

The processor 510, by executing the control program, is equipped with a position and orientation collection unit 511 and a driving course generation unit 512.

The position and orientation collection unit 511 receives position information and orientation information of the transport vehicle 300 from the transport 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.

The driving course generation unit 512 generates course information including information on the area in which the transport vehicle 300 is permitted to move, based on the driving route stored in the driving route memory unit 531 and the position information and orientation information stored in the position orientation memory 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 driving route, target speed information at those points, and permitted driving area information that does not overlap with the permitted driving areas of other transport vehicles 300.

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 an approach instruction signal is received from the remote cab 700. As a result, the transport vehicle 300 waits at the waiting point P1 until the approach instruction signal is received. When the travel course generation unit 512 receives an approach instruction signal, it generates course information including the approach route R2 and the approach route R3 and not including the exit route R4. As a result, the transport 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 a departure instruction signal, it generates course information including the exit route R4. In the work system 1 according to this embodiment, the transport vehicle 300 waits at the waiting point P1 until it receives an approach instruction signal, but this is not limited to this. For example, in another embodiment, the position where the transport vehicle 300 waits may be the turning point P2, or may be a point on the way of the approach route R2 or the approach route R3.

Remote Control Cabin
The remote operator's cab 700 includes a operator'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 a plurality of displays arranged in a row as shown in Fig. 1, or may be configured with one large display. The display device 720 may also be one that projects an image onto a curved or spherical surface by a projector or the like.

The operation device 730 is an operation device for the remote operation system. In response to the operation of the operator, the operation device 730 generates operation signals for the boom cylinder 131C, the arm cylinder 132C, the bucket cylinder 133C, the left and right rotation operation signals for the rotating body 120, and the travel operation signals for forward and backward movement of the traveling body 110, and outputs them 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.

The automatic control is that the loading machine 100 autonomously controls the driving of the work machine 130 and the rotating body 120 to realize a predetermined operation. The automatic control in the first embodiment is a control in which the loading machine 100 autonomously performs a first rotation (FIG. 6) which is a series of operations in which the bucket 133 is located outside the transport vehicle 300 due to excavation of the excavation target and rotates 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 the load onto the transport vehicle 300, and a second rotation (FIG. 7) which is a series of operations in which the bucket 133 is located above the transport vehicle 300 due to the loading operation and rotates to a predetermined direction while lowering the boom 131 to move it to the outside of the transport vehicle 300. 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 this 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 in the first rotation and raised in the second rotation. Note that the 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 machine 130 during the first and second rotations so that the transport vehicle 300 and the work machine 130 do not come into contact with each other. Details of the automatic control will be described later.

The operation terminal 740, when operated by an operator, transmits a departure instruction signal to the control device 500. 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 disposed 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 he or she sits in the driver's seat 710 .

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 operating device 730 to the loading machine 100.

"Control device for loading machine 100"
FIG. 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 in 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.

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 the loading control device 200, or an external medium connected to the loading control device 200 via the interface 240. Storage 230 is a non-transitory tangible storage medium.

By executing the loading control program, the processor 210 is provided with an acquisition unit 211, a display control unit 212, an operation signal input unit 213, an attitude identification unit 214, a control point determination unit 215, and a control unit 216.

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.

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.

The operation signal input unit 213 accepts 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 rotating body 120, a travel operation signal for the travel body 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 decides to implement automatic control. In other words, the operation signal input unit 213 is an example of an automatic control determination unit that determines whether or not to start automatic control.

The attitude identifying unit 214 identifies the attitude of the loading machine 100 based on the measurement data received by the acquiring unit 211. Specifically, the attitude 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 inclination 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.

The control point determination unit 215 determines a plurality of control points related to automatic control when an automatic control instruction signal is input to the operation signal input unit 213. The control points may be expressed in a polar coordinate system based on the attitude of the revolving body 120 when the automatic control instruction signal is input. In other words, the position of the control point is expressed by the deviation angle from the direction in which the revolving body 120 faces when the automatic control instruction signal is input, the radius vector which is the distance from the center of rotation of the revolving body 120, and the height. The control point determination unit 215 determines the positions of the start point p1, the first interference avoidance point p2a, the second interference avoidance point p2b, and the earth removal point p3 as control points. The start point p1 is the target point of the tip of the arm 132 in the second rotation. The first interference avoidance point p2a is a control point for controlling the work machine 130 and the transport vehicle 300 not to come into contact with each other in the first rotation. The second interference avoidance point p2b is a control point for controlling the work machine 130 and the transport vehicle 300 to avoid contact during the second rotation. The earth removal point p3 is the target point of the tip of the arm 132 during the first rotation.

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 starting point p1.

The control point determination unit 215 identifies the position of the discharge point p3 based on the measurement data of the position and orientation of the transport vehicle 300 acquired by the acquisition unit 211. The discharge point p3 is a point located at the center of the vessel of the transport vehicle 300 in a plan view from above. The height of the discharge point p3 is the height of the transport vehicle 300 plus the length from the pin of the bucket 133 to the furthest point of the bucket 133 and the first margin. The length from the pin of the bucket 133 to the furthest point of the bucket 133 is, for example, the length from the pin of the bucket 133 to the blade tip of the bucket 133. The first margin is a constant that is set so that the load loaded on the transport vehicle 300 does not interfere with the bucket 133. The first margin may be a value that is predetermined according to the model of the transport vehicle 300.

The control point determination unit 215 determines 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 transport vehicle 300 acquired by the acquisition unit 211. The interference avoidance point p2 is a position whose distance from the center of rotation of the rotating body 120 is equal to the distance from the center of rotation to the earth discharge point p3, and below which the transport vehicle 300 does not exist. For example, the control point determination unit 215 determines a circle related to the radius of the earth discharge point p3, and determines the angle of the interference avoidance points p2a and p2b on the circle at which the outline of the bucket 133 does not interfere with the transport vehicle 300 in a plan view and is closest to the deviation angle of the earth discharge point p3. The radius of the interference avoidance points p2a and p2b is equal to the radius of the earth discharge point p3. The control point determination unit 215 can determine whether the transport vehicle 300 and the bucket 133 interfere with each other based on the position, orientation, and known outer shape of the transport vehicle 300, and the known shape of the bucket 133. Here, "same height" and "equal distance" do not necessarily mean that the height or distance is completely the same, but rather allow for some error or margin. The height of the first interference avoidance point p2a is the height of the transport vehicle 300 plus the height of the bucket 133 when it is in a posture to hold a load, plus the second margin. The height of the bucket 133 when it is in a posture to hold a load is, for example, the length from the pin of the bucket 133 to the bottom surface of the bucket 133. The second margin is a constant that is set so that the transport vehicle 300 and the bucket 133 do not interfere with each other. The second margin may be a value smaller than the first margin. The height of the second interference avoidance point p2b may be the same as the height of the earth removal point p3.

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 signals input to the operation signal input unit 213 or the operation signals it generates, and outputs control signals to the control valve 123.

<<Automatic control operation>>
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 turning according to the first embodiment. Fig. 7 is a diagram showing an example of the movement of the loading machine 100 during a second turning according to the first embodiment.

When automatic control is started, the control unit 216 first causes the loading machine 100 to perform a first rotation. As shown in FIG. 6, the loading machine 100 first starts driving the work machine 130 (boom 131, arm 132, and bucket 133), and moves the bucket 133 upward by raising the boom 131. With a delay, the loading control device 200 starts rotating the rotating body 120. The loading control device 200 adjusts the rotation start timing so that the height of the tip of the arm 132 becomes the height of the first interference avoidance point p2 (the intermediate target height for the first rotation) and the distance from the rotation center to the tip of the arm 132 becomes equal to the distance of the first interference avoidance point p2 by the time the rotation angle of the rotating body 120 matches the first interference avoidance angle θ1 (the deflection angle of the first interference avoidance point p2a). In addition, if the height of the work implement 130 reaches the intermediate target height for the first rotation before the rotation angle of the rotating body 120 coincides with 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 rotation of the rotating body 120 will not cause the work implement 130 to come into contact with the transport vehicle 300. When the rotation angle of the rotating body 120 reaches the first interference avoidance angle θ1, the loading control device 200 drives the rotating body 120 and the work implement 130 so that the position of the tip of the arm 132 coincides with the soil discharge point p3.

When the tip of the arm 132 reaches the discharge point p3, the loading control device 200 rotates the bucket 133 in the dump direction. In order to improve work efficiency, the loading control device 200 may rotate the bucket 133 in the dump direction at a timing that is a response delay time from the discharge control command to the time the soil falls, rather than the timing at which the tip of the arm 132 reaches a point a certain angle before the discharge point p3. When a certain time has elapsed since the bucket 133 was rotated in the dump direction, the control unit 216 causes the loading machine 100 to perform a second rotation. As shown in FIG. 7, the loading control device 200 rotates the rotating body 120 without moving the work machine 130 until the rotation angle of the rotating body 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), and maintains the height of the lowest point of the bucket 133. When the rotation angle of the rotating body 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 part 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 working machine 130 at the end of the second rotation may not be the same as the posture at the start of the automatic control. In other words, in other embodiments, the position of the tip of the arm 132 may not be the same as the start point p1. For example, the posture of the working machine 130 at the end of the second rotation may be a posture that is determined in advance so that excavation can be easily started.

Note that, although Figures 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 body 120, 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 body 120.

<<Operation of the loading control device 200>>
The transport 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 specific 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 transport vehicle 300 travels along the approach route R3, and stops at the loading point P3. The operator scoops up soil and sand with the bucket 133 of the loading machine 100 by operating the operation device 730, and generates and outputs an automatic control instruction signal by operating the knob switch of the operation device 730.

Figure 8 is a flowchart (part 1) showing the automatic control method of the work system 1 according to the first embodiment. Figure 9 is a flowchart (part 2) showing the automatic control method of the work system 1 according to the first embodiment. Figure 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 automatic control instruction signal input from the remote control device 800 by the operator's operation, it executes the automatic control shown in Figures 8 to 10.

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/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 rotating body 120, the inclination angles of the boom 131, the arm 132, and the bucket 133, and the attitude of the rotating body 120. The acquisition unit 211 also acquires measurement data of the position and orientation of the transport vehicle 300 from the control device 500.

The posture identification unit 214 identifies the position of the tip of the arm 132 at the time when the automatic control instruction signal is input 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 starting point p1 (step S3).

The control point determination unit 215 determines the position of the discharge point p3 based on the position information and orientation information of the transport vehicle 300 acquired by the acquisition unit 211, and the known shape of the transport vehicle 300 (step S4). The control point determination unit 215 determines the planar position (deviation angle and radius) of the discharge point p3 based on the position information and orientation information of the transport vehicle 300, and the known shape of the transport vehicle 300. The control point determination unit 215 also determines the height of the discharge 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 transport vehicle 300.

The control point determination unit 215 determines the positions of the interference avoidance points p2a and p2b based on the position information and orientation information of the transport vehicle 300 acquired by the acquisition unit 211, the known shape of the transport vehicle 300, and the position of the earth discharge point p3 (step S5). The control point determination unit 215 determines the radius of the earth discharge point p3 as the radius of the interference avoidance points p2a and p2b. The control point determination unit 215 determines the deflection angle at which the outer shape of the bucket 133 does not interfere with the transport vehicle 300 in a plan view and is closest to the earth discharge point p3 as the deflection angle of the interference avoidance points p2a and p2b. The control point determination unit 215 determines the height of the first interference avoidance point p2a by adding the length from the pin to the bottom surface of the bucket 133 and the second margin to the known height of the transport vehicle 300. The control point determination unit 215 determines the height of the earth discharge point p3 as the height of the second interference avoidance point p2b.

The loading control device 200 first executes a first rotation control of the loading machine 100 (Figure 9). The acquisition unit 211 acquires the position and orientation of the rotating body 120, the inclination angles of the boom 131, arm 132 and bucket 133, and the attitude of the rotating body 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).

The control unit 216 determines whether the rotation 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 rotation angle of the loading machine 100 is the angle difference between the direction in which the rotating body 120 faces when the automatic control instruction signal is input (initial direction) and the direction in which the rotating body 120 is currently facing.

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), i.e., 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 S7 when expressed in a polar coordinate system and the radius and height of the first interference avoidance point p2a is smaller than a predetermined threshold value (step S9).

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 an automatic operation signal for the boom 131 and the arm 132 so as to move 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 signal based on the position and speed of the boom 131 and the arm 132 identified from the measurement data acquired in step S6.

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 of 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 the lowest point during the first rotation. Note that in other embodiments, the control unit 216 may generate an automatic operation signal for the bucket 133 by feedback control based on the difference between the target ground angle of the bucket 133 (for example, 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.

The control unit 216 determines whether the work machine 130 is rotating (step S12). For example, the control unit 216 determines that the work machine 130 is rotating when the rotation speed of the rotating body 120 is equal to or greater than a predetermined speed. If the work machine 130 is not rotating (step S12: NO), the control unit 216 calculates the completion time until the difference between the radius and height of the tip of the arm 132 and the radius and height of the first interference avoidance point p2a becomes equal based on the speed of the boom 131 and the arm 132 (step S13). In addition, the control unit 216 calculates the arrival time until the rotation angle reaches the deflection angle of the first interference avoidance point p2a identified in step S5 when the rotating body 120 starts rotating (step S14). The control unit 216 determines whether the completion time calculated in step S13 is less than the arrival time calculated in step S14 (step S15). In other words, 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.

If the completion time is equal to or longer than the arrival time (step S15: NO), that is, if the radius vector and height of the tip of the arm 132 do not match the radius vector and height of the first interference avoidance point p2a before the rotation angle reaches the deflection angle of the first interference avoidance point p2a, the control unit 216 does not generate a rotation operation signal for the rotating body 120. On the other hand, if the completion time is shorter than the arrival time (step S15: YES), that is, if 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 before the rotation angle reaches the deflection angle of the first interference avoidance point p2a, the control unit 216 generates a rotation operation signal for the rotating body 120 (step S16). This allows the loading control device 200 to prevent the working machine 130 from contacting the transport vehicle 300 due to the working machine 130 rotating at a low height. In addition, since the height of the first interference avoidance point p2a is lower than the height of the earth removal point p3, the time during which only the working machine 130 is driven without rotating during the first rotation can be shortened.

The control unit 216 outputs the generated automatic operation signal to the control valve 123 (step S17). This drives the loading machine 100. The loading control device 200 then returns the process to step S6 and continues control.

On the other hand, if it is determined in step S12 that the work machine 130 is rotating (step S12: YES), the control unit 216 generates a rotation operation signal in step S16 and outputs the rotation operation signal to the control valve 123 in step S17. The loading control device 200 then returns the process to step S6 and continues control.

On the other hand, if the rotation angle is equal to or greater than the deflection angle of the first interference avoidance point p2a (step S8: NO), i.e., 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 earth removal point p3 is smaller than a predetermined threshold value (step S18).

If the difference between the height of the tip of the arm 132 and the height of the earth discharge point p3 is equal to or greater than the threshold (step S18: NO), the control unit 216 generates an automatic operation signal 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 discharge 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 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 and the actual ground angle of the bucket 133 identified from the measurement data acquired in step S6.

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

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 rotation control.

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 dump 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 dump direction at a timing that is a response delay time from the discharge control command until the soil falls, before the timing of reaching a point a certain angle before the discharge point p3. When the loading operation onto the transport vehicle 300 is completed, the loading control device 200 executes the second rotation control of the loading machine 100 (Figure 10).

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

The control unit 216 determines whether the rotation 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 rotation angle of the loading machine 100 at the start of the second rotation is greater than the deflection angle of the second interference avoidance point p2b.

If the rotation 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 rotating body 120 is facing the transport vehicle 300, the control unit 216 generates a rotation operation signal for the rotating body 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.

On the other hand, if the rotation angle is equal to or 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).

If the difference between the radius vector and height of the tip of the arm 132 and the radius vector and height of the start point p1 is equal to or greater than the threshold (step S32: NO), the control unit 216 generates an automatic operation signal 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 the same speed as the sum of the drive speeds (step S34). Note that in other embodiments, the control unit 216 may generate an automatic operation signal for the bucket 133 by feedback control based on the difference between the target ground angle of the bucket 133 (for example, the ground angle of the bucket 133 at the start of the second rotation) and the actual ground angle of the bucket 133 identified from the measurement data acquired in step S27.

Next, the control unit 216 determines whether the rotation angle reaches the deflection angle of the start point p1 due to inertial rotation when the rotation operation signal is stopped based on the rotation speed of the rotating body 120 (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 sets it to a neutral signal. The control unit 216 outputs the generated operation signal of the work machine 130 and/or the rotation operation signal to the control valve 123 (step S37).

The control unit 216 determines whether the tip of the arm 132 has reached the start point p1 (step S38). In another embodiment, the posture of the work machine 130 at the end of the second rotation may be a predetermined posture that makes it easy to start excavation. In this case, the control unit 216 determines whether the tip of the arm 132 has reached a point whose rotation angle is represented by the deflection angle of the start point p1 and the radius vector when the work machine 130 takes 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 the process to step S27 and continues the second rotation 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.

By the above-mentioned 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 executes excavation by the work machine 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.

<Action and Effects>
According to the first embodiment, the loading control device 200 automatically controls the rotating body 120 and the working machine 130 so that the lowest point of the bucket 133 is at an intermediate target height that is higher than the transport vehicle 300 and lower than the unloading point p3 by the time the rotating body 120 turns from the first direction to the second direction in which the working machine 130 does not interfere with the transport vehicle 300 in a plan view from above. Thereafter, the loading control device 200 controls the rotating body 120 and the working machine 130 so that the lowest point of the bucket 133 is at the height of the unloading point p3 by the time the rotating body 120 turns from the second direction to the third direction. Note that the orientation related to the deflection angle of the start point p1 is an example of the first direction, the orientation related to the deflection angle of the first interference avoidance point p2a is an example of the second direction, and the orientation 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 rotating body 120 to turn from the first direction to the second direction, thereby shortening the time required for automatic control.

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 changes are possible. That is, in other embodiments, the order of the above-mentioned processes may be changed as appropriate. Also, some of the processes may be executed in parallel.

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

The loading machine 100 according to the embodiment described above acquires the position information and orientation information of the transport vehicle 300 from the control device 500, but is not limited to this. For example, the loading machine 100 according to another embodiment is equipped with 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 transport 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 transport vehicle 300 without relying on the control device 500.

In the above-described embodiment, the loading machine 100 is remotely controlled via the remote control device 800, but this is not limited thereto. 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 of 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. In other embodiments, the loading machine 100 may transmit and receive signals by vehicle-to-vehicle communication instead of communication via an access point.

The control device according to the above-described embodiment (e.g., the loading control device 200) may be configured by a single computer, or the configuration of the control device may be divided and arranged among multiple computers, and the multiple computers may function as a control device by working together. In this case, part of the configuration of the control device may be realized by the loading control device 200, the control device 500, the remote control device 800, etc.

1...Work system 100...Loading machine 110...Traveling body 111...Crawler track 112...Traveling motor 120...Rotating body 121...Engine 122...Hydraulic pump 123...Control valve 124...Rotating motor 130...Working 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 memory unit 532: Position and orientation memory 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 (9)

A control device for a loading machine including a rotating body that rotates around a rotation center, a support part that supports the rotating body, and a working machine attached to the rotating body that has a working tool,
a control point determination unit that, when moving the working tool to a target point above a loading target by automatic control, determines, as a control point related to the automatic control, a control point that is lower than the height of the target point and has a direction in which the working tool does not interfere with the loading target in a plan view from above;
a control unit that controls the rotating body and the work machine via the control point when the automatic control is started;
Equipped with
Loading machine control system. When the automatic control is started, the control unit controls the rotating body and the work machine so that the lowest point of the work tool is at a height of the control point by the time the rotating body turns from a first direction in which the automatic control is started to a second direction in which the control point is turned, and controls the rotating body and the work machine so that the lowest point of the work tool is at a height of the target point by the time the rotating body turns from the second direction to a third direction in which the target point is turned.
A control system for a loading machine according to claim 1. The working tool is provided at the tip of the working machine so as to be rotatable around a rotation axis,
the control unit controls the rotating body and the work machine so that a position of the rotation axis of the work machine moves to the target point via the control point,
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,
A control system for a loading machine according to claim 1. The height of the target point is a height obtained by adding the height of the loading object, the length of the work tool to the point farthest from the rotation axis, and a predetermined margin value.
A control system for a loading machine according to claim 3. The height of the control point is higher than the height of the loading target plus the height of the work tool when the load is held.
A control system for a loading machine according to claim 1. An acquisition unit that acquires measurement data indicating a position and an attitude of the loading object,
The control point determination unit includes a determination unit that determines the control points based on the measurement data;
Equipped with
A control system for a loading machine according to claim 1. a trajectory generating unit that generates a trajectory that passes through the control points and the target points;
The control unit controls the rotating body and the work machine so that the work tool moves according to the trajectory.
A control system for a loading machine according to claim 1. 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 working machine attached to the rotating body having a working tool, comprising:
When the working tool is moved to a target point above the loading target by automatic control, a control point related to the automatic control is determined to be lower than the height of the target point and in a direction in which the working tool does not interfere with the loading target in a plan view from above;
When the automatic control is started, controlling the rotating body and the work machine via the control point;
Equipped with
A method for controlling a loading machine. A control system for a loading machine according to any one of claims 1 to 7;
A display device and an operation device provided remotely from the control system of the loading machine;
Equipped with
Remote control system for loading machines.

Images