Articulated vehicle

By using its own position sensors and control devices to calculate the axle reference point position and target track in the articulated vehicle, the problem of snake travel and low following accuracy during automatic driving of the articulated vehicle is solved, and higher path following accuracy and stability are achieved.

CN119072429APending Publication Date: 2024-12-03HITACHI CONSTRUCTION MACHINERY CO LTD
View PDF 0 Cites 1 Cited by

Patent Information

Application Number
CN202380027565.6
Authority / Receiving Office
CN · China
Patent Type
Applications(China)
Current Assignee / Owner
Priority Date
2022-03-24
Filing Date
2023-03-03
Publication Date
2024-12-03

AI Technical Summary

Technical Problem

The articulated vehicle is snaked due to the delay in steering control intervention when it is automatically driven, and the vehicle body position error within the allowable range of position deviation reduces the following accuracy of the target path.

Method used

Using an articulated vehicle with its own position sensor and control device, by calculating the reference point position of the axle and the target track of the traveling track, the bending amount of the front frame relative to the rear frame is calculated to control steering, ensuring that the vehicle follows on the traveling direction side. Target track.

Benefits of technology

It improves the following accuracy of the target path, suppresses snake driving, and enhances the stability and accuracy of the vehicle during automatic driving.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure CN119072429A_ABST
    Figure CN119072429A_ABST
Patent Text Reader

Abstract

An articulated vehicle is provided with a front frame and a rear frame which are connected so as to be rotatable in the left-right direction, and is provided with a control device for controlling the operation of the articulated vehicle. The control device sets a reference point of the articulated vehicle on the axle or on the travel direction side of the axle on a straight line passing through the left and right centers of the axle of the wheels of the vehicle frame on the travel direction side of the front frame and the rear frame in the front-rear direction perpendicular to the axle, and calculates the position of the reference point on the work site. The control device calculates a steering control amount, which is an amount of bending of the front frame with respect to the rear frame, on the basis of a target trajectory predetermined as a travel trajectory of the articulated vehicle and the position of the reference point in the work site. As a result, it is possible to improve the following accuracy with respect to the target route and to suppress hunting.
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to articulated vehicles. Background Art

[0002] Articulated vehicles have been used in construction sites, but there is a growing demand for autonomous driving of articulated vehicles due to a shortage of operators. As autonomous driving of articulated vehicles becomes more common, they require non-snaking path-following performance from the perspective of fuel economy and cycle time.

[0003] In the automatic driving of an articulated vehicle, as a technology for suppressing snake behavior with respect to a driving target path, for example, the technology described in Patent Document 1 is known. Patent Document 1 discloses an autonomous driving control device, which controls an autonomously driving construction machine, outputs a control signal for correcting the traveling direction of the construction machine in a manner close to the traveling reference line when the distance from the traveling reference line to the construction machine is greater than a predetermined first threshold, and outputs a control signal for making the traveling direction of the construction machine parallel to the traveling reference line when the distance from the traveling reference line to the construction machine is less than a second threshold, the second threshold being the same as or smaller than the first threshold.

[0004] Prior art literature

[0005] Patent Literature

[0006] Patent Document 1: Japanese Patent Application Publication No. 2017-204089 Summary of the invention

[0007] Problems to be solved by the invention

[0008] However, in the above-mentioned prior art, the reference point of the own position is also considered to be on the rear side relative to the center of the axle of the frame on the front side of the traveling direction compared to the curved portion. Therefore, in an articulated vehicle in which the rear vehicle moves in a manner following the frame on the front side of the traveling direction, there is a problem that the control intervention of the steering is delayed from the target path and the snaking occurs. In addition, although the traveling direction of the vehicle body is maintained parallel to the traveling target path, the error of the vehicle body position relative to the traveling target path is allowed if it is within the allowable range of position deviation, so there is room for improvement in the following accuracy of the target path.

[0009] The present invention has been made in view of the above circumstances, and an object of the present invention is to provide an articulated vehicle capable of improving the following accuracy to a target path and suppressing meandering.

[0010] Means for solving problems

[0011] The present application includes a plurality of solutions to the above-mentioned problems, and an example is given. An articulated vehicle comprises: a front frame having a pair of left and right wheels; and a rear frame connected to the front frame in a manner that allows rotation in the left and right directions and having a pair of left and right wheels, the articulated vehicle comprises: an own position sensor that detects a position at a work site; and a control device that controls the movement of the articulated vehicle, the control device sets a reference point of the articulated vehicle on the axle or closer to the travel direction side than the axle on a straight line that passes through the left and right centers of the axles of the wheels of the frames on the travel direction side of the front and rear frames in the front and rear directions perpendicular to the axles, calculates the position of the reference point at the work site based on the detection result of the own position sensor, and calculates the bending amount of the front frame relative to the rear frame, i.e., the steering control amount, based on a target track predetermined as the travel track of the articulated vehicle and the position of the reference point at the work site.

[0012] Effects of the Invention

[0013] According to the present invention, it is possible to improve the accuracy of following a target path and suppress meandering. BRIEF DESCRIPTION OF THE DRAWINGS

[0014] Figure 1 It is a side view schematically showing a wheel loader.

[0015] Figure 2 It is a top view schematically showing a wheel loader.

[0016] Figure 3 This is a diagram showing the travel drive system of the wheel loader extracted together with the control device and related structures.

[0017] Figure 4 This is a functional block diagram showing the functions of the automatic driving controller according to the first embodiment together with related structures extracted.

[0018] Figure 5 1 is a diagram showing an example of setting the reference points for the vehicle body, and is a diagram showing an example of setting the reference points when the vehicle is moving forward.

[0019] Figure 6 1 is a diagram showing an example of setting the reference point for the vehicle body, and is a diagram showing an example of setting the reference point when moving backward.

[0020] Figure 7 This is a functional block diagram showing the functions of the automatic driving controller according to the second embodiment together with related structures extracted.

[0021] Figure 8 This is a flowchart showing the processing contents of the reference point switching unit.

[0022] Fig. 9 This is a flowchart showing the processing contents of the reference point correction amount calculation unit.

