Automatic driving control device, construction machinery, automatic driving control system, automatic driving control method and automatic driving control program

By setting the basic speed and correction values, the problem of speed variation in construction machinery during automatic driving was solved, achieving more stable motion control.

CN123076704APending Publication Date: 2026-11-10KOBELCO CONSTR MASCH CO LTD
View PDF 1 Cites 0 Cited by

Patent Information

Application Number
CN202580026008.1
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2024-04-04
Filing Date
2025-03-27
Publication Date
2026-11-10

AI Technical Summary

Technical Problem

In the automatic driving of construction machinery, the speed of movement before and after switching target positions is prone to change, resulting in unstable operation volume and movement speed.

Method used

By setting the basic speed of multiple movable parts, obtaining the actual posture value, calculating the ideal posture value and the correction value, and outputting the corresponding operation amount to correct the basic speed, precise control of multiple movable parts is achieved.

Benefits of technology

This reduces the speed variation of construction machinery before and after switching target positions, improving the stability and precision of the operation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN123076704A_ABST
    Figure CN123076704A_ABST
Patent Text Reader

Abstract

The automatic driving control device (50) includes a controller (51) that controls the movement of multiple movable parts of the construction machinery (100) based on multiple target positions (P1 to Pn). The controller (51) sets the basic speed (rv) of each of the multiple movable parts, obtains the actual posture value (yp) of each of the multiple movable parts, calculates the ideal posture value (rp) of each of the multiple movable parts using the basic speed (rv), calculates the correction value (uc(t)) for correcting the basic speed (rv) of each of the multiple movable parts using the difference (e(t)) between the ideal posture value (rp) and the actual posture value (yp), and outputs the operation quantity (u(t)) corresponding to the value obtained by correcting the basic speed (rv) of each of the multiple movable parts using the correction value (uc(t)) to the controlled object (9).
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] This disclosure relates to technologies for automatic driving of construction machinery. Background Technology

[0002] Patent Document 1 discloses an automated excavator consisting of a hydraulic excavator and an automated driving controller. The automated driving controller is installed in the hydraulic excavator, causing it to reproduce guided actions from digging cycles to unloading. In this automated excavator, when the automated driving controller determines that the hydraulic excavator has reached a predetermined positioning range, it outputs the next guided position as the target position. The servo control unit of the automated driving controller performs general feedback control based on the current position data calculated by the current position calculation unit and the angle target value output from the servo preprocessing unit, outputting a drive current for driving the proportional solenoid valve. This controls the valve to supply a predetermined pressure of hydraulic oil to the actuator, driving each joint of the automated excavator body. As in Patent Document 1… Figure 5 As shown, in the guidance position storage unit, target values ​​of the postures of the slewing body, boom, stick, and bucket are stored for guidance positions P1 to Pn, namely the slewing body angle, boom angle, stick angle, and bucket angle.

[0003] When performing general feedback control in the aforementioned automated driving system, the following problems arise. Specifically, if the bucket tip approaches the guide position, the difference between the actual angle of the movable parts, such as the boom, and the target angle of those movable parts decreases. Consequently, the input quantity to the controlled object, such as the proportional solenoid valve, in the feedback control also decreases, and the operating speed of the construction machinery (the operating speed of the slewing body, boom, stick, bucket, etc.) also decreases. On the other hand, if the target position changes to the next guide position, the difference between the actual angle of the movable parts and the target angle increases. Therefore, the input quantity to the controlled object in the feedback control also increases, and the operating speed of the construction machinery also increases. In this situation, the operating speed of the construction machinery is prone to fluctuating before and after switching between the guide position (target position).

[0004] Existing technical documents Patent documents Patent Document 1: Japanese Patent Publication No. 11-264155. Summary of the Invention

[0005] The purpose of this disclosure is to provide a technology that can reduce the change in the speed of construction machinery before and after changing the target position in the automatic driving of construction machinery.

[0006] The provided automatic driving control device includes a controller that controls the movement of multiple movable parts of the construction machinery based on multiple target positions set for automatic driving of the construction machinery. The controller sets a basic speed for each of the multiple movable parts, obtains actual posture values ​​related to the actual postures of each of the multiple movable parts, calculates ideal posture values ​​related to the ideal postures of each of the multiple movable parts using the basic speeds, calculates correction values ​​for correcting the basic speeds of each of the multiple movable parts using the difference between the ideal posture values ​​and the actual posture values, and outputs an operation quantity corresponding to the value obtained by correcting the basic speeds of each of the multiple movable parts using the correction values ​​to the controlled object in the automatic driving. Attached Figure Description

[0007] Figure 1 This is a diagram illustrating an autonomous driving control system including an autonomous driving control device according to an embodiment.

[0008] Figure 2 This is a block diagram illustrating an example of the relationship between inputs and outputs in the aforementioned autonomous driving control system.

[0009] Figure 3 This is a block diagram illustrating an example of the relationship between inputs and outputs in the aforementioned autonomous driving control system.

[0010] Figure 4 It is a diagram showing the multiple parameters set for the multiple target locations respectively.

[0011] Figure 5 This is a flowchart illustrating an example of the computational processing performed by the controller of the aforementioned automatic driving control device.

[0012] Figure 6 This is a diagram illustrating the method for setting the basic speed in the aforementioned automatic driving control system.

[0013] Figure 7 This is a diagram illustrating the calculation method for the ideal posture value in the aforementioned automatic driving control system.

[0014] Figure 8 This is a block diagram illustrating an example of the relationship between inputs and outputs in an automatic driving control system according to a variation of the implementation method 1.

[0015] Figure 9 This is a diagram showing the multiple parameters set for the multiple target positions in Variation 1.

[0016] Figure 10 This is a flowchart illustrating an example of the computational processing performed by the controller of the automatic driving control device involved in Variation Example 1.

[0017] Figure 11 This is a block diagram illustrating an example of the relationship between inputs and outputs in an automated driving control system according to Variation 2 of the implementation method.

[0018] Figure 12 This is a flowchart illustrating an example of the computational processing performed by the controller of the automatic driving control device involved in Variation Example 3.

[0019] Figure 13 This is a diagram used to illustrate the computational processing of variation example 3.

[0020] Figure 14 This is a diagram used to illustrate the computational processing of variation example 3.

[0021] Figure 15 This is a diagram used to illustrate the computational processing of variation example 3. Detailed Implementation

[0022] The embodiments of this disclosure are described with reference to the accompanying drawings. Figure 1 This is a diagram illustrating the automatic driving control system 300 including the automatic driving control device 50 according to this embodiment.

[0023] The automatic driving control device 50 is a device used for the automatic driving of the construction machinery 100. Figure 1 In the specific example shown, the automatic driving control system 300 includes construction machinery 100 and external equipment 200, with the construction machinery 100 equipped with an automatic driving control device 50. However, the external equipment 200 may also be equipped with the automatic driving control device 50. Alternatively, the construction machinery 100 may have a portion of the functions of the automatic driving control device 50, and the external equipment 200 may have another portion of the functions of the automatic driving control device 50.

[0024] like Figure 1 As shown, the construction machinery 100 includes: a lower traveling body 1, including a traveling device; an upper rotating body 2, supported on the lower traveling body 1 in a manner capable of rotating relative to the lower traveling body 1 about a vertically extending rotating axis SA; and a working device 3, supported on the upper rotating body 2. Although the construction machinery 100 involved in this embodiment is a hydraulic excavator, the construction machinery in this disclosure is not limited to hydraulic excavators, and may also be other construction machinery such as cranes and bulldozers. The traveling device may be... Figure 1 The tracked traveling device shown can also be a tire-equipped traveling device (not shown). The upper slewing body 2 includes a slewing frame that is rotatably supported on the lower traveling body 1, and a driver's cab supported on the slewing frame. The driver's cab houses various components such as a driver's seat and operating devices.

[0025] The working device 3 includes a boom 4 that is undulatingly mounted on the upper rotating body 2, a stick 5 that is rotatably mounted on the boom 4, and a distal attachment 6 that is rotatably mounted on the stick 5. Although the distal attachment 6 in this embodiment is a bucket 6, the distal attachment 6 may also be other distal attachments such as a grab bucket, forks, a crusher, or a lifting magnet.

[0026] Construction machinery 100 includes multiple actuators and a hydraulic pump 7. Each actuator operates by receiving a supply of working oil from the hydraulic pump 7. The actuators include a hydraulic cylinder for raising and lowering the boom 4 (boom cylinder 11), a hydraulic cylinder for rotating the stick 5 (stick cylinder 12), a hydraulic cylinder for rotating the remote attachment 6 (remote attachment cylinder 13), and a hydraulic motor for rotating the upper slewing body 2 relative to the lower traveling body 1 (slewing motor 14). The hydraulic pump 7 is driven by a power source (not shown). This power source may be, for example, an engine or an electric motor. The electric motor may also be driven by, for example, at least one of a fuel cell and a battery.

[0027] Figure 2 and Figure 3 Each is a block diagram illustrating an example of the relationship between inputs and outputs in an automatic driving control system 300. Figure 2 This is a block diagram illustrating the case where the controlled object 9 includes the hydraulic working cylinder or a component that moves with the movement of the hydraulic working cylinder. Figure 3 This is a block diagram of the case where the controlled object 9 includes a rotary motor 14 or a component that operates with the operation of the rotary motor 14.

[0028] like Figure 2 and Figure 3 As shown, the construction machinery 100 includes a control object 9, which is controlled by an automatic driving control device 50 (specifically, a controller 51 described later) during the automatic driving of the construction machinery 100. The output of the control object 9 (e.g., the actual posture value yp(t) described later) varies according to the operation amount u(t) input from the controller 51. The control object 9 may also include, for example, a flow regulator 8 and at least one of the plurality of actuators. The flow regulator 8 adjusts the direction and flow rate of the working oil supplied to at least one of the plurality of actuators according to the operation amount u(t) input from the controller 51. That is, after the controller 51 inputs the operation amount u(t) to the flow regulator 8, the flow regulator 8 operates according to the operation amount u(t) input from the controller 51, thereby supplying working oil from the hydraulic pump 7 to at least one of the plurality of actuators, which then operates. The output of the actuator (e.g., the actual posture value yp(t)) is detected by a posture detector described later.

