Articulate type vehicle

JP2023141474A5Active Publication Date: 2024-11-12HITACHI CONSTRUCTION MACHINERY CO LTD
View PDF 0 Cites 0 Cited by

Patent Information

Application Number
JP2022047809
Authority / Receiving Office
JP · JP
Patent Type
Applications
Current Assignee / Owner
Filing Date
2022-03-24
Publication Date
2024-11-12
Estimated Expiration
2042-03-24

AI Technical Summary

Technical Problem

Articulated vehicles experience meandering during automatic driving due to delayed steering control intervention and positional errors relative to the target route, particularly when the reference point is behind the center of the front frame axle, leading to reduced tracking accuracy.

Method used

An articulated vehicle with a front and rear frame connected rotatably, equipped with self-position sensors and a control device that sets a reference point on a straight line through the centers of the wheels' axles, calculating steering control amounts to maintain alignment with the target trajectory, thereby improving route-following accuracy.

Benefits of technology

The solution effectively suppresses meandering and enhances the accuracy of following the target route by aligning the vehicle's frames with the target trajectory, ensuring precise navigation.

✦ Generated by Eureka AI based on patent content.

Smart Images

  • Figure 00000000_0000_ABST
    Figure 00000000_0000_ABST
Patent Text Reader

Abstract

To provide an articulate type vehicle capable of suppressing meandering travel while improving following accuracy to a target route.SOLUTION: An articulate type vehicle includes a front frame and a rear frame connected rotatably in a right and left direction. The articulate type vehicle includes a control device that controls operation of the articulate type vehicle. The control device sets a reference point of the articulate type vehicle at a position on a straight line passing a right and left center of an axle of a wheel of a frame in a travel direction side among the front frame and the rear frame, in a front and rear direction perpendicularly to a vehicle axis, the position being on the axle or in the travel direction side further from the axle, calculates a position of the reference point in a work site, and operates a steering control amount that is a bending amount of the front frame with respect to the rear frame on the basis of a target locus predetermined as a travel locus of the articulate type vehicle and a position of the reference point in the work site.SELECTED DRAWING: Figure 5
Need to check novelty before this filing date? Find Prior Art

Description

Technical Field

[0001] The present invention relates to an articulated vehicle.

Background Art

[0002] Conventionally, articulated vehicles have been used at construction sites and the like, but due to reasons such as a shortage of operators, the demand for autonomous driving of articulated vehicles is increasing. In the widespread use of autonomous driving of articulated vehicles, path following performance without meandering is required from the viewpoints of fuel consumption and cycle time.

[0003] In the autonomous driving of an articulated vehicle, as a technique for suppressing meandering with respect to a driving target path, for example, the one described in Patent Document 1 is known. Patent Document 1 discloses an autonomous driving control device for controlling a construction machine that autonomously travels, and when the distance from a driving reference line to the construction machine is greater than a predetermined first threshold value, outputs a control signal for correcting the traveling direction of the construction machine so as to approach the driving reference line, and when the distance from the driving reference line to the construction machine becomes smaller than a second threshold value that is the same as or smaller than the first threshold value, outputs a control signal for making the traveling direction of the construction machine parallel to the driving reference line.

Prior Art Documents

Patent Documents

[0004]

Patent Document 1

Summary of the Invention

Problems to be Solved by the Invention

[0005] However, in the conventional technology described above, the reference point for the vehicle's own position may be located behind the center of the axle of the frame on the front side in the direction of travel, rather than at the bend. Therefore, in articulated vehicles where the rear vehicle follows the front frame in the direction of travel, there is a problem in that steering control intervention is delayed in response to deviations from the target path, resulting in meandering. Furthermore, although the vehicle attempts to maintain its direction of travel parallel to the target path, if the positional deviation is within an acceptable range, an error in the vehicle's position relative to the target path is tolerated, leaving room for improvement in the accuracy of following the target path.

[0006] The present invention has been made in view of the above, and aims to provide an articulated vehicle that can suppress meandering while improving the accuracy of following a target path. [Means for solving the problem]

[0007] The present invention includes multiple means for solving the above problems, but to give one example, an articulated vehicle comprising a front frame having a pair of left and right wheels, and a rear frame having a pair of left and right wheels, which is rotatably connected to the front frame in the left and right directions, comprising a self-position sensor for detecting the position at the work site, and a control device for controlling the operation of the articulated vehicle, wherein the control device sets a reference point for the articulated vehicle on the axle or on the side of the axle in the direction of travel, on a straight line passing perpendicular to the axle in the front and rear directions from the left and right centers of the axle of the wheel of the frame on the direction of travel side of the front frame and rear frame, calculates the position of the reference point at the work site based on the detection result of the self-position sensor, and calculates a steering control amount, which is the amount of bending of the front frame relative to the rear frame, based on a target trajectory predetermined as the travel trajectory of the articulated vehicle and the position of the reference point at the work site. [Effects of the Invention]

[0008] According to the present invention, it is possible to improve the accuracy of following the target path while suppressing meandering. [Brief explanation of the drawing]