[0023] Fig.10 This is a functional block diagram showing the functions of the automatic driving controller according to the third embodiment together with related structures extracted.

[0024] Fig.11 This is a flowchart showing the processing contents of the reference point switching unit.

[0025] Fig.12 This is a functional block diagram showing the functions of the automatic driving controller according to the fourth embodiment together with related structures extracted.

[0026] Fig.13 This is a flowchart showing the processing contents of the target position calculation unit.

[0027] Fig.14 This is a flowchart showing the processing contents of the reference point switching unit.

[0028] Fig.15 This is a flowchart showing the processing contents of the route plan setting unit.

[0029] Fig.16 : is a flowchart showing the processing contents of the reference point switching determination unit.

[0030] Fig.17 This is a functional block diagram showing the functions of the automatic driving controller according to the fifth embodiment together with related structures extracted.

[0031] Fig.18 This is a flowchart showing the processing contents of the reference point correction amount calculation unit.

[0032] Fig.19 : is a flowchart showing the processing contents of the reference point switching determination unit.

[0033] Fig. 20 This is a flowchart showing the processing contents of the speed control instruction calculation unit. DETAILED DESCRIPTION

[0034] Hereinafter, embodiments of the present invention will be described with reference to the accompanying drawings. In addition, in the following description, a wheel loader is exemplified as an articulated vehicle for description, but it is not limited thereto, and the invention of the present application can also be applied to other articulated working machines. In addition, in the following description, when there are multiple identical components, sometimes letters are marked at the end of the figure mark (number), but sometimes the letters are omitted and the multiple components are collectively described. For example, when there is a pair of left and right front wheels 5a, 5b, they are sometimes collectively referred to as front wheels 5.

[0035] <First Embodiment>

[0036] Reference Figure 1 to Figure 4 , describing the first embodiment of the present invention.

[0037] Figure 1 FIG. 1 is a side view schematically showing the wheel loader according to the present embodiment. Figure 2 is a top view. In addition, Figure 3 In the following description, unless otherwise specified, the front, rear, left, and right sides of the wheel loader 1 are based on the viewpoint of the operator riding on the wheel loader 1 to operate it.

[0038] exist Figure 1 and Figure 2 In the embodiment, the wheel loader 1 is composed of a front frame 2 and a rear frame 3. A pair of left and right lifting arms 8 and a bucket 7 and a pair of left and right wheels (front wheels 5a, 5b) are mounted on the front frame 2. A cab 4 for an operator to ride on and a pair of left and right wheels (rear wheels 6a, 6b) are mounted on the rear frame 3. The front frame 2 and the rear frame 3 are connected by a center pin 9 so as to be rotatable in the left and right directions. In addition, the front frame 2 and the rear frame 3 are connected by a pair of left and right steering cylinders 10a, 10b.

[0039] The front wheels 5a, 5b and the rear wheels 6a, 6b are driven by the engine 11 (see below). Figure 3 ) power to rotate the driving wheels. A pair of left and right lifting arms 8a, 8b are separately mounted on the front end of the front frame 2 of the wheel loader 1 in the width direction (left and right direction). In addition, a bucket 7 is connected to the front end of the pair of left and right lifting arms 8a, 8b so as to be able to rotate in the vertical direction, and the rear end is connected to the front end of the front frame 2 so as to be able to rotate in the vertical direction. By extending one of the pair of left and right steering cylinders 10a, 10b and retracting the other, the front frame 2 and the rear frame 3 are bent in the left and right directions around the center pin 9.

[0040] exist Figure 3 In FIG. 1 , the wheel loader 1 is roughly composed of an engine 11 , a torque converter 12 , a transmission 13 , a brake 14 , a hydraulic pump 15 , a drive shaft 16 , an axle 17 , an operating device 20 , a control device 30 , and a hydraulic circuit 40 .

[0041] The engine 11 is a prime mover that generates driving force by burning fossil fuel, for example.

[0042] The torque converter 12 is connected to the output shaft of the engine 11 and the input shaft of the transmission 13 , and adjusts the driving force transmitted from the engine 11 to the transmission 13 , that is, transmits a part of the driving force of the engine 11 to the transmission 13 .

[0043] The transmission 13 changes the speed of the driving force of the engine 11 transmitted via the torque converter 12, and transmits the changed driving force to the drive wheels (front wheels 5a, 5b and rear wheels 6a, 6b) via the drive shaft 16 and the axle 17. In addition, the transmission 13 can be switched between a forward state in which the drive wheels are rotated in a direction in which the wheel loader 1 moves forward and a reverse state in which the drive wheels are rotated in a direction in which the wheel loader 1 moves backward.

[0044] Brakes 14a, 14b, 14c, and 14d brake the rotation of the front wheels 5a, 5b and the rear wheels 6a, 6b. The brakes 14 are provided at four locations corresponding to the wheels in order to brake the front wheels 5a, 5b and the rear wheels 6a, 6b, respectively.

[0045] The hydraulic pump 15 is connected to and driven by the output shaft of the engine 11. The hydraulic pump 15 pressure-feeds hydraulic oil stored in a hydraulic oil tank (not shown) to the hydraulic circuit 40 using the driving force transmitted from the engine 11.

[0046] The hydraulic circuit 40 is composed of a directional switching valve, etc., and controls the flow and direction of the working oil discharged from the hydraulic pump 15 and supplied to the hydraulic actuator (brake 14, steering cylinder 10a, 10b) according to the operation signal output from the operating device 20 or the control signal output from the control device 30.

[0047] The operating device 20 operates the wheel loader 1 by outputting an operation signal corresponding to an operator's operation to the control device 30 , and includes, for example, an accelerator pedal 21 , a forward / reverse instruction switch 22 , a brake pedal 23 , a steering wheel 24 , and the like.

[0048] The accelerator pedal 21 adjusts the rotation speed of the engine 11 in accordance with the operation of the operator. The accelerator pedal 21 outputs an operation signal indicating the amount of depression by the operator to the control device 30.

[0049] The forward / reverse indication switch 22 is an alternating switch that indicates the traveling direction state of the wheel loader 1 according to the operator's operation. For example, when the forward / reverse indication switch 22 is switched to the forward position, the transmission 13 is switched to the forward state. In addition, when the forward / reverse indication switch 22 is switched to the reverse position, the transmission 13 is switched to the reverse state. The forward / reverse indication switch 22 outputs an operation signal indicating the current position to the control device 30.