[0029] Specifically, the flow regulator 8 may include, for example, multiple proportional valves 8A and control valves 8B. Each of the multiple proportional valves 8A may also be, for example, an electromagnetic proportional valve. The control valve 8B has multiple valve spools corresponding to the multiple actuators. The control valve 8B has a pair of pilot ports corresponding to each valve spool. Each valve spool operates due to a pilot pressure input to any one of the pair of pilot ports corresponding to that valve spool, allowing working oil to be supplied to the actuator corresponding to that valve spool. Each of the multiple proportional valves 8A is configured in an oil passage connecting the pilot port of the valve spool corresponding to that proportional valve 8A to a pilot pump (not shown), regulating the pilot pressure input to the pilot port. In other words, each of the multiple proportional valves 8A outputs a secondary pressure corresponding to the operating quantity u(t) (e.g., a current value) input from the controller 51, which is input as a pilot pressure to the pilot port corresponding to that proportional valve 8A. Each of the plurality of proportional valves 8A is adjusted by a pilot pressure input to its corresponding pilot port to a magnitude corresponding to the operating quantity u(t) input from the controller 51. Control valve 8B operates according to the pilot pressure input to its pilot port, thereby supplying working oil from the hydraulic pump 7 to at least one of the plurality of actuators, which then operates.

[0030] The multiple proportional valves 8A may also include a pair of boom proportional valves 8A for controlling the action of the boom cylinder 11, a pair of stick proportional valves 8A for controlling the action of the stick cylinder 12, a pair of remote auxiliary device proportional valves 8A for controlling the action of the remote auxiliary device cylinder 13, and a pair of slewing proportional valves 8A for controlling the action of the slewing motor 14.

[0031] The construction machinery 100 includes at least one posture detector that detects actual posture values ​​related to the posture of the construction machinery. For example, such as Figure 1 As shown, the at least one posture detector may also include a boom posture detector 15, a stick posture detector 16, a remote attachment posture detector 17, and a slewing posture detector 18. Each of these posture detectors inputs its detection results to the controller 51.

[0032] The boom posture detector 15 can be any detector capable of detecting the actual posture value related to the posture of the boom 4, i.e., the boom posture value. There is no limitation on the specific type of detector. The boom posture value can be, for example, the posture of the boom 4, the extension and retraction degree of the boom working cylinder 11 (working cylinder length), or other boom posture values ​​related to the posture of the boom 4.

[0033] The stick posture detector 16 can be any detector capable of detecting the actual posture value related to the posture of the stick 5, i.e., the stick posture value. There is no limitation on the specific type of detector. The stick posture value can be, for example, the posture of the stick 5, the extension and retraction degree of the stick working cylinder 12 (working cylinder length), or other stick posture values ​​related to the posture of the stick 5.

[0034] The remote accessory device posture detector 17 can be any detector capable of detecting the actual posture value related to the posture of the remote accessory device 6, i.e., the remote accessory device posture value. The specific type of detector is not limited. The remote accessory device posture value can be, for example, the posture of the remote accessory device 6, the extension and retraction degree of the remote accessory device working cylinder 13 (working cylinder length), or other remote accessory device posture values ​​related to the posture of the remote accessory device 6.

[0035] The rotation posture detector 18 can be any detector capable of detecting the actual posture value, i.e., the rotation posture value, related to the posture of the upper rotating body 2; the specific type of detector is not limited. The rotation posture value can be, for example, the posture of the upper rotating body 2, the state of a rotation-related device (e.g., the rotation motor 14) associated with the rotation of the upper rotating body 2, or other rotation posture values ​​related to the posture of the upper rotating body 2. The rotation posture value can also be the rotation angle of the upper rotating body 2 relative to the lower traveling body 1.

[0036] The attitude detectors 15-17 can each be, for example, an inertial measurement unit (IMU), a stroke sensor that measures the extension and retraction of the working cylinder (working cylinder length), a sensor that measures the rotation angle of the boom 4, stick 5, and distal auxiliary device 6, or other sensors. The rotation attitude detector 18 can be a sensor that measures the relative angle between the upper rotating body 2 and the lower traveling body 1, or other sensors.

[0037] The at least one posture detector may also include a camera device (not shown). The camera device may also be a 3D information acquisition device capable of detecting 3D information of the object being photographed. The 3D information acquisition device may be, for example, a LIDAR (Light Detection and Ranging) or a stereo camera. The camera device may also be configured to detect at least one of the following postures: the posture of the boom, the posture of the stick 5, the posture of the distal auxiliary device 6, and the posture of the upper rotating body 2.

[0038] The construction machinery 100 may also include an antenna 19 for a satellite positioning system. The satellite positioning system may be, for example, GPS (Global Positioning System), GNSS (Global Navigation Satellite System), or other satellite positioning systems. The antenna 19 may be configured to detect the attitude of the upper rotating body 2 relative to the lower traveling body 1, or it may be configured to obtain the position information of the construction machinery 100 at the work site.

[0039] External device 200 can be an information terminal such as a tablet computer, smartphone, laptop, or desktop computer, or a management device such as a server. Alternatively, external device 200 can also be a computer provided as a service in a cloud service on a network such as the Internet. Furthermore, external device 200 may include a remote control device for remotely operating the construction machinery 100.

[0040] The external device 200 includes an external device controller 201, an external display 202, an external input device 203, an external memory 204, and a communication device 205.

[0041] The external device controller 201 includes a computer with an arithmetic processing unit. The arithmetic processing unit of the external device controller 201 executes a control program, thereby enabling the functions of the external device 200.

[0042] The external display 202 shows information related to the automatic driving of the construction machinery 100. In this case, by checking the information displayed on the external display 202 of the external device 200, the operator can check the status of the automatic driving of the construction machinery 100 after leaving the location where the construction machinery 100 is located.

[0043] The external display 202 can be a monitor (display), a device that projects images onto objects, or a device using AR (Augmented Reality) technology. The external display 202 can also display images of the work site, i.e., work site images. The external device controller 201 can also use image data input from the camera device to generate the work site image and display the generated work site image on the external display 202.

[0044] The external input device 203 accepts input operations performed by the person involved in the task. The external input device 203 can be a keyboard, a mouse, a joystick, an input switch, a device that inputs information based on the person's line of sight, a device that inputs information based on the position of the person's fingers in space, or other input devices. Alternatively, the external input device 203 can also be a function included in the touchscreen of the information terminal.

[0045] External memory 204 can also store various settings used in autonomous driving. For example, external memory 204 can also store teaching data used in autonomous driving.

[0046] The communication unit 205 is a device for wireless or wired communication with the construction machinery 100 (e.g., the automatic driving control device 50). The external device 200 can communicate with the construction machinery 100 (e.g., the automatic driving control device 50) via the communication unit 205.

[0047] The autonomous driving control device 50 includes a communication unit 20 for wireless or wired communication with an external device 200. The autonomous driving control device 50 and the external device 200 can send and receive data with each other, for example, by using various networks such as the Internet or mobile phone networks.

[0048] The features of this embodiment will be described in detail below. The automatic driving control device 50, construction machinery 100, automatic driving control system 300, automatic driving control method and automatic driving control program involved in this embodiment can each reduce the variation in the operating speed of the construction machinery 100 during automatic driving.

[0049] The automatic driving control device 50 according to this embodiment includes a controller 51. The controller 51 controls the movement of multiple movable parts of the construction machinery 100 based on multiple target positions P1 to Pn set for automatic driving of the construction machinery 100. The controller 51 sets the basic speed rv of each of the multiple movable parts, obtains the actual posture value yp related to the actual posture of each of the multiple movable parts, calculates the ideal posture value rp related to the ideal posture of each of the multiple movable parts using the basic speed rv, calculates the correction value uc(t) for correcting the basic speed rv of each of the multiple movable parts using the difference (deviation e(t)) between the ideal posture value rp and the actual posture value yp, and outputs the operation quantity u(t) corresponding to the value obtained by correcting the basic speed rv of each of the multiple movable parts using the correction value uc(t) to the control object 9 of the automatic driving.

[0050] In this embodiment, a basic speed rv is set for each of the plurality of movable parts, and an operation quantity u(t) corresponding to the value obtained by correcting the basic speed rv using a correction value uc(t) is output to the controlled object 9. Therefore, compared with the case where the basic speed rv is not set, the variation range of the operation quantity u(t) can be reduced. As a result, in the automatic driving of the construction machinery 100, the variation of the movement speed of the construction machinery 100 before and after switching the target position (specifically, the variation of the movement speed of the plurality of movable parts) can be reduced. In addition, in this embodiment, the correction value uc(t) is calculated using the deviation e(t), which is the deviation between the ideal posture value rp calculated using the basic speed rv and the actual posture value yp. Therefore, a specific part 10 of the construction machinery 100 can be moved along an ideal path or a path close to the ideal path when the plurality of movable parts move at the basic speed rv.

[0051] The operating quantity u(t) can be a value corresponding to the basic speed rv obtained by correcting the basic speed rv using the correction value uc(t), or it can be a speed value (unit: [mm / s] or [deg / s]), or it can be a current value corresponding to that speed value. Alternatively, the operating quantity u(t) can also be a voltage value corresponding to that speed value. The operating quantity u(t) can also be the flow rate of the working oil corresponding to that speed value. The controller 51 can also pre-store mappings such as functions representing the relationship between the speed value and the current value, the voltage value, or the flow rate. In this case, the controller 51 can convert the speed value into a value corresponding to that speed value (the current value, the voltage value, or the flow rate).

[0052] The controller 51 includes a computer with an arithmetic processing unit. The arithmetic processing unit of the controller 51 executes a control program, thereby realizing the function of the automatic driving control device 50. The automatic driving control device 50 may also include a memory 52 and an input device 53.