[0009] [Figure 1] This is a schematic side view of a wheel loader. [Figure 2] This is a schematic top view of a wheel loader. [Figure 3] This diagram shows the drive system of a wheel loader, along with the control device and related components. [Figure 4] This is a functional block diagram showing the functions of the automatic driving controller according to the first embodiment, along with the related configurations. [Figure 5] This diagram shows an example of setting a reference point relative to the vehicle body, specifically an example of setting a reference point when moving forward. [Figure 6] This diagram shows an example of setting a reference point relative to the vehicle body, specifically an example of setting a reference point when reversing. [Figure 7] This is a functional block diagram showing the functions of the automatic driving controller according to the second embodiment, along with their related configurations. [Figure 8] This flowchart shows the processing details of the reference point switching section. [Figure 9] This flowchart shows the processing details of the reference point correction amount calculation unit. [Figure 10] This is a functional block diagram showing the functions of the automatic driving controller according to the third embodiment, along with their related configurations. [Figure 11] This flowchart shows the processing details of the reference point switching section. [Figure 12] This is a functional block diagram showing the functions of the automatic driving controller according to the fourth embodiment, along with the related configurations. [Figure 13] This flowchart shows the processing details of the target position calculation unit. [Figure 14] This flowchart shows the processing details of the reference point switching section. [Figure 15]It is a flowchart showing the processing content of the route plan setting unit. [Figure 16] It is a flowchart showing the processing content of the reference point switching determination unit. [Figure 17] It is a functional block diagram showing the functions of the automatic driving controller according to the fifth embodiment together with related configurations. [Figure 18] It is a flowchart showing the processing content of the reference point correction amount calculation unit. [Figure 19] It is a flowchart showing the processing content of the reference point switching determination unit. [Figure 20] It is a flowchart showing the processing content of the speed control command calculation unit.

Modes for Carrying Out the Invention

[0010] Hereinafter, embodiments of the present invention will be described with reference to the drawings. In the following description, a wheel loader is exemplified as an articulated vehicle, but the present invention is not limited to this, and the present invention can also be applied to other articulated work machines. Also, when there are a plurality of identical components in the following description, an alphabet may be attached to the end of the reference numeral (number), but the plurality of components may be collectively represented by omitting the alphabet. For example, when there are a pair of left and right front wheels 5a and 5b, they may be collectively represented as the front wheels 5.

[0011] <The First Embodiment> The first embodiment of the present invention will be described with reference to FIGS. 1 to 4.

[0012] FIG. 1 is a side view schematically showing the wheel loader according to the present embodiment, and FIG. 2 is a top view. Also, FIG. 3 is a diagram showing the traveling drive system of the wheel loader together with a control device and related configurations. In the following description, unless otherwise specified, the front, rear, left, and right of the wheel loader 1 are based on the viewpoint of an operator who rides on and operates the wheel loader 1.

[0013] In Figures 1 and 2, the wheel loader 1 consists of a front frame 2 and a rear frame 3. The front frame 2 is fitted with a pair of left and right lift arms 8 and a bucket 7, and a pair of left and right wheels (front wheels 5a, 5b). The rear frame 3 is fitted with a cab 4 in which the operator sits and a pair of left and right wheels (rear wheels 6a, 6b). 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. The front frame 2 and the rear frame 3 are also connected by a pair of left and right steering cylinders 10a, 10b.

[0014] The front wheels 5a and 5b and the rear wheels 6a and 6b are drive wheels that rotate when power is transmitted from the engine 11 (see Figure 3 below). A pair of left and right lift arms 8a and 8b are mounted on the front end of the front frame 2 of the wheel loader 1, spaced apart in the width direction (left and right direction). The buckets 7 are connected to the front ends of the pair of left and right lift arms 8a and 8b so as to be rotatable in the vertical direction, and their rear ends are connected to the front end of the front frame 2 so as to be rotatable in the vertical direction. By extending one of the pair of left and right steering cylinders 10a and 10b and simultaneously retracting the other, the front frame 2 and the rear frame 3 are bent in the left and right direction around the center pin 9.

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

[0016] Engine 11 is, for example, a prime mover that generates driving force by burning fossil fuels.

[0017] 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, it transmits a portion of the driving force of the engine 11 to the transmission 13.

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

[0019] Brakes 14a, 14b, 14c, and 14d slow the rotation of the front wheels 5a, 5b and the rear wheels 6a, 6b. Brakes 14 are provided at four locations corresponding to each wheel to slow the front wheels 5a, 5b and the rear wheels 6a, 6b respectively.

[0020] The hydraulic pump 15 is connected to and driven by the output shaft of the engine 11. The hydraulic pump 15 uses the driving force transmitted from the engine 11 to pump the hydraulic fluid stored in the hydraulic fluid tank (not shown) into the hydraulic circuit 40.

[0021] The hydraulic circuit 40 is composed of directional control valves and the like, and controls the flow rate and direction of the hydraulic fluid discharged from the hydraulic pump 15 and supplied to the hydraulic actuators (brake 14, steering cylinders 10a, 10b) according to the operation signal output from the operating device 20 or the control signal output from the control device 30.

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