[0050] The brake pedal 23 adjusts the braking force of the brake 14 in accordance with the operation of the operator. The brake pedal 23 outputs an operation signal indicating the amount of depression by the operator to the control device 30.

[0051] The steering wheel 24 extends and retracts the steering cylinders 10a and 10b according to the operator's operation. For example, when the operator rotates the steering wheel 24 to the right (clockwise), the steering cylinder 10a on the left side extends and the steering cylinder 10b on the right side retracts, thereby causing the front frame 2 to bend to the right relative to the rear frame 3. On the other hand, when the operator rotates the steering wheel 24 to the left (counterclockwise), the steering cylinder 10a on the left side retracts and the steering cylinder 10b on the right side extends, thereby causing the front frame 2 to bend to the left relative to the rear frame 3. The steering wheel 24 outputs the rotation direction and the operation signal corresponding to the rotation direction to the control device 30.

[0052] The control device 30 controls the operation of the wheel loader 1 based on the operation signal output from the operation device 20 and the detection signal output from various sensors described later. In addition, although not shown in the figure, the control device 30 has a CPU (Central Processing Unit), a ROM (Read Only Memory) and a RAM (Random Access Memory). Moreover, the control device 30 realizes each functional module described later by reading and executing the program code stored in the ROM by the CPU. The RAM is used as a working area when the CPU executes the program. However, the specific structure of the control device 30 is not limited to this, and it can also be realized by other hardware.

[0053] The control device 30 includes, for example, an engine controller 31, a transmission controller 32, a vehicle body controller 33, and an automatic driving controller 34. For example, the engine controller 31, the transmission controller 32, and the vehicle body controller 33 may be independent hardware, connected to each other via a CAN (Controller Area Network) so as to be able to communicate with each other. As another example, the engine controller 31, the transmission controller 32, and the vehicle body controller 33 may also be configured to be implemented by the CPU executing programs stored in the ROM, respectively.

[0054] The engine controller 31 increases or decreases the rotation speed of the engine 11 according to an operation signal indicating the amount of depression of the accelerator pedal 21. The transmission controller 32 switches the state of the transmission 13 between the forward state and the reverse state according to an operation signal indicating the position of the forward / reverse indication switch 22. The vehicle body controller 33 controls the braking force of the brake 14 according to an operation signal indicating the amount of depression of the brake pedal 23.

[0055] (Automatic driving controller 34)

[0056] Figure 4 This is a functional block diagram that extracts the functions of the automatic driving controller together with the related structures.

[0057] exist Figure 4 , the automatic driving controller 34 includes a reference point correction amount calculation unit 101, an own position calculation unit 102, a target track setting unit 103, and a steering control command calculation unit 104. The automatic driving controller 34 controls the automatic driving of the wheel loader 1 (including the assistance of the operator), controls the operation of the hydraulic circuit 40 based on the detection signal output from the own position sensor 50, and thereby controls the operation of the steering cylinders 10a, 10b, the brakes 14a, 14b, 14c, 14d, etc.

[0058] The self-position sensor 50 detects the self-position of the body of the wheel loader 1 and outputs it to the self-position calculation unit 102 as self-position information. The self-position sensor 50 is, for example, a GNSS (Global Navigation Satellite System), and outputs the current latitude and longitude coordinates as a positioning result. In addition, the self-position sensor 50 is not limited to this, and can also be implemented by other means. Here, the self-position detected by the self-position sensor 50 is, for example, the position of the GNSS antenna installed in the wheel loader 1.

[0059] The reference point correction amount calculation unit 101 calculates a reference point correction amount for correcting the self position detected by the self position sensor 50 to the position of a reference point set in the wheel loader 1 , and outputs the calculated reference point correction amount to the self position calculation unit 102 .

[0060] Figure 5 as well as Figure 6 An example of setting the reference point for the vehicle body is shown. Figure 5 This shows an example of setting the reference point when moving forward. Figure 6 This shows an example of setting the reference point when retreating.

[0061] like Figure 5 As shown, when the wheel loader 1 moves forward, the front frame 2 is at the front (travel direction side) and the rear frame 3 is at the rear. At this time, a reference point is set at the left-right center of the frame (i.e., the front frame 2) located at the front (travel direction side). More specifically, a reference point is set between the axles of the front wheels 5a, 5b and the front end of the bucket 7 on a straight line 100 that passes through the left-right centers of the axles (axles 17a, 17b) of the wheels (front wheels 5a, 5b) of the frame (front frame 2) located at the travel direction side of the front frame 2 and the rear frame 3 in the front-rear direction perpendicular to the axles.

[0062] like Figure 6As shown, when the wheel loader 1 moves backward, the rear frame 3 is at the front (travel direction side) and the front frame 2 is at the rear. At this time, a reference point is set at the left-right center of the frame (i.e., the rear frame 3) located at the front (travel direction side). More specifically, a reference point is set between the axles of the rear wheels 6a, 6b and the rear end (the end on the travel direction side) of the rear frame 3 on a straight line 100 that passes through the left-right centers of the axles of the wheels (rear wheels 6a, 6b) of the frame (rear frame 3) located at the travel direction side of the front frame 2 and the rear frame 3 in the front-rear direction perpendicular to the axles.

[0063] The self-position calculation unit 102 calculates the position of the reference point at the work site (i.e., the coordinate position in the work site coordinate system or the earth coordinate system) based on the signal from the self-position sensor 50 (self-position information) and the calculation result (reference point correction amount) of the reference point correction amount calculation unit 101, and outputs it to the steering control instruction calculation unit 104.

[0064] The target track setting unit 103 sets a target track for the wheel loader 1 to travel, sets a target position on the target track, and outputs the target position to the steering control command calculation unit 104. The target track setting unit 103 forms a target track by, for example, arranging a plurality of target coordinates in advance, and outputs one target coordinate in the target track as the target position. In addition, the method for setting the target track and the target position by the target track setting unit 103 is not limited to this, and other methods may be used to achieve it.