[0053] In this embodiment, the specific portion 10 is defined as the distal end of the distal accessory device 6 (in... Figure 1 In this specific example, the specific part 10 is the distal end of the bucket 6, but the specific part 10 can also be any part other than the distal end of the distal end accessory 6. Specifically, for example, the specific part 10 can be the distal end of the boom 5, or it can be any other part of the construction machinery 100.

[0054] The plurality of movable parts may, for example, include a boom 4, a stick 5, and a distal auxiliary device 6. The plurality of movable parts may, for example, include a boom 4, a stick 5, a distal auxiliary device 6, and an upper slewing body 2. The plurality of movable parts may, for example, include a boom working cylinder 11, a stick working cylinder 12, and a distal auxiliary device working cylinder 13. The plurality of movable parts may, for example, include a boom working cylinder 11, a stick working cylinder 12, a distal auxiliary device working cylinder 13, and an upper slewing body 2 or slewing-related equipment (e.g., a slewing motor 14).

[0055] The multiple target positions P1 to Pn can be multiple target points that a specific part 10 of the construction machinery 100 is expected to reach sequentially during automatic driving, or they can be rotation angles that the upper rotating body 2 of the construction machinery 100 is expected to reach sequentially during automatic driving, or they can be other types of target positions. In addition, "n" in the symbol Pn can be an integer of 2 or more, or an integer of 3 or more.

[0056] Multiple target locations P1 to Pn can also be stored as teaching data in at least one of the external memory 204 of the external device 200 and the memory 52 of the automatic driving control device 50. The controller 51 of the automatic driving control device 50 can also acquire teaching data (e.g., trajectory data described later) through teaching when the construction machinery 100 is set to teaching mode. Additionally, the controller 51 can also acquire path information (information about the multiple target locations P1 to Pn) input by a person involved in the operation to the external input device 203 or input device 53 as teaching data. Furthermore, the controller 51 can also acquire teaching data by receiving teaching data pre-stored by the external device 200.

[0057] Each of the multiple target positions P1 to Pn can be represented by two-dimensional or three-dimensional coordinates in a specific coordinate system. The specific coordinate system can be, for example, a coordinate system with the reference position at the work site as the origin, or a coordinate system with the reference position in the engineering machinery 100 (e.g., any part on the rotary axis SA) as the origin, or a coordinate system other than these coordinate systems (e.g., a global coordinate system).

[0058] exist Figure 1 In the specific example shown, the operation performed by the construction machinery 100 via automatic driving (automatic driving operation) is excavation. Multiple target locations P1 to Pn include target locations P1 to P4. Figure 1 In this context, position P0 can be the starting position P0 (starting point P0) of autonomous driving, and target position P4 can be the ending position (ending point) of autonomous driving. Furthermore, in the following text, position P0 may sometimes be referred to as target position P0.

[0059] Furthermore, the autonomous driving operation is not limited to excavation. For example, the autonomous driving operation may include a lifting and slewing operation performed after the excavation operation, a soil removal operation performed after the lifting and slewing operation, or a reset and slewing operation performed after the soil removal operation.

[0060] In the excavation operation, the bucket 6 is used to excavate the ground surface G and other excavation objects. This excavation operation includes, for example, the action of bringing the boom 5 closer to the upper rotating body 2 (boom retraction action) and the action of bringing the tip of the bucket 6 closer to the upper rotating body 2 (excavation action). In the lifting and slewing operation, the bucket 6, holding the excavated sand, is moved directly above the dumping site. This lifting and slewing operation includes, for example, the action of raising the boom 4 and the rotation of the upper rotating body 2. The dumping site can be, for example, a loading platform for a dump truck or other transport vehicle, or a sand pit for temporary storage of sand. In the dumping operation, the sand held by the bucket 6 is discharged to the dumping site. This dumping operation includes, for example, the action of moving the boom 5 away from the upper rotating body 2 (boom action) and the action of moving the tip of the bucket 6 away from the upper rotating body 2 (dumping action). In the return and slewing operation, the bucket 6 is returned to the excavated object. In this reset and slewing operation, for example, the action of lowering the boom 4 and the slewing action of the upper slewing body 2 are performed.

[0061] The automated driving operation is not limited to the specific examples mentioned above; it could also be other operations such as leveling. The leveling operation involves using the bucket 6 to level the surface of the land or other objects requiring leveling. The leveling operation can be a horizontal retraction leveling operation, a horizontal extension leveling operation, or a compaction leveling operation.

[0062] In the automated driving, the controller 51 controls the movement of the plurality of movable parts in a manner that causes a specific part 10 of the construction machinery 100 to move from the starting position P0 to the target position P1, controls the movement of the plurality of movable parts in a manner that causes the specific part 10 to move from the target position P1 or the vicinity of the target position P1 to the target position P2, controls the movement of the plurality of movable parts in a manner that causes the specific part 10 to move from the target position P2 or the vicinity of the target position P2 to the target position P3, and controls the movement of the plurality of movable parts in a manner that causes the specific part 10 to move from the target position P3 or the vicinity of the target position P3 to the target position P4 (end position).

[0063] In the automatic driving control device 50 according to this embodiment, the controller 51 sets a target time, i.e., the time tm between two points, for a specific part 10 of the construction machinery 100 to move from the kth target position Pk to the (k+1)th target position P(k+1) among multiple target positions P0 to Pn. Using information related to the posture of the movable part at the kth target position Pk, information related to the posture of the movable part at the (k+1)th target position P(k+1), and the time tm between the two points, it sets a basic speed rv associated with each of the multiple movable parts. In this embodiment, the specific part 10 moving towards the (k+1)th target position P(k+1) can reach the (k+1)th target position P(k+1) or its vicinity at or near the time tm between the two points. Furthermore, "k" can be an integer greater than or equal to zero, or an integer greater than or equal to one.

[0064] The information related to the posture of the movable part at the k-th target position Pk is the information related to the posture of the movable part at the starting point (starting position) of the movement of the specific part 10, and may be, for example, the starting position posture value described later. The information related to the posture of the movable part at the (k+1)-th target position P(k+1) is the information related to the posture of the movable part at the destination (target position) of the movement of the specific part 10, and may be, for example, the target position posture value described later.

[0065] Figure 4 This is a diagram showing multiple parameters set for multiple target positions P1 to Pn. Figure 4 In the specific example shown, the parameters for each target position include the target coordinates (X, Z) of a specific part 10 (e.g., the distal end of the bucket 6), the target posture (Xi1) of a specific movable part, the target slewing angle (SwingAng) of the upper rotating body 2, and the travel time (tm) between the two points. These parameters for each target position can be stored, for example, in the memory 52 of the automatic driving control device 50, in the external memory 204 of the external device 200, or in other memories besides these.

[0066] The X-axis of the coordinate system for the target coordinates (X, Z) of a specific location 10 can, for example, be a horizontal coordinate axis parallel to the extension direction of the working device 3 when viewed from above. The Z-axis of the coordinate system for the target coordinates (X, Z) can also be a vertical coordinate axis intersecting the X-axis. For example, the target coordinates (X, Z) of the specific location 10 recorded in the row for target position P1 are the coordinates of target position P1, and the same applies to other target positions P2 to Pn. Furthermore, although in Figure 4In the specific example shown, the target coordinates are two-dimensional coordinates, but the target coordinates of a specific part 10 can also be three-dimensional coordinates.

[0067] The target posture (Xi1) of the specific movable part can be, for example, the angle of any one of the boom 4, stick 5, and distal attachment 6 (bucket 6) constituting the working device 3, or the extension degree (working cylinder length) of any one of the working cylinders of the boom working cylinder 11, stick working cylinder 12, and distal attachment working cylinder 13. In this embodiment, the target posture (Xi1) of the specific movable part is the target angle of the bucket 6.

[0068] The target rotation angle (SwingAng) of the upper rotating body 2 can be the target rotation angle of the upper rotating body 2 relative to the lower traveling body 1, or it can be the target rotation angle of the upper rotating body 2 relative to other references.

[0069] Set the movement time (tm) between two points for each of the multiple target positions P1 to Pn. That is, set the movement time (tm) between two points as the target time for a specific part 10 to move from target position P1 to target position P2, set the movement time (tm) between two points as the target time for a specific part 10 to move from target position Pk to target position P(k+1), and set the movement time (tm) between two points as the target time for a specific part 10 to move from target position P(n-1) to target position Pn.

[0070] The multiple inter-point movement times tm set for multiple target positions P1 to Pn can be set, for example, in the following manner. The controller 51 can also set multiple inter-point movement times tm based on values ​​input by a person involved in the operation to the input device 53 of the automatic driving control device 50 or the external input device 203 of the external device 200. Furthermore, when the teaching data includes trajectory data of a specific part 10, the controller 51 can also set a start position P0 and an end position Pn in the trajectory of the specific part 10, and equally divide the portion between the start position P0 and the end position Pn to set the target positions P1 to P(n-1), setting the inter-point movement time tm associated with each of the multiple target positions P1 to Pn to the same value. Furthermore, when the trajectory data is time-series data that includes not only position information (e.g., coordinate information) but also time information, the controller 51 can also set the movement time tm between two points to a specific value (e.g., 0.5 seconds), setting the position of the specific part 10 on the trajectory of the specific part 10 0.5 seconds after the starting position P0 as the target position P1, and then setting the positions of the specific parts 10 0.5 seconds after the starting position P0 as P2 to Pn respectively. In this case, the movement time tm between the two points of the multiple target positions P1 to Pn is set to the same value.

[0071] Figure 5 This is a flowchart illustrating an example of the computational processing performed by the controller 51 of the automatic driving control device 50.

[0072] After the autonomous driving of the construction machinery 100 begins, the controller 51 acquires path information related to the target trajectory of a specific part 10 during autonomous driving. Figure 5 Step S11). The path information may also include information about multiple target locations P1 to Pn. Specifically, for example, it may also include information about... Figure 4 Information on multiple parameters shown. The path information may also be stored in at least one of the memories in the memory 52 of the autonomous driving control device 50 and the external memory 204 of the external device 200.

[0073] Next, the controller 51 calculates the posture values ​​(starting position posture values) of each of the plurality of movable parts at the start of autonomous driving (step S12). Figure 1 In the specific example shown, the controller 51 calculates the initial position posture value of each of the plurality of movable parts when the specific part 10 is configured in the initial position P0. This initial position posture value is used to calculate the basic velocity rv in step S15 described later. The controller 51 may also calculate the initial position posture value using the coordinates (X, Z) of the initial position P0 and the angle of the remote auxiliary device 6 at this point in time.