[0023] The accelerator pedal 21 adjusts the rotational speed of the engine 11 according to the operator's input. The accelerator pedal 21 outputs an operation signal to the control device 30 indicating the amount of depression by the operator.

[0024] The forward / reverse indicator switch 22 is an alternate switch that indicates the direction of travel of the wheel loader 1 according to the operator's operation. For example, when the forward / reverse indicator switch 22 is switched to the forward position, the transmission 13 is switched to the forward position. Also, when the forward / reverse indicator switch 22 is switched to the reverse position, the transmission 13 is switched to the reverse position. The forward / reverse indicator switch 22 outputs an operation signal indicating the current position to the control device 30.

[0025] The brake pedal 23 adjusts the braking force of the brake 14 according to the operator's operation. The brake pedal 23 outputs an operation signal to the control device 30 indicating the amount the operator presses down on the pedal.

[0026] The steering wheel 24 extends and retracts the steering cylinders 10a and 10b in response to the operator's input. For example, when the operator rotates the steering wheel 24 to the right (clockwise), the left steering cylinder 10a extends and the right steering cylinder 10b retracts, causing the front frame 2 to bend to the right relative to the rear frame 3. Conversely, when the operator rotates the steering wheel 24 to the left (counterclockwise), the left steering cylinder 10a retracts and the right steering cylinder 10b extends, causing the front frame 2 to bend to the left relative to the rear frame 3. The steering wheel 24 outputs the direction of rotation and an operation signal corresponding to the direction of rotation to the control device 30.

[0027] The control device 30 controls the operation of the wheel loader 1 based on operation signals output from the operating device 20 and detection signals output from various sensors, which will be described later. Although not shown in the figures, the control device 30 includes a CPU (Central Processing Unit), ROM (Read Only Memory), and RAM (Random Access Memory). The control device 30 implements the various functional blocks described later by having the CPU read and execute program code stored in the ROM. The RAM is used as a work area when the CPU executes the program. However, the specific configuration of the control device 30 is not limited to this and may be implemented by other hardware.

[0028] 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 each be independent hardware and be interconnected via CAN (Controller Area Network) for mutual communication. As another example, the engine controller 31, the transmission controller 32, and the vehicle body controller 33 may be configured to be implemented by executing programs stored in ROM using a CPU.

[0029] The engine controller 31 increases or decreases the rotational speed of the engine 11 in response to an operation signal indicating the amount the accelerator pedal 21 is pressed. The transmission controller 32 switches the state of the transmission 13 between forward and reverse in response to an operation signal indicating the position of the forward / reverse indicator switch 22. The vehicle controller 33 controls the braking force of the brake 14 in response to an operation signal indicating the amount the brake pedal 23 is pressed.

[0030] (Automatic driving controller 34) Figure 4 is a functional block diagram that shows the functions of the automatic driving controller along with their related components.

[0031] In Figure 4, the automatic driving controller 34 includes a reference point correction amount calculation unit 101, a self-position calculation unit 102, a target trajectory 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 operator assistance), and controls the operation of the hydraulic circuit 40 based on detection signals output from the self-position sensor 50, thereby controlling the operation of the steering cylinders 10a, 10b and brakes 14a, 14b, 14c, 14d, etc.

[0032] The self-position sensor 50 detects the self-position of the wheel loader 1 and outputs the self-position information to the self-position calculation unit 102. The self-position sensor 50 is, for example, a GNSS (Global Navigation Satellite System) and outputs the current latitude and longitude coordinates as positioning results. The self-position sensor 50 is not limited to this and may 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 on the wheel loader 1.

[0033] The reference point correction amount calculation unit 101 calculates a reference point correction amount to correct the self-position detected by the self-position sensor 50 to the position of a reference point set on the wheel loader 1, and outputs the calculated reference point correction amount to the self-position calculation unit 102.

[0034] Figures 5 and 6 show examples of setting reference points relative to the vehicle body. Figure 5 shows an example of setting reference points when moving forward, and Figure 6 shows an example of setting reference points when moving backward.

[0035] As shown in Figure 5, when the wheel loader 1 is moving forward, the front frame 2 is at the front (direction of travel) 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 located at the front (direction of travel) (i.e., the front frame 2). More specifically, the reference point is set on a straight line 100 that passes perpendicular to the axle in the front-rear direction from the left-right center of the axle (axle shaft 17a, 17b) of the wheel (front wheels 5a, 5b) of the frame on the direction of travel side (front frame 2) of the front frame 2 and the rear frame 3, and is set between the axle of the front wheels 5a, 5b and the tip of the bucket 7.

[0036] As shown in Figure 6, when the wheel loader 1 is reversing, the rear frame 3 is at the front (direction of travel) 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 located at the front (direction of travel) (i.e., the rear frame 3). More specifically, the reference point is set on a straight line 100 that passes perpendicular to the axle in the front-rear direction from the left-right center of the axle of the wheel (rear wheel 6a, 6b) of the frame on the direction of travel side (rear frame 3) of the front frame 2 and the rear frame 3, and is set between the axle of the rear wheel 6a, 6b and the rear end (end on the direction of travel side) of the rear frame 3.