[0065] The steering control command calculation unit 104 calculates the bending angle of the vehicle body as a steering control amount based on the position of the reference point from the own position calculation unit 102 and the target position from the target track setting unit 103, and outputs it as a control command to the hydraulic circuit 40. That is, the control command output from the steering control command calculation unit 104 is a command to control the direction switching valve used to control the direction and flow rate of the working oil supplied to the steering cylinders 10a and 10b.

[0066] Here, the bending angle of the vehicle body refers to the bending amount of the front frame 2 and the rear frame 3. When the axles of the front wheels 5a and 5b are parallel to the axles of the rear wheels 6a and 6b, that is, when the front frame 2 and the rear frame 3 are straight, the bending angle is 0 (zero). For example, in the case of a turning travel of the wheel loader 1 such that the reference point passes through the target position, the angle formed by the straight line connecting the turning center position and the target position and the straight line connecting the turning center position and the position of the reference point, that is, the angle at the turning center position is set as the bending angle of the vehicle body, and the bending angle of the vehicle body is calculated by the steering control command calculation unit 104. However, the calculation method of the bending angle by the steering control command calculation unit 104 is not limited to this, and it can also be realized by other methods.

[0067] The effects of the present embodiment configured as described above will be described.

[0068] In an articulated vehicle, when the reference point of the vehicle's position is located at the rear side relative to the center of the axle of the frame located at the front side of the travel direction relative to the curved portion, when the vehicle at the rear side is controlled to follow the frame at the front side of the travel direction, there is a problem that the steering control intervention is delayed from disengaging from the target path, thereby causing snaking. In addition, when the vehicle is controlled to maintain the travel direction of the vehicle body parallel to the travel target path, the error of the vehicle body position relative to the travel target path is allowed if it is within the allowable range of position deviation, so there is a problem that the accuracy of following the target path is reduced.

[0069] In contrast, in the present embodiment, a reference point of the wheel loader 1, which is an articulated vehicle, is set on the axle or on the side in the direction of travel of the axle on a straight line passing through the left-right centers of the axles of the wheels of the frames on the traveling direction side of the front frame 2 and the rear frame 3 in the front-to-rear direction perpendicular to the axle, the position of the reference point at the work site is calculated based on the detection result of the self-position sensor, and the bending amount of the front frame 2 relative to the rear frame 3, that is, the steering control amount, is calculated based on the target track predetermined as the travel track of the wheel loader 1 and the position of the reference point at the work site. Thus, the distance from the left and right center of the axle (axle 17a, 17b) of the wheel of the frame (front frame 2 or rear frame 3) located on the side of the traveling direction (front) to the target track becomes less than the distance from the left and right center of the axle of the wheel of the frame (front frame 2 or rear frame 3) located on the side opposite to the traveling direction (rear) to the target track, so that the frame located on the side of the traveling direction (front) does not follow the target track in a zigzag manner relative to the target track. That is, the following accuracy with respect to the target path can be improved, and zigzag travel can be suppressed.

[0070] <Second Embodiment>

[0071] Reference Figure 7 to Figure 9 , describing the second embodiment of the present invention.

[0072] The wheel loader of this embodiment sets the reference point of the wheel loader according to the travel direction based on the instruction from the forward and reverse instruction switch switched by the operator. In this embodiment, the same reference numerals are used for the same structures as those in the first embodiment, and the description thereof is omitted.

[0073] Figure 7 This is a functional block diagram showing the functions of the automatic driving controller according to the present embodiment together with related structures extracted.

[0074] exist Figure 7In FIG. 5 , the automatic driving controller 34A includes a reference point switching unit 505 , a reference point correction amount calculation unit 501 , a self-position calculation unit 102 , a target trajectory setting unit 103 , and a steering control command calculation unit 104 .

[0075] The reference point switching unit 505 receives the operation signal from the forward / reverse instruction switch 22 , determines whether the transmission 13 is in the forward state or the reverse state, and outputs the determination result to the reference point correction amount calculation unit 501 .

[0076] Figure 8 This is a flowchart showing the processing contents of the reference point switching unit.

[0077] exist Figure 8 When the reference point switching unit 505 of the automatic driving controller 34A detects the operation signal from the forward / reverse instruction switch 22 (step S100), it determines whether the detected operation signal from the forward / reverse instruction switch 22 is a signal indicating the forward position (step S110).

[0078] If the determination result in step S110 is "YES", the determination result that the transmission 13 is in the forward state is output to the reference point correction amount calculation unit 501 (step S120), and the processing ends.

[0079] If the determination result in step S110 is "No", the determination result that the transmission 13 is in the reverse state is output to the reference point correction amount calculation unit 501 (step S130), and the processing ends.

[0080] The reference point correction amount calculation unit 501 calculates the reference point correction amount based on the determination result from the reference point switching unit 505 , that is, whether the transmission 13 is in the forward state or the reverse state, and outputs the reference point correction amount as the calculation result to the own position calculation unit 102 .

[0081] Fig. 9 This is a flowchart showing the processing contents of the reference point correction amount calculation unit.

[0082] exist Fig. 9 In the process, first, the reference point correction amount calculation unit 501 of the automatic driving controller 34 obtains the determination result from the reference point switching unit 505 (step S200), and determines whether the determination result indicates a forward movement state (step S210).

[0083] If the judgment result in step S210 is "yes", the reference point correction amount during forward movement, that is, the reference point correction amount when the reference point is set between the axle of the front wheel 5 and the front end of the bucket 7 on a straight line passing through the left and right centers of the axle of the front wheel 5 of the front frame 2 on the traveling direction side in the front and rear directions perpendicularly to the axle, is output to the self-position calculation unit 102 (step S220), and the processing is ended.

[0084] In addition, when the judgment result in step S210 is "No", the reference point correction amount when retreating, that is, the reference point correction amount when the reference point is set between the axle of the rear wheel 6 and the rear end of the rear frame 3 (the end on the traveling direction side) on a straight line passing through the left and right centers of the axle of the rear wheel 6 of the rear frame 3 on the traveling direction side in the front-to-back direction perpendicular to the axle, is output to the self-position calculation unit 102 (step S230), and the processing is terminated.