[0074] exist Figure 2 , Figure 3 and Figure 5 In the specific example shown, the initial position posture values ​​of the plurality of movable parts are the working cylinder length of the boom working cylinder 11, the working cylinder length of the stick working cylinder 12, the working cylinder length of the distal auxiliary device working cylinder 13, and the rotation angle of the upper slewing body 2. However, the initial position posture values ​​of the plurality of movable parts may also include the angle of the boom 4, the angle of the stick 5, and the angle of the distal auxiliary device 6 instead of the working cylinder lengths of the working cylinders 11, 12, and 13. In addition, besides the rotation angle of the upper slewing body 2, the initial position posture value for rotation may also be a value related to that rotation angle (e.g., a value related to the slewing motor 14).

[0075] Next, the controller 51 sets the next moving destination (target position) of the specific part 10 as the target position Pn (step S13). After the start of autonomous driving, "n=1", therefore, the controller 51 sets the next moving destination of the specific part 10 as the target position P1.

[0076] Next, the controller 51 uses the coordinates (X, Z) of the target position P1 (refer to...) Figure 4), and the target pose Xi1 of the specific movable part set for the target position P1 (refer to Figure 4 (Step S14) Calculate the target position posture value of each of the plurality of movable parts under the assumption that a specific part 10 has reached the target position P1.

[0077] The target position posture values ​​of the plurality of movable parts can also be the working cylinder length of the boom cylinder 11, the working cylinder length of the stick cylinder 12, the working cylinder length of the distal auxiliary device cylinder 13, and the rotation angle of the upper slewing body 2. In addition to the working cylinder lengths of the cylinders 11, 12, and 13, the target position posture values ​​of the plurality of movable parts can also be the angles of the boom 4, the stick 5, and the distal auxiliary device 6. Furthermore, in addition to the rotation angle of the upper slewing body 2, the target position posture value regarding rotation can also be a value relating to that rotation angle (e.g., a value relating to the slewing motor 14).

[0078] Next, the controller 51 uses the target position posture values ​​of the plurality of movable parts with respect to the movement destination (e.g., target position P1), the start position posture values ​​of the plurality of movable parts with respect to the movement origin (e.g., start position P0), and the movement time tm between the two points with respect to the movement destination (e.g., target position P1) (refer to...). Figure 4 and Figure 6 ), calculate the basic velocity rv associated with each of the plurality of movable parts (step S15). In Figure 6 In the specific example shown, the starting position posture value is the length of the working cylinder at the starting position, and the target position posture value is the length of the working cylinder at the target position.

[0079] Specifically, for example, when the plurality of movable parts are boom cylinder 11, stick cylinder 12, remote auxiliary device cylinder 13 and upper slewing body 2, the controller 51 may calculate the basic speed rv of each movable part as described below.

[0080] (Basic speed rv of boom working cylinder 11) The controller 51 can also use the following formula (1) to calculate the basic speed rv [mm / s] of the boom working cylinder 11.

[0081] The basic speed rv[mm / s] of boom cylinder 11 = (target position posture value of boom cylinder 11 at the target position - starting position posture value of boom cylinder 11 at the starting position) / movement time tm between the two points (1) (The basic speed rv of the boom cylinder 12) The controller 51 can also use the following formula (2) to calculate the basic speed rv [mm / s] of the boom cylinder 12.

[0082] The basic speed rv[mm / s] of the stick working cylinder 12 = (target position posture value of the stick working cylinder 12 at the target position - initial position posture value of the stick working cylinder 12 at the starting position) / movement time tm between the two points (2) (The basic speed rv of the remote auxiliary device working cylinder 13) The controller 51 can also use the following formula (3) to calculate the basic speed rv [mm / s] of the remote auxiliary device working cylinder 13.

[0083] The basic speed rv[mm / s] of the remote auxiliary device working cylinder 13 = (target position posture value of the remote auxiliary device working cylinder 13 at the target position - starting position posture value of the remote auxiliary device working cylinder 13 at the starting position) / movement time tm between the two points (3) (The basic velocity rv of the upper rotating body 2) The controller 51 can also use the following equation (4) to calculate the basic velocity rv[deg / s] of the upper rotating body 2. Furthermore, the basic velocity rv[deg / s] is the change in rotation angle per unit time.

[0084] The basic velocity rv[deg / s] of the upper rotating body 2 = (target position posture value of the upper rotating body 2 at the target position - starting position posture value of the upper rotating body 2 at the starting position) / movement time tm between the two points (4) Next, the controller 51 obtains the actual posture value yp of each of the plurality of movable parts at this point in time (step S16). Figure 5 In the specific example shown, the actual posture value yp of the plurality of movable parts is the working cylinder length of the boom cylinder 11, the working cylinder length of the stick cylinder 12, the working cylinder length of the distal auxiliary device cylinder 13, and the rotation angle of the upper slewing body 2. However, the actual posture value yp of the plurality of movable parts may also include the angle of the boom 4, the angle of the stick 5, and the angle of the distal auxiliary device 6 instead of the working cylinder lengths of the working cylinders 11, 12, and 13. In addition, besides the rotation angle of the upper slewing body 2, the actual posture value yp regarding rotation may also be a value regarding that rotation angle (e.g., a value regarding the slewing motor 14).

[0085] Next, the controller 51 uses the base velocity rv to calculate the ideal posture value rp of each of the plurality of movable parts at this point in time (step S17). In other words, the controller 51 uses the base velocity rv to calculate the ideal posture value rp of each of the plurality of movable parts in the same control cycle as the previous step S16 (the controller 51 uses the base velocity rv to calculate the ideal posture value rp of each of the plurality of movable parts at a time point that is approximately the same as the time point at which the actual posture value yp is obtained in step S16).

[0086] exist Figure 2 , Figure 3 and Figure 5 In the specific example shown, the ideal posture value rp of the plurality of movable parts is the ideal length of the working cylinder of the boom cylinder 11, the ideal length of the working cylinder of the stick cylinder 12, the ideal length of the working cylinder of the distal auxiliary device cylinder 13, and the ideal rotation angle of the upper slewing body 2. However, in addition to the ideal lengths of the working cylinders 11, 12, and 13, the ideal posture value rp of the plurality of movable parts can also be the ideal angle of the boom 4, the ideal angle of the stick 5, and the ideal angle of the distal auxiliary device 6. Furthermore, in addition to the ideal rotation angle of the upper slewing body 2, the ideal posture value rp regarding rotation can also be a value related to that ideal rotation angle (e.g., the ideal value related to the slewing motor 14).

[0087] Specifically, for example, the movement distance conversion unit of controller 51 can also use the basic speed rv, the starting position posture value of each of the plurality of movable parts at the starting point of movement (e.g., starting position P0), and the time elapsed and below, formula (5), to calculate the ideal posture value rp of each of the plurality of movable parts at this time point. Figure 7 In the specific example shown, the initial position posture value is the length of the working cylinder at the initial position. During the period from the initial position P0 to the target position P1 at a specific location 10, calculations are performed every control cycle of feedback control such as PID (Proportional Integral Derivative) control. Figure 7 The ideal pose value rp is shown.

[0088] The ideal posture value of the movable part rp = the initial posture value of the movable part at the starting position + the basic velocity rv × the time t (5) The elapsed time t can be the time elapsed since the point in time when the specific part 10 moves from the starting position (the origin) to the target position (the destination). Specifically, for example, if the origin is the starting position P0, the controller 51 can measure the elapsed time t from the point in time when the specific part 10 moves from the starting position P0 to the target position P1. Similarly, if the origin is the target position P1, the controller 51 can measure the elapsed time t from the point in time when the specific part 10 moves from the target position P1 to the target position P2. When the origins are the target positions P2 through Pn, the elapsed time t can be measured in the same way as described above. That is, after changing the origin to the next target position, the controller 51 resets the elapsed time t up to this point and restarts measuring the elapsed time t.

[0089] When the multiple movable parts are boom cylinder 11, stick cylinder 12, remote auxiliary device cylinder 13 and upper slewing body 2, the controller 51 may, for example, calculate the ideal posture value rp of each movable part as described below.

[0090] The controller 51 can also use the following formulas (6) to (9) to calculate the ideal posture value rp of the boom working cylinder 11, stick working cylinder 12, remote auxiliary device working cylinder 13 and upper rotating body 2.

[0091] The ideal posture value rp of boom cylinder 11 = the initial posture value of boom cylinder 11 at the starting position + the basic speed rv of boom cylinder 11 × the elapsed time t (6) The ideal posture value rp of the stick working cylinder 12 = the initial posture value of the stick working cylinder 12 at the starting position + the basic speed rv of the stick working cylinder 12 × the time t (7) The ideal posture value rp of the remote auxiliary device working cylinder 13 = the initial posture value of the remote auxiliary device working cylinder 13 at the starting position + the basic velocity rv of the remote auxiliary device working cylinder 13 × the elapsed time t (8) The ideal posture value rp of the upper rotating body 2 = the initial posture value of the upper rotating body 2 at the starting position + the basic velocity rv of the upper rotating body 2 × the time t (9) Next, the controller 51 uses the deviation e(t) between the ideal posture value rp calculated in step S17 and the actual posture value yp obtained in step S16 to calculate the correction value uc(t) for correcting the basic velocity rv of each of the plurality of movable parts (step S18).

[0092] Next, the controller 51 calculates the operation quantity u(t) corresponding to the value obtained by correcting the basic speed rv of each of the plurality of movable parts using the correction value uc(t), and outputs the operation quantity u(t) to the control object 9 in the automatic driving (step S19).

[0093] exist Figure 5 In the processing of steps S16 to S19 of the flowchart, such as Figure 2 and Figure 3As shown in the block diagram, feedback control is performed using PID control, PI (Proportional Integral) control, PD (Proportional Derivative) control, and P (Proportional) control. Specifically, the correction value calculation unit of controller 51 uses a pre-set formula for feedback control to determine a correction value uc(t) that makes the deviation e(t) zero or close to zero. Controller 51 calculates the operating quantity u(t) corresponding to the sum of the determined correction value uc(t) and the basic speed rv. Controller 51 outputs the calculated operating quantity u(t) to the proportional valve 8A of the controlled object 9. Furthermore, the correction value uc(t) can take any value, both positive and negative.