[0037] 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 of the reference point correction amount calculation unit 101 (reference point correction amount), and outputs it to the steering control command calculation unit 104.

[0038] The target trajectory setting unit 103 sets a target trajectory for the wheel loader 1 to travel on, sets a target position on the target trajectory, and outputs it to the steering control command calculation unit 104. For example, the target trajectory setting unit 103 forms a target trajectory by arranging multiple target coordinates in advance, and outputs one of the target coordinates within the target trajectory as the target position. However, the method of setting the target trajectory and target position by the target trajectory setting unit 103 is not limited to this, and may be implemented using other methods.

[0039] 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 self-position calculation unit 102 and the target position from the target trajectory setting unit 103, and outputs it to the hydraulic circuit 40 as a control command. In other words, the control command output from the steering control command calculation unit 104 is a command to control the directional control valve that controls the direction and flow rate of the hydraulic fluid supplied to the steering cylinders 10a and 10b.

[0040] Here, the bending angle of the vehicle body is the amount of bending between the front frame 2 and the rear frame 3, and the bending angle is 0 (zero) when the axles of the front wheels 5a, 5b and the axles of the rear wheels 6a, 6b are parallel, that is, when the front frame 2 and the rear frame 3 are straight. The steering control command calculation unit 104 calculates the bending angle of the vehicle body by, for example, assuming that the wheel loader 1 is turning so that the reference point passes through the target position, by taking 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, as the bending angle of the vehicle body. However, the method of calculating the bending angle by the steering control command calculation unit 104 is not limited to this, and may be implemented using other methods.

[0041] The effects of this embodiment, configured as described above, will now be explained.

[0042] In articulated vehicles, if the reference point for the vehicle's position is behind the center of the axle of the frame on the front side in the direction of travel, controlling the vehicle so that the rear of the vehicle follows the front of the frame in the direction of travel can lead to a problem where steering control intervention is delayed in response to deviations from the target path, causing meandering. Furthermore, if the vehicle is controlled to maintain its direction of travel parallel to the target path, errors in the vehicle's position relative to the target path are tolerated as long as they are within the allowable range of positional deviation, resulting in a decrease in the accuracy of tracking the target path.

[0043] In contrast, in this embodiment, a reference point for the articulated wheel loader 1 is set on or on the axle in the direction of travel, on a straight line passing perpendicular to the axle in the longitudinal direction between the left and right centers of the wheel axles of the frame on the direction of travel side of the front frame 2 and rear frame 3. The position of the reference point at the work site is calculated based on the detection result of the self-position sensor, and the steering control amount, which is the amount of bending of the front frame 2 relative to the rear frame 3, is calculated based on the target trajectory predetermined as the travel trajectory of the wheel loader 1 and the position of the reference point at the work site. As a result, the distance from the left and right centers of the wheel axles (axle shafts 17a, 17b) of the frame located on the direction of travel side (front frame 2 or rear frame 3) to the target trajectory is less than or equal to the distance from the left and right centers of the wheel axles of the frame located on the opposite side of the direction of travel (rear) to the target trajectory. Therefore, the frame located on the direction of travel side (front frame 2 or rear frame 3) can follow the target trajectory without meandering. In other words, meandering can be suppressed while improving the accuracy of following the target path.

[0044] <Second Embodiment> A second embodiment of the present invention will be described with reference to Figures 7 to 9.

[0045] The wheel loader of this embodiment is configured to set a reference point for the wheel loader according to the direction of travel indicated by an instruction from a forward / reverse instruction switch that can be switched by the operator. In this embodiment, components similar to those of the first embodiment are denoted by the same reference numerals and their descriptions are omitted.

[0046] Figure 7 is a functional block diagram that shows the functions of the automatic driving controller according to this embodiment, along with their related components.

[0047] In Figure 7, 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.

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

[0049] Figure 8 is a flowchart showing the processing details of the reference point switching unit.

[0050] In Figure 8, when the reference point switching unit 505 of the automatic driving controller 34A detects an 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).

[0051] If the result of the determination in step S110 is YES, the determination result that the transmission 13 is in the forward position is output to the reference point correction amount calculation unit 501 (step S120), and the process ends.

[0052] Furthermore, if the result of the determination in step S110 is NO, the determination result that the transmission 13 is in the reverse position is output to the reference point correction amount calculation unit 501 (step S130), and the process is terminated.

[0053] The reference point correction amount calculation unit 501 calculates the reference point correction amount according to the determination result from the reference point switching unit 505, that is, whether the transmission 13 is in a forward or reverse state, and outputs the calculated reference point correction amount to the self-position calculation unit 102.

[0054] Figure 9 is a flowchart showing the processing details of the reference point correction amount calculation unit.

[0055] In Figure 9, the reference point correction amount calculation unit 501 of the automatic driving controller 34 first obtains a determination result from the reference point switching unit 505 (step S200), and then determines whether the determination result indicates a forward state or not (step S210).

[0056] If the result of the determination in step S210 is YES, the amount of reference point correction when moving forward, that is, the amount of reference point correction when setting a reference point on a straight line passing perpendicular to the axle in the front-rear direction from the left-right center of the axle of the front wheel 5 of the front frame 2 on the direction of travel side, and between the axle of the front wheel 5 and the tip of the bucket 7, is output to the self-position calculation unit 102 (step S220), and the process ends.