[0085] The other structures are the same as those of the first embodiment.

[0086] In the present embodiment configured as above, the same effects as those of the first embodiment can be obtained.

[0087] Furthermore, since the reference point is corrected (switched) in accordance with the operator's operation of the forward / reverse instruction switch 22, it is possible to more reliably improve the accuracy of following the target path and suppress meandering.

[0088] <Third Embodiment>

[0089] Reference Fig.10 and Fig.11 , describing the third embodiment of the present invention.

[0090] The wheel loader of this embodiment is configured to set the reference point of the wheel loader based on the detection result from the vehicle body information acquisition sensor, wherein the vehicle body information acquisition sensor detects the vehicle body information (acceleration direction) for detecting the direction of travel (forward, backward) of the vehicle. In addition, in this embodiment, the same reference numerals are attached to the same structures as those in the first and second embodiments, and the description thereof is omitted.

[0091] Fig.10 This is a functional block diagram showing the functions of the automatic driving controller according to the present embodiment together with related structures extracted.

[0092] exist Fig.10 In FIG. 8 , the automatic driving controller 34B includes a reference point switching unit 805 , a reference point correction amount calculation unit 501 , a self-position calculation unit 102 , a target trajectory setting unit 103 , and a steering control command calculation unit 104 .

[0093] The reference point switching unit 805 determines whether the transmission 13 is in the forward state or the reverse state based on the detection result from the vehicle body information acquisition sensor 51 , and outputs the determination result to the reference point correction amount calculation unit 501 .

[0094] The vehicle body information acquisition sensor 51 is a device capable of detecting acceleration, such as an IMU (Inertial Measurement Unit), and is provided on the wheel loader 1 in such a manner that it detects positive acceleration when the wheel loader 1 moves forward (i.e., in the direction of the front frame 2), and detects negative acceleration when the wheel loader 1 moves backward (i.e., in the direction of the rear frame 3) and outputs the acceleration. However, the structure of the vehicle body information acquisition sensor 51 is not limited thereto, and it may also be configured to be implemented by other means. For example, as a sensor for detecting the traveling direction of the wheel loader 1, the following sensors may be used according to the type of the travel device. If it is a vehicle with a torque converter transmission, it may be a rotation sensor built into the transmission, if it is an electric vehicle that travels by the driving force of an electric motor, it may be a rotary transformer of the electric motor, and if it is an HST vehicle composed of a hydraulic pump and a hydraulic motor, it may be a tilt angle sensor of the hydraulic pump and the hydraulic motor. In addition, a controller for the travel device may be provided separately, and the traveling direction may be received from the controller for the travel device.

[0095] Fig.11 This is a flowchart showing the processing contents of the reference point switching unit.

[0096] exist Fig.11 In the process, when the reference point switching unit 805 of the automatic driving controller 34A obtains the detection result from the vehicle body information acquisition sensor 51 (step S300), it determines whether the obtained detection result, that is, the acceleration, is positive (step S310).

[0097] If the result of determination in step S310 is "yes", that is, if it is determined that the acceleration is positive and the wheel loader 1 is moving toward the front frame 2, the result of determination that the transmission 13 is in the forward state is output to the reference point correction amount calculation unit 501 (step S320), and the processing ends.

[0098] In addition, when the determination result in step S310 is "No", that is, when it is determined that the acceleration is negative and the wheel loader 1 is moving toward the rear frame 3 side, the determination result that the transmission 13 is in the reverse state is output to the reference point correction amount calculation unit 501 (step S330), and the processing is terminated.

[0099] The reference point correction amount calculation unit 501 calculates the reference point correction amount based on the determination result from the reference point switching unit 805 , that is, whether the transmission 13 is in the forward state or the reverse state, and outputs the reference point correction amount as the calculation result to the own position calculation unit 102 .

[0100] The other structures are the same as those of the first and second embodiments.

[0101] In the present embodiment configured as described above, it is also possible to obtain the same effects as those of the first and second embodiments.

[0102] Furthermore, since the reference point is corrected (switched) based on the detection result of the travel of the wheel loader 1 by the vehicle information acquisition sensor 51, it is possible to more reliably improve the following accuracy of the target path and suppress meandering.

[0103] <Fourth Embodiment>

[0104] Reference Figure 12 to Figure 16 , describing the fourth embodiment of the present invention.

[0105] The wheel loader of this embodiment is configured to set the reference point of the wheel loader 1 according to the travel direction determined based on the position of the reference point at the work site and the target position, and when the reference point is changed, the path plan is switched according to the position of the reference point in the articulated vehicle. In addition, in this embodiment, the same reference numerals are attached to the same structures as those in the first to third embodiments, and the description thereof is omitted.

[0106] Fig.12 This is a functional block diagram showing the functions of the automatic driving controller according to the present embodiment together with related structures extracted.

[0107] exist Fig.12 In the figure, the automatic driving controller 34C has a reference point switching unit 1005, a path plan setting unit 1006, a reference point switching determination unit 1007, a reference point correction amount calculation unit 501, a self-position calculation unit 102, a target position calculation unit 1003 and a steering control instruction calculation unit 104.

[0108] The target position calculation unit 1003 calculates the target position based on the position of the reference point from the own position calculation unit 102 and the path plan from the path plan setting unit 1006 , and outputs the calculation result to the steering control command calculation unit 104 and the reference point switching determination unit 1007 .

[0109] Fig.13 This is a flowchart showing the processing contents of the target position calculation unit.

[0110] exist Fig.13In the process, first, the target position calculation unit 1003 of the automatic driving controller 34C obtains the calculation results from the own position calculation unit 102 and the path plan setting unit 1006 (step S400), and calculates the target position according to the position of the reference point from the own position calculation unit 102 and the target coordinates of the path plan from the path plan setting unit 1006 (step S410). The calculation of the target position in the target position calculation unit 1003 is performed, for example, in the following manner: based on the current position of the reference point and the current target coordinates, the path is interpolated by a spline function, and the position after advancing a certain distance on the interpolated path from the current reference point is used as the target position. However, the calculation method of the target position is not limited to this, and it can also be configured to be implemented using other methods.