[0094] Next, the controller 51 determines whether to change the target position to the next target position (step S20). In this embodiment, the determination condition for whether to change the target position to the next target position is a time-related condition (time condition) regarding whether the elapsed time t has reached the travel time between the two points. However, the determination condition is not limited to the time condition, and may also be a position-related condition (position condition). The position condition may, for example, be whether a specific part 10 has reached a predetermined range set based on the target position of the travel destination.

[0095] Furthermore, when the determination condition is the time condition, compared to when the determination condition is the location condition, the specific part 10 is more likely to reach the destination (the next target location) or be near the destination. The reason is as follows: the determination criterion for the location condition is defined by a range as specified above, while the determination criterion for the time condition can be defined by precise time (time of movement between two points). Therefore, compared to the location condition, the probability of the specific part 10 reaching the target location of the destination can be increased.

[0096] If the determination condition is not met (step S20 is "No"), the controller 51 repeatedly performs the processing of steps S16 to S19.

[0097] If the determination condition is met (step S20 is "Yes"), the controller 51 determines that the automatic driving has ended at position Pn (in Figure 1 Check whether the control up to the end position P4 has been completed (step S21).

[0098] If the control up to the end position Pn has not been completed (step S21 is "No"), the controller 51 performs the processing after step S22. If the control up to the end position Pn has been completed (step S21 is "Yes"), the controller 51 ends the automatic driving.

[0099] In step S22, the controller 51 changes the travel destination to the next target location. Specifically, for example, if the original travel destination was target location P1, the controller 51 changes the travel destination to the next target location P2. In this case, the changed travel origin (the changed starting position) is the target location P1.

[0100] The controller 51 obtains the actual pose value yp of each of the plurality of movable parts as the target position of the changed movement starting point (changed starting position) (step S23).

[0101] Next, the controller 51 repeatedly performs the processing after step S14.

[0102] Next, the control modes of the automatic driving control device 50 will be described. The controller 51 of the automatic driving control device 50 can switch between a teaching mode for acquiring teaching data and an automatic driving mode that allows automatic driving using the teaching data. The controller 51 can also switch the control mode based on input operations performed by a person involved in the operation, such as input through the input device 53 of the automatic driving control device 50 or the external input device 203 of the external device 200.

[0103] When the control mode is in teach mode, at least one of the memories in the memory 52 of the automatic driving control device 50 and the external memory 204 of the external device 200 can store trajectory data of the construction machinery 100 when it moves according to the operations applied by the operating lever, operating pedal, or other operators of the remote operating device, or according to the operations applied by the operating devices in the cockpit of the construction machinery 100. Then, the controller 51 can also use the trajectory data as described above to set multiple target positions P1 to Pn. In this case, by using the trajectory data of the construction machinery 100 when it moves to set multiple target positions P1 to Pn, multiple target positions P1 to Pn can be set on target paths corresponding to the trajectory drawn by the specific part 10 or the upper rotating body 2 during the actual movement of the construction machinery 100. Furthermore, as described above, the trajectory data can also be time-series data that includes not only position information but also time information.

[0104] When the control mode is set to automatic driving mode, the controller 51 is capable of performing automatic driving of the construction machinery 100 as described above.

[0105] In the automatic driving control device 50 according to this embodiment, regarding the rotational movement of the upper rotating body 2, for example... Figure 3 As shown, the controller 51 can also set the basic rotational speed rv of the upper rotating body 2 or the rotation-related device (e.g., the rotary motor 14) to the basic speed rv, and calculate a rotational correction value uc(t) to correct the basic rotational speed rv as the correction value uc(t). In this case, one of the movable parts is the upper rotating body 2 or the rotation-related device (e.g., the rotary motor), so the variation in the rotational speed of the upper rotating body 2 can be reduced during automatic driving.

[0106] While the embodiments of this disclosure have been described above, this disclosure is not limited to the described embodiments, and includes, for example, the variations described below.

[0107] [Variation Example 1] In the automatic driving control device 50 according to Variation 1 of this embodiment, the plurality of target positions P1 to Pn include: a target position that prioritizes reducing changes in movement speed (i.e., a change reduction priority target position) and a target position that prioritizes positional accuracy (i.e., a accuracy priority target position). The controller 51 sets the basic speed rv with respect to the accuracy priority target position to a value smaller than the basic speed rv with respect to the change reduction priority target position. In this Variation 1, the basic speed rv when a specific part 10 of the construction machinery 100 moves toward the accuracy priority target position is smaller than the basic speed rv when the specific part 10 moves toward the change reduction priority target position. Therefore, the probability that the specific part 10 passes through or near the accuracy priority target position can be increased.

[0108] Figure 8 This is a block diagram illustrating an example of the relationship between inputs and outputs in the automatic driving control system 300 involved in Modification 1. Figure 9 This is a diagram showing the multiple parameters set for multiple target positions P1 to Pn in Variation Example 1. Figure 10 This is a flowchart illustrating an example of the computational processing performed by the controller 51 of the automatic driving control device 50 involved in Modification 1.

[0109] Although Figure 10 The flowchart in the modified example 1 shown has the same characteristics as... Figure 5 The flowchart shown contains steps S11 to S23, which are the same as steps S11 to S23, but... Figure 10 The illustrations of steps S11 to S19, S22, and S23 are omitted in the text. Figure 10 The flowchart in the modified example 1 shown is similar to Figure 5 The difference in the flowchart shown is that steps S31, S32, and S33 are included between steps S20 and S21.

[0110] Figure 9 The table in the modified example 1 shown is... Figure 4 The difference in the table shown is that it also includes columns on the right. Figure 9 The contents of other columns in the table are the same as those in the table. Figure 4 The table shown is the same. Figure 9 The parameters in the right-hand column are used to pre-set whether to prioritize position accuracy for multiple target positions P1 to Pn. Target positions with a parameter set to "0" are priority targets for reducing variation, while target positions with a parameter set to "1" are priority targets for accuracy. Figure 9 In the specific example shown, although target position P2 and target position Pn (the final target position) among multiple target positions P1 to Pn are precision-priority target positions, the setting of change reduction priority target positions and precision-priority target positions is not limited to... Figure 9 specific example.

[0111] Controller 51 can also be based on Figure 9 The parameters of the right-hand column are set. Figure 10 The determination in step S31 shown. That is, if the determination condition for whether to change the target position to the next target position is met in step S20 (step S20 is "yes"), the controller 51 performs the processing after step S31.

[0112] The controller 51 determines whether the next target position is the target position prioritizing position accuracy or the target position prioritizing change reduction (step S31). If the next target position is the target position prioritizing change reduction (step S31 is "No"), the controller 51 performs the processing after step S21.

[0113] On the other hand, if the next target position is a position accuracy priority target position (step S31 is "Yes"), the controller 51 temporarily sets the basic velocity rv of each of the multiple movable parts to "zero" (step S32), and performs... Figure 8 The feedback control is shown in the block diagram. Figure 8 In this context, the "Target" signal is the target position posture value of each of the plurality of movable parts associated with the target position (P2 or Pn) of the moving destination. In other words, the "Target" signal is the ideal posture value (target position posture value) of each of the plurality of movable parts assuming that the specific part 10 has reached the target position (P2 or Pn) of the moving destination.

[0114] The controller 51 uses the "target" signal, i.e., the difference between the target position posture value and the actual posture value yp of the movable part (deviation e(t)), to calculate the correction value uc(t). In this case, the deviation e(t) is the difference between the target position posture value and the actual posture value yp of the movable part. Therefore, although the variation in motion speed increases, the positional accuracy of the specific part 10 can be improved. Moreover, since the basic speed rv is "zero", the controller 51 outputs the operation quantity corresponding to the same value as the correction value uc(t) as the operation quantity u(t) to the controlled object 9.

[0115] In step S33, controller 51 determines whether the position determination condition is met. The position determination condition may include, for example, whether the difference between the target position posture value and the actual posture value yp of the movable part is less than a preset threshold Th. Specifically, the position determination condition may include: whether the difference between the working cylinder length of the boom cylinder 11 (which is the target position posture value) and the actual working cylinder length (which is the actual posture value yp) is less than a preset threshold Th1; whether the difference between the working cylinder length of the stick cylinder 12 (which is the target position posture value) and the actual working cylinder length (which is the actual posture value yp) is less than a preset threshold Th2; whether the difference between the working cylinder length of the distal auxiliary device cylinder 13 (which is the target position posture value) and the actual working cylinder length (which is the actual posture value yp) is less than a preset threshold Th3; and whether the difference between the rotation angle of the upper rotating body 2 (which is the target position posture value) and the actual rotation angle (which is the actual posture value yp) is less than a preset threshold Th4.

[0116] If the position determination condition is not met (step S33 is "No"), the controller 51 performs... Figure 8 The block diagram illustrates feedback control. That is, controller 51 performs... Figure 8 The feedback control, as shown in the diagram, continues until the specific part 10 approaches the target position (P2 or Pn) of the moving destination.

[0117] If the position determination condition is met (step S33 is "yes"), the controller 51 performs the processing after step S21.

[0118] [Variation Example 2] In the automatic driving control device 50 according to Variation 2 of this embodiment, the controller 51 sets the basic rotational speed rv of the upper rotating body 2 in the final stage of rotation to a value smaller than the basic rotational speed rv in the initial stage of rotation of the upper rotating body 2. In this Variation 2, since the basic rotational speed rv in the final stage is set to a value smaller than the basic rotational speed rv in the initial stage, it is easier to make the posture (e.g., rotation angle) of the upper rotating body 2 when it stops, which has a large moment of inertia, close to the target posture.

[0119] Specifically, for example, in this modified example 2, the multiple target positions P1 to Pn can also be multiple target rotation angles, including a first target position (e.g., a first target rotation angle) and a final target position (e.g., a final target rotation angle). In this case, the controller 51 can also set the basic rotation speed rv with respect to the final target position to a value smaller than the basic rotation speed rv with respect to the first target position. In other words, the basic rotation speed rv when the upper rotating body 2 or the rotation associated device rotates towards the final target rotation angle can also be set to a value smaller than the basic rotation speed rv when the rotation angle rotates towards the first target rotation angle.

[0120] Figure 11 This is a block diagram illustrating an example of the input-output relationship in the automatic driving control system involved in Modification 2. Modification 2 Figure 11 The outline diagram shown uses the same format as in Modification 1 above. Figure 8 The same idea is shown in the outline diagram.

[0121] In the case where the next target position is, for example, the final target position Pn, the controller 51, as follows: Figure 11 As shown, the basic velocity rv of each of the multiple movable parts is set to "zero", and then... Figure 11 The feedback control is shown in the block diagram. Figure 11 In this context, the "target" signal is the target position posture value of each of the plurality of movable parts related to the target position Pn of the moving destination. In other words, the "target" signal is the ideal posture value (target position posture value) of each of the plurality of movable parts assuming that the specific part 10 has reached the target position Pn of the moving destination.

[0122] The controller 51 uses the "target" signal, i.e., the difference between the target position posture value and the actual posture value yp of the movable part (deviation e(t)), to calculate the correction value uc(t). In this case, the deviation e(t) is the difference between the target position posture value and the actual posture value yp of the movable part. Therefore, although the variation in motion speed increases, the positional accuracy of the specific part 10 can be improved. Moreover, since the basic speed rv is "zero", the controller 51 outputs the operation quantity corresponding to the same value as the correction value uc(t) as the operation quantity u(t) to the controlled object 9.

[0123] Controller 51, for example, with Figure 10 The processing in step S33 similarly determines whether the position determination condition is met. The position determination condition may, for example, include whether the difference between the target position posture value and the actual posture value yp of the movable part is less than a preset threshold Th. Specifically, the position determination condition may include: whether the difference between the working cylinder length of the boom cylinder 11 (which is the target position posture value) and the actual working cylinder length (which is the actual posture value yp) is less than a preset threshold Th1; whether the difference between the working cylinder length of the stick cylinder 12 (which is the target position posture value) and the actual working cylinder length (which is the actual posture value yp) is less than a preset threshold Th2; whether the difference between the working cylinder length of the distal auxiliary device cylinder 13 (which is the target position posture value) and the actual working cylinder length (which is the actual posture value yp) is less than a preset threshold Th3; and whether the difference between the rotation angle of the upper rotating body 2 (which is the target position posture value) and the actual rotation angle (which is the actual posture value yp) is less than a preset threshold Th4.

[0124] If the position determination condition is not met, the controller 51 performs... Figure 11 The block diagram illustrates feedback control. That is, controller 51 performs... Figure 11 The feedback control shown in the diagram continues until the specific part 10 approaches the target position Pn of the moving destination.

[0125] If the position determination condition is met, the controller 51 terminates the automatic driving control.

[0126] [Variation Example 3] In the automatic driving control device 50 according to Variation 3 of this embodiment, the controller 51 calculates a vector from the k-th target position among multiple target positions P1 to Pn to the (k+1)-th target position, and controls the operation of the multiple movable parts in a manner that causes a specific part 10 of the construction machinery 100 to move along the vector. Ideally, the controller 51 controls the operation of the multiple movable parts in a manner that causes the specific part 10 of the construction machinery 100 to be located on the vector. In this Variation 3, when the specific part 10 of the construction machinery 100 moves towards the (k+1)-th target position, the specific part 10 can be moved linearly along the vector.

[0127] Figure 12 This is a flowchart illustrating an example of the computational processing performed by the controller 51 of the automatic driving control device 50 involved in Modification 3. Although Figure 12 The flowchart in variation example 3 has the same characteristics as... Figure 5 The flowchart shown contains steps S11-S13, S22, and S23, which are the same as steps S11-S13, S22, and S23, but... Figure 12 The illustrations for steps S11-S13, S22, and S23 are omitted. Additionally, Figure 12 The flowchart in the variant example 3 shown is the same as Figure 5 The difference in the flowchart shown is that steps S41 to S43 are used instead of... Figure 5 The step S15 shown is replaced by steps S44 to S46. Figure 5 Step S17 is shown.

[0128] Furthermore, in the following specific example, it is explained that the boom working cylinder 11, the stick working cylinder 12, and the remote auxiliary device working cylinder 13 are activated, while the upper slewing body 2 does not perform a slewing action.

[0129] exist Figure 12 In the variation 3 shown, the controller 51 calculates the target position and posture values ​​of each of the plurality of movable parts in the same manner as described above (step S14).

[0130] Next, in step S41, the controller 51 calculates the vector V from the target position of the starting point of the movement (e.g., the starting position P0) to the target position of the destination of the movement (e.g., the target position P1).

[0131] Next, the controller 51 uses the following formula (10) to calculate the distance Ve that a specific part 10 advances per unit time (step S42).

[0132] Distance Ve[mm / s] = V / travel time tm between the two points (10) Next, the controller 51 uses the following formula (11) to calculate the ideal ground angle change Vxi, which is the ideal value of the change in the angle of the bucket 6 relative to the ground or the angle related to that angle, i.e., the change in the bucket's ground angle per unit time (step S43).

[0133] Ideal change in ground angle Vxi = (Target position ground angle TargetXi - Start position ground angle StartXi) / Time of movement between the two points tm (11) TargetXi is the target value of the bucket's ground angle at the destination, and StartXi is the bucket's ground angle at the starting point (starting position).

[0134] Next, the controller 51 obtains the actual posture value yp of each of the plurality of movable parts at this time point (step S16).

[0135] Next, the controller 51 uses the coordinates (x, z) of the target position (starting position) of the starting point of the movement, the distance Ve, the elapsed time t and below, and Equation (12) to calculate the ideal coordinates (x, z) (step S44).

[0136] Ideal coordinates (x, z) = coordinates of the starting position (x, z) + distance Ve × time t (12) Next, the controller 51 uses the ground angle (Xi) of the bucket 6 at the target position (starting position) of the moving departure point, namely the ground angle StartXi, the ground angle TargetXi, and the time t and below, as expressed in equation (13), to calculate the ideal ground angle Xi (step S45).

[0137] Ideal ground angle Xi = Starting position ground angle StartXi + Ideal ground angle change Vxi × Time t (13) Next, in Figure 12 In step S46, the controller 51 calculates, for example, the ideal posture value rp of the boom cylinder 11 with ideal coordinates (x, z), the ideal posture value rp of the stick cylinder 12 with ideal coordinates (x, z), and the ideal posture value rp of the remote auxiliary device cylinder 13 with ideal coordinates (x, z).

[0138] Processing and reference after step S18 Figure 5 The above-described embodiments are the same. In this variation 3, the movement of the plurality of movable parts can be controlled in such a way that a specific part 10 of the engineering machinery 100 is located on the vector.

[0139] When the ideal coordinates (x, z) are the coordinates of the far end (specific part 10) of the bucket 6, the controller 51 may, for example, calculate the ideal posture value rp as described below.

[0140] (1) The controller 51 calculates the X and Z coordinates (X_Arm, Z_Arm) of the distal end of the boom 5 based on the ideal coordinates (x, z), bucket length (Bkt_LENGTH), ideal ground angle Xi, bucket tip angle (BktTipAng), and the following formula. In the following formula, as... Figure 14 As shown, the bucket tip angle (BktTipAng) is the angle formed by the extending direction of the side edge of the opening of the bucket 6 and the front surface containing the distal end of the bucket 6. Additionally, as... Figure 14 As shown, the bucket length (Bkt_LENGTH) is the length from the base end of the bucket 6 (the far end of the boom 5) to the far end of the bucket 6.

[0141] [Mathematical Expression 1] The X-coordinate of the distal end of the stick: XArm = X - Bkt_LENGTH × sin(Xi - BktTipAng) [Mathematical Expression 2] The Z-coordinate of the distal end of the stick: ZArm = Z - Bkt_LENGTH × cos(Xi - BktTipAng) (2) Next, the controller 51 calculates the distance (AtBfLENGTH) between the base end (boom foot pin) of the boom 4 and the distal end (AtBfLENGTH) of the stick 5 using the following formula. This distance (AtBfLENGTH) is... Figure 15 The middle part is represented by a dotted line (2).

[0142] [Mathematical Expression 3] (3) Next, the controller 51 calculates the angle (ArmBmAng) between the boom 4 and the stick 5 using the following formula. This angle (ArmBmAng) is... Figure 15 The angle (3) represents the middle.

[0143] [Mathematical Expression 4] (4) Next, the controller 51 calculates the angle (BfBmAng) between the straight line connecting the base end of the boom 4 and the distal end of the stick 5 and the boom 4. This angle (BfBmAng) is... Figure 15 The angle (4) represents the middle.

[0144] [Mathematical Expression 5] (5) Next, the controller 51 calculates the angle (HoriBfAng) between the straight line connecting the base end of the boom 4 and the distal end of the stick 5 and the X-axis of the coordinate system. Alternatively, this coordinate system can also be a coordinate system with the base end of the boom 4 (boom foot pin) as its origin. This angle (HoriBfAng) is... Figure 15 The angle (5) is represented by the middle.

[0145] [Mathematical Expression 6] Next, the controller 51 uses the angle (BfBmAng), the angle (HoriBfAng), and the following formula to calculate the ideal angle (BmAng) of the boom 4.

[0146] When the Z-coordinate at the far end of boom 5 is above zero, the ideal angle of boom 4 (BmAng) = (BfBmAng) + (HoriBfAng). When the Z-coordinate at the far end of boom 5 is less than zero, the ideal angle of boom 4 (BmAng) = (BfBmAng) - (HoriBfAng). Next, the controller 51 uses the angle (ArmBmAng) and the following formula to calculate the ideal angle (ArmAng) of the stick 5.

[0147] The ideal angle of pole 5 (ArmAng) = 180 - (ArmBmAng) The controller 51 calculates the ideal angle (BktAng) of the bucket 6 using the ideal ground angle Xi, the ideal angle of the boom 4, the ideal angle of the stick 5, the bucket tip angle (BktTipAng), and the following formula.

[0148] The ideal angle of bucket 6 (BktAng) = Xi + BmAng - ArmAng - BktTipAng - 90° Next, the controller 51 uses a conversion mapping that represents the relationship between the working cylinder length of the boom working cylinder 11 and the angle of the boom 4 to convert the ideal angle (BmAng) of the boom 4 into the ideal posture value rp of the boom working cylinder 11. Similarly, the controller 51 uses a conversion mapping that represents the relationship between the working cylinder length of the stick working cylinder 12 and the angle of the stick 5 to convert the ideal angle (ArmAng) of the stick working cylinder 12 into the ideal posture value rp of the stick working cylinder 12, and uses a conversion mapping that represents the relationship between the working cylinder length of the remote attachment working cylinder 13 and the angle of the bucket 6 to convert the ideal angle (BktAng) of the remote attachment working cylinder 13 into the ideal posture value rp of the remote attachment working cylinder 13.

[0149] [Variation Example 4] The automatic driving control device 50 involved in Variation Example 4 includes an input device 53 (see reference). Figure 1 The input device 53 can accept input operations for at least one change, namely, a change in the target position or a change in the basic speed rv. In this variation 4, if the set target position does not conform to the actual work site conditions, the operator can change the target position to a target position that conforms to the actual work site conditions by applying an input operation to the input device 53. Furthermore, if the set basic speed rv does not conform to the actual work site conditions, the operator can change the basic speed rv to a basic speed rv that conforms to the actual work site conditions by applying an input operation to the input device 53.

[0150] [Variation Example 5] In the automatic driving control system 300 described in Variation 5, the external device 200 includes an external input device 203 (see reference). Figure 1 The external input device 203 is an input device capable of accepting input operations for at least one change, namely, a change in the target position or a change in the basic speed rv. In this variation 5, if the set target position does not conform to the actual work site conditions, the operator can change the target position to a target position that conforms to the actual work site conditions by applying an input operation to the external input device 203. Furthermore, if the set basic speed rv does not conform to the actual work site conditions, the operator can change the basic speed rv to a basic speed rv that conforms to the actual work site conditions by applying an input operation to the external input device 203.

[0151] [Autonomous Driving Control Methods] The automatic driving control method involved in this embodiment is based on multiple target positions set for the automatic driving of the construction machinery 100, and controls the movement of multiple movable parts of the construction machinery 100. The automatic driving control method includes the following steps: the controller 51 obtains the actual posture value yp related to the actual posture of the construction machinery 100; the controller 51 sets the basic speed rv of each of the multiple movable parts; the controller 51 uses the basic speed rv to calculate the ideal posture value rp related to the ideal posture of the construction machinery 100; the controller 51 uses the difference (deviation e(t)) between the ideal posture value rp and the actual posture value yp to calculate the correction value uc(t) for correcting the basic speed rv; and the controller 51 outputs the operation quantity u(t) corresponding to the value obtained by correcting the basic speed rv of each of the multiple movable parts using the correction value uc(t) to the control object 9 in the automatic driving.

[0152] [Autonomous driving control program] The automatic driving control program involved in this embodiment controls the movement of multiple movable parts of the construction machinery 100 based on multiple target positions set for automatic driving of the construction machinery 100. The automatic driving control program instructs a computer to perform the following processing: obtain an actual posture value yp related to the actual posture of the construction machinery 100; set a basic speed rv for the multiple movable parts; calculate an ideal posture value rp related to the ideal posture of the construction machinery 100 using the basic speed rv; calculate a correction value uc(t) for correcting the basic speed rv using the difference (deviation e(t)) between the ideal posture value rp and the actual posture value yp; and output the operation quantity u(t) corresponding to the value obtained by correcting the basic speed rv of each of the multiple movable parts using the correction value uc(t) to the control object 9 in the automatic driving process. The automatic driving control program can also be stored on a non-temporary storage medium.

[0153] [Other variations] (A) Regarding the automatic driving control device The controller of the automatic driving control device can consist of a single controller or multiple controllers. Construction machinery can also be equipped with multiple controllers, and external devices can also be equipped with multiple controllers. Alternatively, the construction machinery can have a portion of the multiple controllers, and the external devices can have the remaining portions of the multiple controllers.

[0154] (B) Correction for basic velocity In the described embodiment, although the controller outputs the value corresponding to the sum of the basic speed and the correction value to the controlled object as an operational quantity, the method of using the correction value to correct the basic speed is not limited to the described embodiment. For example, the value corresponding to the sum of the basic speed and the correction value multiplied by a predetermined coefficient may also be used as the operational quantity.

[0155] (C) Regarding external equipment In the described embodiment, although the construction machinery 100 is equipped with an automatic driving control device 50, the external device 200 may also be equipped with at least a portion of the automatic driving control device of this disclosure. That is, the external device 200 may also be equipped with the automatic driving control device 50, the construction machinery 100 may also be equipped with a portion of the automatic driving control device 50, and the external device 200 may also be equipped with another portion of the automatic driving control device 50. Furthermore, in the automatic control system involved in this disclosure, the external device 200 can be omitted.

[0156] (D) In ​​the embodiment described above, although the controller 51 inputs an operational quantity about speed to the controlled object 9, it may also input an operational quantity that converts speed into the flow rate of working oil to the controlled object 9.

[0157] As explained above, this disclosure provides a technology that can reduce the change in the speed of construction machinery before and after switching target positions in automatic driving of construction machinery.

[0158] The first aspect of this disclosure relates to an automatic driving control device comprising a controller that controls the movement of multiple movable parts of the construction machinery based on multiple target positions set for automatic driving of the construction machinery. The controller sets a basic speed for each of the multiple movable parts, obtains an actual posture value related to the actual posture of each of the multiple movable parts, calculates an ideal posture value related to the ideal posture of each of the multiple movable parts using the basic speed, calculates a correction value for correcting the basic speed of each of the multiple movable parts using the difference between the ideal posture value and the actual posture value, and outputs an operation quantity corresponding to the value obtained by correcting the basic speed of each of the multiple movable parts using the correction value to the controlled object in the automatic driving.

[0159] In this first method, a basic speed is set for each of the plurality of movable parts, and the operation quantity after correcting the basic speed using the correction value is output to the controlled object. Therefore, compared with the case where no basic speed is set, the variation range of the operation quantity can be reduced. Thus, in the automatic driving of construction machinery, the variation in the movement speed of the construction machinery before and after switching target positions (specifically, the variation in the movement speed of the plurality of movable parts) can be reduced. Furthermore, in this first method, the correction value is calculated using the difference between an ideal posture value and an actual posture value, where the ideal posture value is calculated using the basic speed. Therefore, the construction machinery can move along an ideal path or a path close to that ideal path when each of the plurality of movable parts moves at the basic speed.

[0160] The multiple target locations may be multiple target points that are expected to be reached sequentially by specific parts of the construction machinery in the autonomous driving process, or they may be the rotation angles that are expected to be reached sequentially by the upper rotating body of the construction machinery in the autonomous driving process, or they may be other target locations besides these.

[0161] Ideally, the automatic driving control device according to the second aspect of this disclosure, compared to the automatic driving control device according to the first aspect, further includes the following structure: That is, ideally, in the automatic driving control device according to the second aspect, the controller sets a target time (i.e., the travel time between two points) for a specific part of the construction machinery to move from the k-th target position to the (k+1)-th target position among the plurality of target positions. Using information related to the posture of the movable part at the k-th target position, information related to the posture of the movable part at the (k+1)-th target position, and the travel time between two points, the controller sets the basic speed for each of the plurality of movable parts. In this second aspect, the specific part moving towards the (k+1)-th target position can reach the (k+1)-th target position or its vicinity at the time specified in the travel time between two points or at a time close to the travel time between two points. Furthermore, "k" is an integer greater than or equal to zero.

[0162] The automatic driving control device according to the third aspect of this disclosure may also include the automatic driving control device according to the first or second aspect, further comprising the following structure. That is, in the automatic driving control device according to the third aspect, the controller may also output a value corresponding to the sum of the basic speed and the correction value as the operating quantity.

[0163] Ideally, the automatic driving control device according to the fourth aspect of this disclosure, in any of the automatic driving control devices according to the first to third aspects, further includes the following structure: That is, ideally, the automatic driving control device according to the fourth aspect further includes a memory storing trajectory data of the construction machinery during its operation, and the controller uses the trajectory data to set the plurality of target positions. In this fourth aspect, by using the trajectory data of the construction machinery during its operation to set the plurality of target positions, it is possible to set multiple target positions on a target path corresponding to the trajectory drawn by a specific part or the upper rotating body during the actual operation of the construction machinery.

[0164] Ideally, the automatic driving control device according to the fifth aspect of this disclosure, in any of the automatic driving control devices according to the first to fourth aspects, further includes the following structure: That is, ideally, in the automatic driving control device according to the fifth aspect, the plurality of movable parts include the upper rotating body of the construction machinery or a rotating associated device associated with the rotation of the upper rotating body, and the controller sets the basic rotation speed of the upper rotating body or the rotating associated device to the basic speed, and calculates a rotation correction value for correcting the basic rotation speed as the correction value. In this fifth aspect, one of the movable parts is the upper rotating body or the rotating associated device (e.g., a rotary motor), therefore, the variation in the rotation speed of the upper rotating body can be reduced during automatic driving.

[0165] Ideally, the automatic driving control device according to the sixth aspect of this disclosure, in addition to the automatic driving control device according to the fifth aspect, also includes the following structure: That is, ideally, in the automatic driving control device according to the sixth aspect, the controller sets the basic rotational speed in the final stage of the rotation of the upper rotating body to a value smaller than the basic rotational speed in the initial stage of the rotation of the upper rotating body. In this sixth aspect, since the basic rotational speed in the final stage is set to a value smaller than the basic rotational speed in the initial stage, it is easier to make the posture (e.g., rotation angle) of the upper rotating body with a large moment of inertia when it stops approach the target posture.

[0166] Specifically, for example, in this sixth method, the plurality of target positions may also be, for example, a plurality of target rotation angles, and the plurality of target positions may also include a first target position (e.g., a first target rotation angle) and a final target position (e.g., a final target rotation angle). In this case, the controller may also set the basic rotation speed with respect to the final target position to a value smaller than the basic rotation speed with respect to the first target position. In other words, the basic rotation speed when the upper rotating body or the rotation associated device rotates towards the final target rotation angle may also be set to a value smaller than the basic rotation speed when the rotation angle rotates towards the first target rotation angle.

[0167] Ideally, the automatic driving control device according to the seventh aspect of this disclosure, in any of the automatic driving control devices according to the first to sixth aspects, further includes the following structure: That is, ideally, in the automatic driving control device according to the seventh aspect, the plurality of target positions includes: a target position that prioritizes reducing changes in movement speed (i.e., a change reduction priority target position), and a target position that prioritizes positional accuracy (i.e., a accuracy priority target position), wherein the controller sets the basic speed with respect to the accuracy priority target position to a value smaller than the basic speed with respect to the change reduction priority target position. In this seventh aspect, the basic speed at which a specific part of the construction machinery moves towards the accuracy priority target position is smaller than the basic speed at which the specific part moves towards the change reduction priority target position; therefore, the probability of the specific part passing through or near the accuracy priority target position can be increased.

[0168] The automatic driving control device according to the eighth aspect of this disclosure may also include the following structure in any of the automatic driving control devices according to the first to seventh aspects: That is, in the automatic driving control device according to the eighth aspect, the controller may also calculate a vector from the k-th target position to the (k+1)-th target position among the plurality of target positions, and control the movement of the plurality of movable parts in such a way that a specific part of the construction machinery moves along the vector. In this eighth aspect, when a specific part of the construction machinery moves toward the (k+1)-th target position, the specific part can be made to move linearly along the vector.

[0169] Ideally, the automatic driving control device according to the ninth aspect of this disclosure, in any of the automatic driving control devices according to the first to eighth aspects, further includes the following structure: That is, ideally, the automatic driving control device according to the ninth aspect further includes an input device capable of accepting input operations for at least one change, namely, a change in the target position and a change in the basic speed. In this ninth aspect, if the set target position does not conform to the actual work site conditions, the operator can change the target position to a target position that conforms to the actual work site conditions by applying an input operation to the input device. Furthermore, if the set basic speed does not conform to the actual work site conditions, the operator can change the basic speed to a basic speed that conforms to the actual work site conditions by applying an input operation to the input device.

[0170] The engineering machinery involved in the 10th aspect of this disclosure includes: a lower walking body; an upper rotating body rotatably supported on the lower walking body; a working device undulatingly supported on the upper rotating body; a posture detector for detecting the actual posture value; and an automatic driving control device described in any one of the 1st to 9th aspects.

[0171] The automated driving control system according to the 11th aspect of this disclosure includes: an automated driving control device according to any one of the 1st to 9th aspects; and an external device capable of communicating with the automated driving control device.

[0172] Ideally, the automatic driving control system according to the 12th aspect of this disclosure, in addition to the automatic driving control system according to the 11th aspect, also includes the following structure: That is, ideally, in the automatic driving control system according to the 12th aspect, the external device includes an external display, which is a display showing information related to the automatic driving of the construction machinery. In this 12th aspect, the operator can confirm the status of the automatic driving of the construction machinery after leaving the location by checking the information displayed on the external display of the external device.

[0173] Ideally, the automatic driving control system according to the 13th aspect of this disclosure, in addition to the automatic driving control system according to the 11th or 12th aspects, also includes the following structure: That is, ideally, in the automatic driving control system according to the 13th aspect, the external device includes an external input device, which is an input device capable of accepting input operations for at least one change of the target position and the basic speed. In this 13th aspect, if the set target position does not conform to the actual work site conditions, the operator can change the target position to a target position that conforms to the actual work site conditions by applying an input operation to the external input device. Furthermore, if the set basic speed does not conform to the actual work site conditions, the operator can change the basic speed to a basic speed that conforms to the actual work site conditions by applying an input operation to the external input device.

[0174] The 14th aspect of this disclosure relates to an automatic driving control method that controls the movement of multiple movable parts of an engineering machine based on multiple target positions set for automatic driving of the engineering machine. The automatic driving control method includes the following steps: setting a basic speed for each of the multiple movable parts; obtaining actual posture values ​​related to the actual postures of each of the multiple movable parts; using the basic speeds, calculating ideal posture values ​​related to the ideal postures of each of the multiple movable parts; using the difference between the ideal posture values ​​and the actual posture values, calculating correction values ​​for correcting the basic speeds of each of the multiple movable parts; and outputting an operation quantity corresponding to the value obtained by correcting the basic speeds of each of the multiple movable parts using the correction values ​​to the controlled object in the automatic driving.

[0175] The 15th aspect of this disclosure relates to an automatic driving control program that controls the movement of multiple movable parts of the construction machinery based on multiple target positions set for automatic driving of the construction machinery. The automatic driving control program instructs a computer to perform the following processes: setting a basic speed for the multiple movable parts; obtaining actual posture values ​​related to the actual postures of each of the multiple movable parts; calculating ideal posture values ​​related to the ideal postures of each of the multiple movable parts using the basic speeds; calculating correction values ​​for correcting the basic speeds of each of the multiple movable parts using the difference between the ideal posture values ​​and the actual posture values; and outputting an operation quantity corresponding to the value obtained by correcting the basic speeds of each of the multiple movable parts using the correction values ​​to the controlled object in the automatic driving process.

Claims

1. An automatic driving control device, comprising a controller, the controller controlling the movement of multiple movable parts of the construction machinery based on multiple target positions set for automatic driving of the construction machinery, characterized in that... The controller Set the basic speed for each of the plurality of movable parts. Obtain the actual posture values ​​related to the actual postures of each of the plurality of movable parts. Using the aforementioned basic velocity, ideal posture values ​​related to the ideal postures of each of the plurality of movable parts are calculated. The difference between the ideal posture value and the actual posture value is used to calculate correction values ​​for adjusting the basic velocities of each of the plurality of movable parts. The operation quantity corresponding to the value obtained by correcting the basic speed of each of the plurality of movable parts using the correction value is output to the control object in the automatic driving.

2. The automatic driving control device according to claim 1, characterized in that, The controller The target time for a specific part of the engineering machinery to move from the k-th target position to the (k+1)-th target position among the multiple target positions is set, which is the movement time between the two points. Using information related to the posture of the movable part at the k-th target position, information related to the posture of the movable part at the (k+1)-th target position, and the movement time between the two points, the basic speed is set for the plurality of movable parts respectively.

3. The automatic driving control device according to claim 1 or 2, characterized in that, The controller outputs a value corresponding to the sum of the base speed and the correction value as the operational quantity.

4. The automatic driving control device according to any one of claims 1 to 3, characterized in that, It also includes a memory for storing trajectory data of specific parts of the engineering machinery. The controller uses the trajectory data to set the multiple target locations.

5. The automatic driving control device according to any one of claims 1 to 4, characterized in that, The plurality of movable parts include the upper rotating body of the engineering machinery or a rotating associated device associated with the rotation of the upper rotating body. The controller sets the basic rotation speed of the upper rotating body or the rotation associated device as the basic speed, and calculates a rotation correction value for correcting the basic rotation speed as the correction value.

6. The automatic driving control device according to claim 5, characterized in that, The controller sets the basic rotational speed in the final stage of the rotation of the upper rotating body to a value smaller than the basic rotational speed in the initial stage of the rotation of the upper rotating body.

7. The automatic driving control device according to any one of claims 1 to 6, characterized in that, The multiple target positions include: target positions that prioritize reducing changes in motion speed (i.e., change reduction priority target positions) and target positions that prioritize positional accuracy (i.e., accuracy priority target positions). The controller sets the base velocity with respect to the accuracy-priority target position to a value smaller than the base velocity with respect to the variation-reduction-priority target position.

8. The automatic driving control device according to any one of claims 1 to 7, characterized in that, The controller Calculate the vector from the k-th target position to the (k+1)-th target position among the plurality of target positions. The movement of the plurality of movable parts is controlled in such a way that specific parts of the engineering machinery move along the vector.

9. The automatic driving control device according to any one of claims 1 to 8, characterized in that, It also includes an input device capable of accepting input operations for at least one of the changes to the target position and the basic speed.

10. An engineering machinery, characterized in that... include: Lower walking body; The upper rotating body is rotatably supported by the lower traveling body; The working device can be supported undulatingly on the upper rotating body; A posture detector detects the actual posture value; as well as The automatic driving control device according to any one of claims 1 to 9.

11. An automatic driving control system, characterized in that... include: The automatic driving control device according to any one of claims 1 to 9; as well as External devices are capable of communicating with the autonomous driving control device.

12. The automatic driving control system according to claim 11, characterized in that, The external device includes an external display, which is a display that shows information related to the autonomous driving of the construction machinery.

13. The automatic driving control system according to claim 11 or 12, characterized in that, The external device includes an external input device that is capable of accepting input operations for at least one of the changes in the target position and the basic speed.

14. An automatic driving control method, which controls the movement of multiple movable parts of construction machinery based on multiple target positions set for automatic driving of construction machinery, characterized in that... Includes the following steps: Set the basic speed for each of the plurality of movable parts; Obtain the actual posture value related to the actual posture of each of the plurality of movable parts; Using the basic velocity, calculate the ideal posture value related to the ideal posture of each of the plurality of movable parts; Using the difference between the ideal posture value and the actual posture value, a correction value is calculated to correct the basic velocity of each of the plurality of movable parts; as well as The operation quantity corresponding to the value obtained by correcting the basic speed of each of the plurality of movable parts using the correction value is output to the control object in the automatic driving.

15. An automatic driving control program, based on multiple target positions set for the automatic driving of construction machinery, controls the movement of multiple movable parts of the construction machinery, characterized in that, Instruct the computer to perform the following process: Processing for setting the basic speed of the plurality of movable parts; Processing to obtain actual posture values ​​related to the actual postures of each of the plurality of movable parts; The processing of calculating ideal posture values ​​related to the ideal postures of the plurality of movable parts using the basic velocity; The difference between the ideal posture value and the actual posture value is used to calculate the correction value for correcting the basic velocity of each of the plurality of movable parts; as well as The process of outputting an operational quantity corresponding to the value obtained by correcting the basic speed of each of the plurality of movable parts using the correction value to the control object in the automatic driving.

Citation Information

Patent Citations

  • Automatic operation shovel and automatic operation method thereof

    JP1999264155A