[0057] Furthermore, if the result of the determination in step S210 is NO, the self-position calculation unit 102 is output the reference point correction amount for reversing, that is, the reference point correction amount when setting a reference point on a straight line that passes perpendicular to the axle in the longitudinal direction from the left and right centers of the axle of the rear wheel 6 of the rear frame 3 on the direction of travel, and between the axle of the rear wheel 6 and the rear end (end on the direction of travel side) of the rear frame 3 (step S230), and the process ends.

[0058] The other configurations are the same as in the first embodiment.

[0059] In this embodiment configured as described above, the same effects as in the first embodiment can be obtained.

[0060] Furthermore, since the system is configured so that the reference point is corrected (switched) in response to 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 while suppressing meandering.

[0061] <Third Embodiment> A third embodiment of the present invention will be described with reference to Figures 10 and 11.

[0062] The wheel loader of this embodiment is configured to set a reference point for the wheel loader according to the detection result from a vehicle information acquisition sensor that detects vehicle body information (acceleration direction). In this embodiment, components similar to those in the first and second embodiments are denoted by the same reference numerals and their descriptions are omitted.

[0063] Figure 10 is a functional block diagram that shows the functions of the automatic driving controller according to this embodiment, along with the related components.

[0064] In Figure 10, 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.

[0065] The reference point switching unit 805 determines whether the transmission 13 is in a forward or reverse state according to 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.

[0066] The vehicle information acquisition sensor 51 is, for example, an acceleration-detecting device such as an IMU (Inertial Measurement Unit). It is installed on the wheel loader 1 to detect positive acceleration when the wheel loader 1 is moving forward (i.e., moving in the direction of the front frame 2) and to detect and output negative acceleration when it is moving backward (i.e., moving in the direction of the rear frame 3). However, the configuration of the vehicle information acquisition sensor 51 is not limited to this and may be configured to be realized by other means.

[0067] Figure 11 is a flowchart showing the processing details of the reference point switching unit.

[0068] In Figure 11, the reference point switching unit 805 of the automatic driving controller 34A acquires detection results from the vehicle body information acquisition sensor 51 (step S300), and then determines whether the acquired detection result, acceleration, is positive or negative (step S310).

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

[0070] Furthermore, if the determination result in step S310 is NO, that is, if the acceleration is negative and it is determined that the wheel loader 1 is moving toward the rear frame 3, 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 process is terminated.

[0071] The reference point correction amount calculation unit 501 calculates the reference point correction amount according to the determination result from the reference point switching unit 805, that is, whether the transmission 13 is in a forward or reverse state, and outputs the calculated reference point correction amount to the self-position calculation unit 102.

[0072] The other configurations are the same as those in the first and second embodiments.

[0073] In this embodiment configured as described above, the same effects as those of the first and second embodiments can be obtained.

[0074] Furthermore, the system is configured so that the reference point is corrected (switched) according to the detection results of the vehicle information acquisition sensor 51 during the movement of the wheel loader 1. This makes it possible to more reliably improve the accuracy of following the target path while suppressing meandering.

[0075] <Fourth Embodiment> A fourth embodiment of the present invention will be described with reference to Figures 12 to 16.

[0076] The wheel loader of this embodiment is configured to set a reference point for the wheel loader 1 according to the direction of travel determined based on the position of the reference point at the work site and the target position, and to switch the route plan according to the position of the reference point in the articulated vehicle when the reference point is changed. In this embodiment, components similar to those in the first to third embodiments are denoted by the same reference numerals and their descriptions are omitted.

[0077] Figure 12 is a functional block diagram that shows the functions of the automatic driving controller according to this embodiment, along with their related components.

[0078] In Figure 12, the automatic driving controller 34C includes a reference point switching unit 1005, a route planning 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 command calculation unit 104.

[0079] The target position calculation unit 1003 calculates the target position based on the position of the reference point from the self-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.

[0080] Figure 13 is a flowchart showing the processing details of the target position calculation unit.

[0081] In Figure 13, the target position calculation unit 1003 of the automatic driving controller 34C first obtains calculation results from the self-position calculation unit 102 and the route planning setting unit 1006 (step S400), and then calculates the target position from the position of the reference point from the self-position calculation unit 102 and the target coordinates of the route plan from the route planning setting unit 1006 (step S410). The target position calculation in the target position calculation unit 1003 is performed, for example, by interpolating the path using a spline function based on the current position of the reference point and the current target coordinates, and setting the position obtained by traveling a certain distance along the interpolated path from the current position of the reference point as the target position. However, the method of calculating the target position is not limited to this, and it may be configured to be implemented using other methods.

[0082] Once the processing in step S410 is complete, 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 ends.

[0083] The reference point switching unit 1005 receives the determination result from the reference point switching determination unit 1007 and determines whether the wheel loader 1 is in a forward or reverse state. It outputs the determination result to the reference point correction amount calculation unit 501. The reference point switching determination unit 1007 determines whether the direction of travel of the wheel loader 1 has been switched based on the position of the reference point from the self-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. Details of the process will be described later.