[0111] When the process of step S410 is completed, the target position calculated in step S410 is output to the steering control command calculation unit 104 and the reference point switching determination unit 1007 (step S420), and the process is completed.

[0112] The reference point switching unit 1005 receives the determination result of the reference point switching determination unit 1007, and determines whether the wheel loader 1 is in the forward state or the reverse state. The determination result is output to the reference point correction amount calculation unit 501. In addition, the reference point switching determination unit 1007 determines whether the travel direction of the wheel loader 1 is switched based on the position of the reference point from the own position calculation unit 102 and the target position from the target position calculation unit 1003, and outputs the travel state of the wheel loader 1 as the determination result. The details of the processing will be described later.

[0113] Fig.14 This is a flowchart showing the processing contents of the reference point switching unit.

[0114] exist Fig.14 In the process, the reference point switching unit 1005 of the automatic driving controller 34C obtains the determination result from the reference point switching determination unit 1007 (step S500), and determines whether the obtained determination result indicates a forward movement state (step S510).

[0115] If the determination result in step S510 is YES, the determination result that the wheel loader 1 is in the forward state (in other words, the transmission 13 is in the forward state) is output to the reference point correction amount calculation unit 501 (step S520), and the processing ends.

[0116] If the determination result in step S510 is "NO", the determination result that the wheel loader 1 is in the reverse state (in other words, the transmission 13 is in the reverse state) is output to the reference point correction amount calculation unit 501 (step S530), and the processing ends.

[0117] The path plan setting unit 1006 sets the path plan output to the target position calculation unit 1003 based on the determination result from the reference point switching unit 1005. The path plan output to the target position calculation unit 1003 sets the target track for the wheel loader 1 to travel, for example, by arranging the target coordinates in sequence from the starting position to the target arrival position to form the target track. In addition, the path plan setting unit 1006 determines the target coordinates based on the position of the reference point, and thus has different path plans when the wheel loader 1 moves forward and moves backward when the reference points are different. The path plan when moving forward is composed of the target coordinates based on the reference point in the forward state, and the path plan when moving backward is composed of the target coordinates based on the reference point in the backward state. However, the structure of the path plan setting unit 1006 is not limited to this, and can also be configured to be implemented by other means.

[0118] Fig.15 This is a flowchart showing the processing contents of the route plan setting unit.

[0119] exist Fig.15 In the process, the path plan setting unit 1006 of the automatic driving controller 34C obtains the determination result from the reference point switching unit 1005 (step S600), and determines whether the obtained determination result indicates a forward movement state (step S610).

[0120] If the result of determination in step S610 is “Yes”, the path plan corresponding to the reference point when the wheel loader 1 moves forward is output to the target position calculation unit 1003 (step S520 ), and the processing ends.

[0121] If the result of determination in step S610 is "No", the path plan corresponding to the reference point when the wheel loader moves backward is output to the target position calculation unit 1003 (step S630), and the processing ends.

[0122] The reference point switching determination unit 1007 determines the switching of the traveling direction of the wheel loader 1 based on the position of the reference point from the own position calculation unit 102 and the target position from the target position calculation unit 1003, and outputs the determination result to the reference point switching unit 1005. For example, when the initial state is set to the forward state, when the traveling direction of the wheel loader 1 is switched, the determination result indicating the switching to the reverse state is output to the reference point switching unit 1005 as the determination result. At this time, before determining that the traveling direction of the wheel loader 1 is switched, the determination result indicating the forward state is output to the reference point switching unit 1005. However, the specific structure of the reference point switching determination unit 1007 is not limited to this, and it can also be configured to be realized by other means.

[0123] Fig.16: is a flowchart showing the processing contents of the reference point switching determination unit.

[0124] exist Fig.16 In the process, the reference point switching determination unit 1007 of the automatic driving controller 34C obtains the calculation results from the own position calculation unit 102 and the target position calculation unit 1003 (step S700), calculates the vector from the current reference point position of the work site to the target position based on the obtained calculation results (step S710), and calculates the vector from the current reference point position of the work site to the previous reference point position (step S720).

[0125] Next, it is determined whether the angle formed by the vectors calculated in steps S710 and S720 is greater than 90 degrees (step S730). If the determination result is "yes", the determination result indicating the last moving direction state (forward state or backward state) is output to the reference point switching unit 1005 (step S740), and the current reference point position and moving direction state of the work site are recorded (step S760), and the processing ends. The recorded current reference point position and moving direction state are used as the previous reference point position and moving direction state in the next determination processing of the reference point switching determination unit 1007.

[0126] In addition, if the result of the determination in step S730 is "No", it is determined whether the previous traveling direction state is the forward state (step S750). In the case where the result of the determination in step S750 is "Yes", the determination result indicating the backward state is output to the reference point switching unit 1005 (step S751), and the process proceeds to step S760. In addition, if the result of the determination in step S750 is "No", the determination result indicating the forward state is output to the reference point switching unit 1005 (step S752), and the process proceeds to step S760.

[0127] The other structures are the same as those of the first to third embodiments.

[0128] In the present embodiment configured as above, it is also possible to obtain the same effects as those of the first to third embodiments.

[0129] Furthermore, since the reference point correction amount is switched according to the path plan and the position of the reference point, the reference point in the wheel loader 1 can be automatically corrected according to the travel direction, and the following accuracy of the target path can be more reliably improved, and meandering can be suppressed.

[0130] <Fifth Embodiment>

[0131] Reference Figures 17 to 20 , describing the fourth embodiment of the present invention.

[0132] The wheel loader mechanism of this embodiment is configured to calculate the target travel speed of the wheel loader at the work site, i.e., the speed control amount, and brake the wheel loader so that the distance between the target position and the position of the reference point at the work site becomes less than the distance between the target position and the position of the reference point at the work site before the reference point is changed, when the position of the reference point of the vehicle body is changed. In addition, in this embodiment, the same reference numerals are attached to the same structures as those of the first to fourth embodiments, and the description thereof is omitted.

[0133] Fig.17 This is a functional block diagram showing the functions of the automatic driving controller according to the present embodiment together with related structures extracted.