[0084] Figure 14 is a flowchart showing the processing details of the reference point switching unit.

[0085] In Figure 14, the reference point switching unit 1005 of the automatic driving controller 34C acquires the judgment result from the reference point switching determination unit 1007 (step S500) and determines whether the acquired judgment result indicates a forward state (step S510).

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

[0087] Furthermore, if the result of the determination in step S510 is NO, the determination result that the wheel loader 1 is in the reverse position (in other words, the transmission 13 is in the reverse position) is output to the reference point correction amount calculation unit 501 (step S530), and the process is terminated.

[0088] The route planning setting unit 1006 sets a route plan to be output to the target position calculation unit 1003 based on the determination result from the reference point switching unit 1005. The route plan output to the target position calculation unit 1003 sets a target trajectory for the wheel loader 1 to travel on. For example, the target trajectory is composed of sequentially arranging target coordinates from the starting position to the target arrival position. Furthermore, since the route planning setting unit 1006 determines the target coordinates based on the position of the reference point, it has different route plans for forward and reverse movement, where the reference point on the wheel loader 1 is different. The route plan for forward movement is composed of target coordinates based on the reference point in the forward state, and the route plan for reverse movement is composed of target coordinates based on the reference point in the reverse state. However, the configuration of the route planning setting unit 1006 is not limited to this, and may be configured to be realized by other means.

[0089] Figure 15 is a flowchart showing the processing details of the route planning setting unit.

[0090] In Figure 15, the route planning setting unit 1006 of the automatic driving controller 34C acquires the judgment result from the reference point switching unit 1005 (step S600) and determines whether the acquired judgment result indicates a forward state (step S610).

[0091] If the result of the 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 process ends.

[0092] Furthermore, if the result of the determination in step S610 is NO, the path plan corresponding to the reference point when the wheel loader is reversing is output to the target position calculation unit 1003 (step S630), and the process ends.

[0093] The reference point switching determination unit 1007 determines whether the direction of travel of the wheel loader 1 has been switched based on the position of the reference point from the self-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, if the initial state is the forward state, when the direction of travel of the wheel loader 1 is switched, the determination result indicating a switch to the reverse state is output to the reference point switching unit 1005. At this time, until the switching of the direction of travel of the wheel loader 1 is determined, the determination result indicating the forward state is output to the reference point switching unit 1005. However, the specific configuration of the reference point switching determination unit 1007 is not limited to this, and it may be configured to be implemented by other means.

[0094] Figure 16 is a flowchart showing the processing details of the reference point switching determination unit.

[0095] In Figure 16, the reference point switching determination unit 1007 of the automatic driving controller 34C obtains calculation results from the self-position calculation unit 102 and the target position calculation unit 1003 (step S700), and based on the obtained calculation results, calculates a vector from the current reference point position at the work site to the target position (step S710), and also calculates a vector from the current reference point position at the work site to the previous reference point position (step S720).

[0096] Next, it is determined whether the angle formed by the vectors calculated in steps S710 and S720 is 90 degrees or more (step S730). If the determination result is YES, the determination result indicating the previous direction of travel (forward or backward) is output to the reference point switching unit 1005 (step S740). The current position of the reference point and the direction of travel at the work site are recorded (step S760), and the process ends. The recorded current position of the reference point and the direction of travel are used as the previous position of the reference point and the direction of travel during the next determination process in the reference point switching determination unit 1007.

[0097] Furthermore, if the result of the determination in step S730 is NO, it is determined whether the previous direction of travel was forward or not (step S750). If the result of the determination in step S750 is YES, the determination result indicating the reverse state is output to the reference point switching unit 1005 (step S751), and the process proceeds to step S760. Furthermore, 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.

[0098] The other configurations are the same as those of the first to third embodiments.

[0099] In this embodiment configured as described above, the same effects as those of the first to third embodiments can be obtained.

[0100] Furthermore, since the system is configured to switch the amount of reference point correction according to the route plan and the position of the reference point, the reference point in the wheel loader 1 is automatically corrected according to the direction of travel, thereby improving the accuracy of following the target route more reliably while suppressing meandering.

[0101] <Fifth Embodiment> A fourth embodiment of the present invention will be described with reference to Figures 17 to 20.

[0102] The wheel loader of this embodiment is configured to calculate a speed control amount, which is the target travel speed of the wheel loader at the work site, and to brake when the position of the reference point on the vehicle body is changed, so that the distance between the target position and the position of the reference point at the work site is less than or equal to the distance between the target position and the position of the reference point at the work site before the reference point was changed. In this embodiment, components similar to those in the first to fourth embodiments are denoted by the same reference numerals and their descriptions are omitted.

[0103] Figure 17 is a functional block diagram that shows the functions of the automatic driving controller according to this embodiment, along with their related components.

[0104] In Figure 17, the automatic driving controller 34D includes a reference point switching unit 1005, a reference point correction amount calculation unit 1501, a route planning setting unit 1506, a reference point switching determination unit 1507, a speed control command calculation unit 1508, a self-position calculation unit 102, a target position calculation unit 1003, and a steering control command calculation unit 104.