[0134] exist Fig.17 In the figure, the automatic driving controller 34D has a reference point switching unit 1005, a reference point correction amount calculation unit 1501, a path planning setting unit 1506, a reference point switching determination unit 1507, a speed control instruction calculation unit 1508, a self-position calculation unit 102, a target position calculation unit 1003 and a steering control instruction calculation unit 104.

[0135] The reference point correction amount calculation unit 1501 calculates the reference point correction amount based on the determination result from the reference point switching unit 1005, i.e., whether the wheel loader 1 (in other words, the transmission 13) is in the forward state or the reverse state, and outputs the reference point correction amount as the calculation result to the own position calculation unit 102.

[0136] Fig.18 This is a flowchart showing the processing contents of the reference point correction amount calculation unit.

[0137] exist Fig.18 In the process, the reference point correction amount calculation unit 1501 of the automatic driving controller 34D first obtains the determination result from the reference point switching unit 1005 (step S800), and determines whether the determination result indicates a forward movement state (step S810).

[0138] If the judgment result in step S810 is "yes", the reference point correction amount when moving forward, that is, the reference point correction amount when the reference point is set between the axle of the front wheel 5 and the front end of the bucket 7 on a straight line passing through the left and right centers of the axle of the front wheel 5 of the front frame 2 on the traveling direction side in the front and rear directions perpendicularly to the axle, is output to the self-position calculation unit 102 (step S820), and the processing is ended.

[0139] In addition, when the judgment result in step S810 is "No", the reference point correction amount when retreating, that is, the reference point correction amount when the reference point is set between the axle of the rear wheel 6 and the rear end of the rear frame 3 (the end on the traveling direction side) on a straight line passing through the left and right centers of the axle of the rear wheel 6 of the rear frame 3 on the traveling direction side in the front-to-back direction perpendicularly to the axle, is output to the self-position calculation unit 102 (step S830), and the processing is terminated.

[0140] The path plan setting unit 1506 outputs the path plan to the target position calculation unit 1003 .

[0141] The path plan output to the target position calculation unit 1003 sets a target track for the wheel loader 1 to travel, for example, by sequentially arranging target coordinates from the start position to the target arrival position to form the target track. However, the specific structure of the path plan setting unit 1506 is not limited to this, and can also be implemented by other means.

[0142] The reference point switching determination unit 1507 determines the switching of the traveling direction of the wheel loader 1 based on the position of the reference point from the own position calculation unit 102 and the target position from the target position calculation unit 1003, and outputs the determination result to the reference point switching unit 1005. For example, when the initial state is set to the forward state, when the traveling direction of the wheel loader 1 is switched, the determination result indicating the switching to the reverse state is output to the reference point switching unit 1005 as the determination result. At this time, before determining that the traveling direction of the wheel loader 1 is switched, the determination result indicating the forward state is output to the reference point switching unit 1005. However, the specific structure of the reference point switching determination unit 1507 is not limited to this, and it can also be configured to be realized by other means.

[0143] Fig.19 : is a flowchart showing the processing contents of the reference point switching determination unit.

[0144] exist Fig.19 In the process, the reference point switching determination unit 1507 of the automatic driving controller 34D obtains the calculation results from the own position calculation unit 102 and the target position calculation unit 1003 (step S900), and based on the obtained calculation results, calculates the vector from the current reference point position of the work site to the target position (step S910), and calculates the vector from the current reference point position of the work site to the previous reference point position (step S920).

[0145] Next, it is determined whether the angle formed by the vectors calculated in steps S910 and S920 is greater than 90 degrees (step S930). If the determination result is "yes", the determination result indicating the last moving direction state (forward state or backward state) is output to the reference point switching unit 1005 (step S940), and the current reference point position and moving direction state of the work site are recorded (step S960), and the processing ends. The recorded current reference point position and moving direction state are used as the previous reference point position and moving direction state in the next determination processing of the reference point switching determination unit 1507.

[0146] In addition, when the determination result in step S930 is "No", it is determined whether the previous traveling direction state is the forward state (step S950). In the case where the determination result in step S950 is "Yes", the determination result indicating that the traveling direction state has been switched is output to the speed control instruction operation unit 1508, and the determination result indicating the backward state is output to the reference point switching unit 1005 (step S951), and the process proceeds to step S960. In addition, when the determination result in step S950 is "No", the determination result indicating that the traveling direction state has not been switched is output to the speed control instruction operation unit 1508, and the determination result indicating the forward state is output to the reference point switching unit 1005 (step S952), and the process proceeds to step S960.

[0147] The speed control command calculation unit 1508 determines whether it is necessary to control the braking force of the vehicle body based on the position of the reference point from the own position calculation unit 102, the target position from the target position calculation unit 1003, and the determination result from the reference point switching determination unit 1507, and calculates the required control command and outputs it to the hydraulic circuit 40. The control command output to the hydraulic circuit 40 is, for example, a control command of a valve that supplies working oil to a brake pad that clamps the brake disk, when the brake 14 is a structure in which a pair of brake pads clamp a brake disk that rotates integrally with each drive wheel, thereby braking the rotation of the drive wheel. However, the specific structure of the speed control command calculation unit 1508 and the brake 14 is not limited to this, and can also be configured to be implemented by other units.

[0148] Fig. 20 This is a flowchart showing the processing contents of the speed control instruction calculation unit.

[0149] exist Fig. 20 In the process, the speed control instruction calculation unit 1508 of the automatic driving controller 34D obtains the calculation result and the judgment result from the own position calculation unit 102, the target position calculation unit 1003 and the reference point switching judgment unit 1507 (step S1000), and determines whether it is a judgment result indicating that the traveling direction state has been switched (step S1010).

[0150] If the result of determination in step S1010 is "yes", the difference between the position of the reference point obtained from the own position calculation unit 102 and the target position obtained from the target position calculation unit 1003 is calculated (step S1020), and it is determined whether the position difference is less than a predetermined threshold value (step S1030). The threshold value is set to a value such as 1m, for example. However, it is also possible to prepare a correction distance table for the difference between the position of the reference point and the target position in advance based on other features, and determine the threshold value based on the table.

[0151] If the result of determination in step S1030 is "No", as a control command for the brake 14, a command for controlling the valve in the following manner is output to the hydraulic circuit 40, which is to supply the working oil so that the brake pad clamps the brake disc (step S1040), and the process is terminated. The clamping amount of the brake pad on the brake disc is set to about half of the amount of depression of the brake pedal 23, for example.

[0152] If the determination result of step S1010 is "No" or if the determination result of step S1030 is "Yes", no control command to the brake 14 is output (step S1050), and the process ends.

[0153] The other structures are the same as those of the first to fourth embodiments.

[0154] In the present embodiment configured as above, it is also possible to obtain the same effects as those of the first to fourth embodiments.

[0155] Furthermore, in the forward state, the target track can be followed using the center of the bucket 7 in the left and right directions as the reference point of its own position, and when the reference point is switched and the reference point changes so that the error with the target track becomes larger, the vehicle can travel while the braking force generated by the brake 14 is acting until the error can be absorbed. Therefore, sudden movement of the wheel loader 1 associated with the change of the reference point caused by switching between forward and reverse directions can be suppressed, and the following accuracy to the target path can be more reliably improved, and meandering can be suppressed.

[0156] <Notes>

[0157] In addition, the present invention is not limited to the above-mentioned embodiments, and includes various modifications and combinations within the scope of the present invention. In addition, the present invention is not limited to all the structures described in the above-mentioned embodiments, and also includes a structure in which a part of the structure is deleted. In addition, the above-mentioned structures, functions, etc. can also be implemented in part or in whole by, for example, designing with an integrated circuit. In addition, the above-mentioned structures, functions, etc. can also be implemented by software by interpreting and executing a program for implementing each function by a processor.

[0158] Description of Reference Numerals

[0159] 1…wheel loader, 2…front frame, 3…rear frame, 4…cab, 5…front wheel, 6…rear wheel, 7…bucket, 8…lift arm, 9…center pin, 10…steering cylinder, 11…engine, 12…torque converter, 13…transmission, 14…brake, 15…hydraulic pump, 16…drive shaft, 17…axle, 20…operating device, 21…accelerator pedal, 22…forward / reverse indicator switch, 23…brake pedal, 24…steering wheel, 30…control device, 31…engine controller, 32…transmission controller, 33…body controller, 34, 34A, 34B, 34C, 34D…automatic driving controller, 40…hydraulic circuit, 50 …self-position sensor, 51…vehicle information acquisition sensor, 100…straight line, 101…reference point correction amount calculation unit, 102…self-position calculation unit, 103…target trajectory setting unit, 104…steering control command calculation unit, 501…reference point correction amount calculation unit, 505…reference point switching unit, 805…reference point switching unit, 1003…target position calculation unit, 1005…reference point switching unit, 1006…path plan setting unit, 1007…reference point switching determination unit, 1501…reference point correction amount calculation unit, 1506…path plan setting unit, 1507…reference point switching determination unit, 1508…speed control command calculation unit.

Claims

1. An articulated vehicle comprising: a front frame having a pair of left and right wheels; and a rear frame connected to the front frame so as to be rotatable in the left-right direction and having a pair of left and right wheels, It is characterized in that The articulated vehicle comprises: a self-position sensor that detects the position at the work site; and a control device, which controls the movement of the articulated vehicle, The control device sets a reference point of the articulated vehicle on the axle or on the side in the traveling direction of the axle on a straight line passing through the left and right centers of the axle of the wheels of the frame on the traveling direction side of the front frame and the rear frame in the front and rear directions perpendicularly to the axle, The control device calculates the position of the reference point at the work site based on the detection result of the self-position sensor, The control device calculates a steering control amount, which is an amount of bending of the front frame with respect to the rear frame, based on a target trajectory predetermined as a travel trajectory of the articulated vehicle and the position of the reference point at the work site.

2. The articulated vehicle according to claim 1, It is characterized in that The control device calculates the steering control amount so that the distance between the left and right centers of the axles of the wheels of the frames on the traveling direction side of the front frame and the rear frame and the target track becomes less than the distance between the center of the axles of the wheels of the frames on the opposite side of the traveling direction and the target track.

3. The articulated vehicle according to claim 1, It is characterized in that The articulated vehicle further comprises a forward and reverse indication switch, wherein the forward and reverse indication switch indicates the traveling direction of the articulated vehicle. The control device sets the reference point of the articulated vehicle according to a travel direction indicated by the forward / reverse instruction switch.

4. The articulated vehicle according to claim 1, It is characterized in that The articulated vehicle further comprises a vehicle body information acquisition sensor for detecting a traveling direction of the vehicle. The control device sets the reference point of the articulated vehicle according to the traveling direction of the articulated vehicle determined based on the detection result of the vehicle body information acquisition sensor.

5. The articulated vehicle according to claim 2, It is characterized in that The control device calculates a target position in the work site based on a path plan that predetermines a travel path of the articulated vehicle in the work site and the position of the reference point in the work site. The control device sets the reference point of the articulated vehicle according to a traveling direction of the articulated vehicle determined based on a position of the reference point at the work site and the target position.

6. The articulated vehicle according to claim 5, It is characterized in that The control device switches the path plan according to a position of the reference point in the articulated vehicle when the reference point is changed.

7. The articulated vehicle according to claim 5, It is characterized in that When the reference point is changed, the control device calculates the target driving speed of the articulated vehicle at the work site, i.e., the speed control amount, so that the distance between the target position and the position of the reference point at the work site becomes less than the distance between the target position and the position of the reference point at the work site before the reference point is changed.

8. The articulated vehicle according to claim 2, It is characterized in that The articulated vehicle comprises: a pair of lifting arms extending forward and supported on the front frame at positions separated in the width direction so as to be able to rise and fall; and a bucket supported at the front ends of the pair of lifting arms in a tiltable manner, The control device sets the reference point of the articulated vehicle between the axle of the wheel of the front frame and the front end of the bucket when the front frame side is the traveling direction, The control device sets the reference point of the articulated vehicle between an axle of a wheel of the rear frame and a rear end of the rear frame when the rear frame side is the traveling direction.

Citation Information

Cited By

  • Riding type mower

    CN119384949A