[0105] The reference point correction amount calculation unit 1501 calculates the reference point correction amount according to the determination result from the reference point switching unit 1005, that is, whether the wheel loader 1 (in other words, the transmission 13) is in a forward or reverse state, and outputs the calculated reference point correction amount to the self-position calculation unit 102.

[0106] Figure 18 is a flowchart showing the processing details of the reference point correction amount calculation unit.

[0107] In Figure 18, the reference point correction amount calculation unit 1501 of the automatic driving controller 34D first obtains a determination result from the reference point switching unit 1005 (step S800), and then determines whether the determination result indicates a forward state or not (step S810).

[0108] If the result of the determination in step S810 is YES, the amount of reference point correction when moving forward, that is, the amount of reference point correction when setting a reference point on a straight line passing perpendicular to the axle in the front-rear direction from the left-right center of the axle of the front wheel 5 of the front frame 2 on the direction of travel side, and between the axle of the front wheel 5 and the tip of the bucket 7, is output to the self-position calculation unit 102 (step S820), and the process ends.

[0109] Furthermore, if the result of the determination in step S810 is NO, the self-position calculation unit 102 is output the reference point correction amount for reversing, that is, the reference point correction amount when setting a reference point on a straight line that passes perpendicular to the axle in the longitudinal direction from the left and right centers of the axle of the rear wheel 6 of the rear frame 3 on the direction of travel, and between the axle of the rear wheel 6 and the rear end (end on the direction of travel side) of the rear frame 3 (step S830), and the process ends.

[0110] The route planning setting unit 1506 outputs the route plan to the target position calculation unit 1003. The route plan output to the target position calculation unit 1003 sets the target trajectory for the wheel loader 1 to travel along. For example, the target trajectory is constructed by sequentially arranging the target coordinates from the starting position to the target arrival position. However, the specific configuration of the route plan setting unit 1506 is not limited to this and may be implemented by other means.

[0111] The reference point switching determination unit 1507 determines whether the direction of travel of the wheel loader 1 has been switched based on the position of the reference point from the self-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, if the initial state is the forward state, when the direction of travel of the wheel loader 1 is switched, the determination result indicating a switch to the reverse state is output to the reference point switching unit 1005. At this time, until the switching of the direction of travel of the wheel loader 1 is determined, the determination result indicating the forward state is output to the reference point switching unit 1005. However, the specific configuration of the reference point switching determination unit 1507 is not limited to this, and it may be configured to be implemented by other means.

[0112] Figure 19 is a flowchart showing the processing details of the reference point switching determination unit.

[0113] In Figure 19, the reference point switching determination unit 1507 of the automatic driving controller 34D obtains calculation results from the self-position calculation unit 102 and the target position calculation unit 1003 (step S900), and based on the obtained calculation results, calculates a vector from the current reference point position at the work site to the target position (step S910), and also calculates a vector from the current reference point position at the work site to the previous reference point position (step S920).

[0114] Next, it is determined whether the angle formed by the vectors calculated in steps S910 and S920 is 90 degrees or more (step S930). If the determination result is YES, the determination result indicating the previous direction of travel (forward or backward) is output to the reference point switching unit 1005 (step S940). The current position of the reference point and the direction of travel at the work site are recorded (step S960), and the process ends. The recorded current position of the reference point and the direction of travel are used as the previous position of the reference point and the direction of travel during the next determination process in the reference point switching determination unit 1507.

[0115] Furthermore, if the result of the determination in step S930 is NO, it is determined whether the previous direction of travel was forward or not (step S950). If the result of the determination in step S950 is YES, a determination result indicating that the direction of travel has switched is output to the speed control command calculation unit 1508, and a determination result indicating that it is in reverse is output to the reference point switching unit 1005 (step S951), and the process proceeds to step S960. Furthermore, if the result of the determination in step S950 is NO, a determination result indicating that the direction of travel has not switched is output to the speed control command calculation unit 1508, and a determination result indicating that it is in forward is output to the reference point switching unit 1005 (step S952), and the process proceeds to step S960.

[0116] 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 self-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 necessary 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 for the valve that supplies hydraulic fluid to the brake shoes that grip the brake disc, in the case where the brake 14 is configured to brake the rotation of the drive wheels by clamping a brake disc that rotates integrally with each drive wheel with a pair of brake shoes. However, the specific configuration of the speed control command calculation unit 1508 and the brake 14 is not limited to this, and may be configured to be realized by other means.

[0117] Figure 20 is a flowchart showing the processing details of the speed control command calculation unit.

[0118] In Figure 20, the speed control command calculation unit 1508 of the automatic driving controller 34D obtains calculation results and determination results from the self-position calculation unit 102, the target position calculation unit 1003, and the reference point switching determination unit 1507 (step S1000), and determines whether or not the determination result indicates that the direction of travel state has been switched (step S1010).

[0119] If the result of step S1010 is YES, the difference between the position of the reference point obtained from the self-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 difference in position is less than or equal to a predetermined threshold (step S1030). The threshold is set to a value such as 1m. However, a table of correction distances for the difference between the position of the reference point and the target position may be prepared in advance according to other characteristics, and the threshold may be determined based on this table.

[0120] If the result of step S1030 is NO, a control command is output to the hydraulic circuit 40 to control the valve so that hydraulic fluid is supplied to the brake shoe to grip the brake disc, as a control command for the brake 14 (step S1040), and the process ends. The amount of gripping of the brake disc by the brake shoe is, for example, about half the amount the brake pedal 23 is pressed.

[0121] Furthermore, if the result of the determination in step S1010 is NO, or if the result of the determination in step S1030 is YES, no control command is output to the brake 14 (step S1050), and the process ends.

[0122] The other configurations are the same as those of the first to fourth embodiments.

[0123] In this embodiment configured as described above, the same effects as those of the first to fourth embodiments can be obtained.

[0124] Furthermore, in the forward position, the bucket 7 can follow the target trajectory using its center as the reference point for its own position from both the left and right directions. If the reference point is switched and the error with the target trajectory increases, the brake 14 can be applied to absorb the error, thus suppressing sudden movements of the wheel loader 1 due to changes in the reference point caused by switching between forward and reverse. This improves the accuracy of following the target path more reliably while suppressing meandering.

[0125] <Note> It should be noted that the present invention is not limited to the embodiments described above, and includes various modifications and combinations that do not depart from the spirit of the invention. Furthermore, the present invention is not limited to having all the configurations described in the embodiments described above, and includes configurations in which some of the configurations are omitted. In addition, some or all of the above configurations, functions, etc. may be realized by designing, for example, an integrated circuit. Furthermore, each of the above configurations, functions, etc. may be realized in software by having a processor interpret and execute a program that realizes each function. [Explanation of symbols]

[0126] 1...Wheel loader, 2...Front frame, 3...Rear frame, 4...Cab, 5...Front wheels, 6...Rear wheels, 7...Bucket, 8...Lift arm, 9...Center pin, 10...Steering cylinder, 11...Engine, 12...Torque converter, 13...Transmission, 14...Brakes, 15...Hydraulic pump, 16...Drive shaft, 17...Axle shaft, 20...Control 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...Route planning setting unit, 1007...Reference point switching determination unit, 1501...Reference point correction amount calculation unit, 1506...Route planning 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 and right direction and having a pair of left and right wheels, A self-position sensor for detecting a position in a work site; a control device for controlling an operation of the articulated vehicle, The control device includes: a reference point for the articulated vehicle is set on a straight line passing through a left-right center of an axle of a wheel of the frame in the traveling direction out of the front frame and the rear frame in the forward direction perpendicular to the axle, the reference point being set on the forward direction side of the axle; Calculating the position of the reference point in the work site based on the detection result of the self-position sensor; an articulated vehicle, characterized in that a steering control amount, which is the amount of bending of the front frame relative to the rear frame, is calculated based on a predetermined target trajectory as a traveling trajectory of the articulated vehicle and the position of the reference point at the work site.

2. 2. The articulated vehicle of claim 1, the control device calculates the steering control amount so that a distance between the left and right center of the wheel axle of the frame closest to the traveling direction of the front or rear frame and the target trajectory is equal to or less than a distance between the center of the wheel axle of the frame opposite to the traveling direction of the articulated vehicle and the target trajectory.

3. 2. The articulated vehicle of claim 1, A forward / reverse switch is further provided for indicating a direction of travel of the articulated vehicle. The control device sets the reference point of the articulated vehicle in accordance with a traveling direction indicated by the forward / reverse switch.

4. 2. The articulated vehicle of claim 1, Further comprising a vehicle body information acquisition sensor for detecting a direction of acceleration, The control device of the articulated vehicle is characterized in that it sets the reference point of the articulated vehicle in accordance with a traveling direction of the articulated vehicle determined based on a detection result of a vehicle body information acquisition sensor.

5. 3. The articulated vehicle according to claim 2, The control device includes: calculating a target position at the work site from a route plan that defines a predetermined travel route of the articulated vehicle at the work site and the position of the reference point at the work site; The articulated vehicle is characterized in that the reference point of the articulated vehicle is set 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. 6. The articulated vehicle according to claim 5, The articulated vehicle, wherein the control device switches the path plan depending on a position of the reference point on the articulated vehicle when the reference point is changed.

7. 6. The articulated vehicle according to claim 5, The control device for an articulated vehicle is characterized in that, when the reference point is changed, the control device calculates a speed control amount, which is a target traveling speed of the articulated vehicle at the work site, so that the distance between the target position and the position of the reference point at the work site is equal to or 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. 3. The articulated vehicle according to claim 2, A pair of lift arms are supported on the front frame at positions spaced apart in the width direction and extended forward, so as to be capable of being raised and lowered; a bucket tiltably supported on the front ends of the pair of lift arms, The control device includes: When the front frame side is in the traveling direction, the reference point of the articulated vehicle is set between an axle of a wheel of the front frame and a tip end of the bucket; An articulated vehicle characterized in that, when the rear frame side is in the direction of travel, the reference point of the articulated vehicle is set between the wheel axle of the rear frame and the rear end of the rear frame.