The present application claims priority under 35 U. S. C. § 119 to Japanese Patent Application No. 2023-118988, filed Jul. 21, 2023. The contents of this application are incorporated herein by reference in their entirety.
The present invention relates to a work vehicle, a controller for the work vehicle, and a speed control method for the work vehicle.
Japanese Patent Application Laid-Open No. 2017-053413 describes a technique of measuring an input of a travel lever and a rotation speed of a travel motor and adjusting a pilot pressure of a travel pump so that the rotation speed of the travel motor matches a command based on the input of the travel lever. Japanese Patent Application Laid-Open No. 2020-038002 describes a method of detecting a primary pressure of pilot oil supplied to a remote control valve and a rotational speed of a travel motor, and controlling the primary pressure so as to achieve a target vehicle speed based on the detected primary pressure and rotational speed.
In accordance with one aspect of the present invention, a work vehicle includes a hydraulic motor, a hydraulic pump, a prime mover, a human-machine interface, a rotation speed sensor, a hydraulic control circuit, and circuitry. The hydraulic motor is configured to generate a driving force of the work vehicle. The hydraulic pump is configured to supply hydraulic fluid to the hydraulic motor. The prime mover is configured to rotate the hydraulic pump. The human-machine interface is configured to receive an input corresponding to a target rotation speed of the hydraulic motor. The rotation speed sensor is configured to detect a rotation speed of the hydraulic motor The hydraulic control circuit is configured to control a hydraulic pressure of pilot oil to change a displacement volume of the hydraulic pump. The circuitry is configured to control the prime mover and the hydraulic control circuit. The circuitry is configured to obtain based on the target rotation speed, a reference value of a control parameter according to which the hydraulic control circuit is controlled. The circuitry is configured to calculate a speed difference obtained by subtracting the target rotation speed from the rotation speed. The circuitry is configured to calculate an offset value corresponding to the speed difference. The circuitry is configured to set the control parameter to a value obtained by adding the offset value to the reference value.
In accordance with another aspect of the present invention, a controller of a work vehicle includes operation detection circuitry, determination circuitry, pump control circuitry, prime mover control circuitry, and motor rotation detection circuitry. The operation detection circuitry is configured to receive an input from a human-machine interface, the input corresponding to a target rotation speed of a hydraulic motor configured to generate a driving force of the work vehicle. The determination circuitry is configured to determine a control parameter according to which a displacement volume of a hydraulic pump is controlled in response to an operation of the human-machine interface, the hydraulic pump being configured to supply hydraulic fluid to the hydraulic motor. The pump control circuitry is configured to send a command corresponding to the control parameter to a hydraulic control circuit to control the displacement volume of the hydraulic pump. The prime mover control circuitry is configured to send a command to a prime mover configured to rotate the hydraulic pump to rotate the hydraulic motor via the hydraulic pump. The motor rotation detection circuitry is configured to receive a rotation speed of the hydraulic motor from a rotation speed sensor. The pump control circuitry is configured to calculate a speed difference obtained by subtracting the target rotation speed from the rotation speed. The determination circuitry is configured to obtain a reference value of the control parameter based on the target rotation speed. The determination circuitry is configured to calculate an offset value corresponding to the speed difference. The determination circuitry is configured to set the control parameter to a value obtained by adding the offset value to the reference value.
In accordance with the other aspect of the present invention, a speed control method for a work vehicle includes acquiring from a human-machine interface, a target rotation speed of a hydraulic motor configured to generate a driving force of the work vehicle. The method includes determining a control parameter according to which a displacement volume of a hydraulic pump is set based on an operation of the human-machine interface, the hydraulic pump being configured to supply hydraulic fluid to the hydraulic motor. The method includes controlling the displacement volume of the hydraulic pump according to the control parameter to rotate the hydraulic pump to rotate the hydraulic motor. The method includes detecting a rotation speed of the hydraulic motor and calculating a speed difference obtained by subtracting the rotation speed from the target rotation speed. The method includes obtaining a reference value of the control parameter based on the target rotation speed, calculating an offset value corresponding to the speed difference, and setting the control parameter to a value obtained by adding the offset value to the reference value.
A more complete appreciation of the present disclosure and many of the attendant advantages thereof will be readily obtained as the same becomes better understood by reference to the following detailed description when considered in connection with the accompanying drawings.
The present invention will be described in detail below with reference to the drawings showing embodiments thereof. In the drawings, the same reference numerals denote corresponding or substantially the same components.
Referring to
The link 44 is rotatable relative to the vehicle body 2 about the fulcrum shaft 46. The arm 45 is rotatable relative to the link 44 about the joint shaft 47. The work device 4 further includes a plurality of arm cylinders 48 and at least one equipment cylinder 49. Each of the plurality of arm cylinders 48 is rotatably connected to the vehicle body 2 and the arm 45, and moves the link 44, the arm 45, and the like to raise and lower the bucket 41. The at least one implement cylinder 49 is configured to tilt the bucket 41. The vehicle body 2 includes a cabin 5. The cabin 5 includes a front window 51 that can be opened and closed, and the outer shape of the cabin 5 is defined by a cab frame 53. The front window 51 may be omitted. The work vehicle 1 includes a driver's seat 54 and an operation lever 55 in the cabin 5. As shown in
In the embodiment according to the present application, a front-back direction DFB (forward direction DF/backward direction DB) means a front-back direction (forward direction/backward direction) as seen from an operator seated on the driver's seat 54 of the cabin 5. A leftward direction DL, a rightward direction DR, a width direction DW means the left direction, the right direction, and the left-right direction as viewed from the operator, respectively. An upward direction DU, a downward direction DD, height direction DH means an upward direction, a downward direction, and a height direction as viewed from the operator. The front-back, left-right (width), and up-down (height) directions of the work vehicle 1 coincide with the front-back, left-right (width), and up-down (height) directions as viewed from the operator, respectively.
Referring to
The hydraulic circuit 1A includes The hydraulic circuit includes a pilot oil supply passage PA1 connected to a discharge port of the pilot pump 71. The pilot oil is supplied to the pilot supply oil passage PA1. The hydraulic circuit 1A includes a plurality of switching valves (brake switching valves, direction switching valve SV2) connected to the pilot oil supply passage PA1, and a plurality of brake mechanisms 72. The brake switching valve SV1 is connected to the pilot oil supply passage PAL. The brake switching valves SV1 are direction switching valves (electromagnetic valves) for performing braking and releasing the braking by the plurality of brake mechanisms 72. The brake switching valve SV1 is a two-position switching valve configured to switch a valve element to the first position VP1a and the second position VP1b by exciting. Switching of the valve element of the brake switching valve SV1 is performed by the brake pedal 13 (see
The plurality of brake mechanisms 72 include a first brake mechanism 72L for braking the left traveling device 3L and a second brake mechanism 72R for braking the right traveling device 3R. The first brake mechanism 72L and the second brake mechanism 72R are connected to the brake switching valves via the oil passage PA2. The first brake mechanism 72L and the second brake mechanism 72R are configured to brake the traveling device 3 in accordance with pressures of pilot oil (hydraulic fluid). When the valve element of the brake switching value SV1 is switched to the first position VP1a, the hydraulic fluid is discharged from the oil passage PA2 in a section between the brake switching value SV1 and the brake mechanism 72, and the traveling device 3 is braked by the brake mechanism 72. When the valve element of the brake switching value SV1 is switched to the second position VP1b, the braking by the brake mechanism 72 is released. Note that the braking by the brake mechanism 72 may be released when the valve element of the brake switching valves SV1 is switched to the first position VP1a, and the traveling device 3 may be braked by the brake mechanism 72 when the valve element of the brake switching valves SV1 is switched to the second position VP1b.
Direction switching valve SV2 is a solenoid valves for changing the rotation of the left hydraulic motor device 30L and the right hydraulic motor device 30R. The direction switching valve SV2 is a two-position switching valve configured to switch a valve element to the first position VP2a or second position VP2b by excitation. The direction switching valve SV2 is switched by a human-machine interface (not illustrated) or the like. The human-machine interface includes, for example, a lever, a switch, a button, a dial, a pedal, or a button shown on a touch panel. The direction switching valve SV2 may be a proportional control valve capable of adjusting the flow rate of the hydraulic fluid to be discharged, instead of a two-position control valve.
The left hydraulic motor device 30L is a device configured to generate a driving force of the work vehicle to transmit power to the drive wheel 31 provided in the left traveling device 3L. The left hydraulic motor device 30L includes a left hydraulic motor 31L, a first swash plate switching cylinder 32L, and a first travel control valve (hydraulic switching value) SV4. The left hydraulic motor 31L is a swash plate type variable capacity axial motor for driving the left traveling device 3L, and is a motor capable of changing the vehicle speed (rotation) to the first speed or the second speed. The first swash plate switching cylinder 32L is a cylinder configured to change the angle of the swash plate of the left hydraulic motor 31L by extension and contraction. The first travel control valve SV4 is used to extend and contract the first swash plate switching cylinder 32L. The first travel control valve SV4 is a two-position switching valve configured to switch its valve element between a first position VP4a and a second position VP4b.
Switching of the first travel control valve SV4 is performed by a directional switching valve SV2 located on the upstream side and connected to the first travel control valve SV4. Specifically, the direction switching valve SV2 and the first travel control valve SV4 are connected by an oil passage PA3, and switching operation of the first travel control valve SV4 is performed by hydraulic fluid flowing through the oil passage PA3. For example, the valve element of the direction switching valve SV2 is switched to the first position VP2a, the pilot oil is released in the section between the direction switching valve SV2 and the first travel control valve SV4, and the valve element of the first travel control valve SV4 is switched to the first position VP4a. As a result, the first swash plate switching cylinder 32L contracts, and the speed of the left hydraulic motor 31L is changed to the first speed. When the valve element of the direction switching valve SV2 is switched to the second position VP2b by the operation of the human-machine interface, the pilot oil is supplied to the first travel control valve SV4 through the direction switching valve SV2, and the valve element of the first travel control valve SV4 is switched to the second position VP4b. As a result, the first swash plate switching cylinder 32L is extended, and the speed of the left hydraulic motor 31L is changed to the second speed.
The right hydraulic motor device 30R is a device configured to generate a driving force of the work vehicle to transmit power to the drive wheel 31 provided in the right traveling device 3R. The right hydraulic motor device 30R includes a right hydraulic motor 31R, a second swash plate switching cylinder 32R, and a second travel control valve (hydraulic switching value) SV5. The right hydraulic motor device 30R is a hydraulic motor configured to drive the right traveling device 3R, and operates in the same manner as the left hydraulic motor 31L. That is, the right hydraulic motor 31R operates in the same manner as the left hydraulic motor 31L. The left hydraulic motor 31L and the right hydraulic motor 31R are collectively referred to as hydraulic motors (31L, 31R). The second swash plate switching cylinder 32R operates in the same manner as the first swash plate switching cylinder 32L. The second travel control valve SV5 is a two-position switching valve configured to switch its valve element between the first position VP5a and the second position VP5b, and operates in the same manner as the first travel control valve SV4.
The hydraulic circuit 1A is connected to a drain oil passage DR1. The drain oil passage DR1 is an oil passage to make the pilot oil flow from a plurality of switching valves (brake switching valves SV1 and a direction switching valves SV2) to the hydraulic fluid tank 70. For example, the drain oil passage DR1 is connected to discharge ports of a plurality of switching valves (brake switching valves SV1 and direction switching valves SV2). That is, when the brake switching valve SV1 is at the first position VP1a, the hydraulic fluid is discharged from the oil passage PA2 to the drain oil passage DR1 in the interval between the brake switching valve SV1 and the brake mechanism 72. When the direction switching valve SV2 is at the first position VP1a, the pilot oil in the oil passage PA3 is discharged to the drain oil passage DR1.
The hydraulic circuit 1A further includes a first charge oil passage PA4 and a hydraulic drive device 75. The first charge oil passage PA4 is branched from the pilot oil supply passage PA1 and connected to the hydraulic drive device 75. The hydraulic drive device 75 is a device that drives the left hydraulic motor device 30L and the right hydraulic motor device 30R. The hydraulic drive device 75 includes a first drive circuit 76L for driving the left hydraulic motor device 30L and a second drive circuit 76R for driving the right hydraulic motor device 30R.
The first drive circuit 76L includes a left hydraulic pump 7L, a driving oil passage PA5L, PA6L, and a second charge oil passage PA7L. The driving oil passages PA5L and PA6L are oil passages that connect the left hydraulic pump 7L and the left hydraulic motor 31L. The hydraulic circuit formed by the driving oil passages PA5L and PA6L is referred to as a left hydraulic circuit CL. The second charge oil passage PA7L is an oil passage that is connected to the driving oil passages PA5L and PA6L and replenishes the driving oil passages PA5L and PA6L with the hydraulic fluid from the pilot pump 71. The left hydraulic motor 31L has a first connection port 31P1 connected to the driving oil passage PA5L and a second connection port 31P2 connected to the driving oil passage PA6L. The hydraulic fluid for rotating the left traveling device 3L in the forward direction is input to the left hydraulic motor 31L via the first connection port 31P1, and the hydraulic fluid for rotating the left traveling device 3L in the backward direction is discharged from the left hydraulic motor 31L via the first connection port 31P1. The hydraulic fluid for rotating the left traveling device 3L in the backward direction is input to the left hydraulic motor 31L via the second connection port 31P2, and the hydraulic fluid for rotating the left traveling device 3L in the forward direction is discharged from the left traveling device 3L.
Similarly, the second drive circuit 76R includes a right hydraulic pump 7R, driving oil passages PA5R and PA6R, and a third charge oil passage PA7R. The driving oil passages PA5R and PA6R are oil passages that connect the right hydraulic pump 7R and the right hydraulic motor 31R. The hydraulic circuit formed by the driving oil passages PA5R and PA6R is referred to as a right hydraulic circuit CR. The third charge oil passage PA7R is an oil passage that is connected to the driving oil passages PA5R and PA6R and replenishes the driving oil passages PA5R and PA6R with the hydraulic fluid from the pilot pump 71. The right hydraulic motor 31R includes a third connection port 31P3 connected to the driving oil passage PA5R, and a fourth connection port 31P4 connected to the driving oil passage PA6R. The hydraulic fluid for rotating the right traveling device 3R in the forward direction is input to the right hydraulic motor 31R via the third connection port 31P3, and the hydraulic fluid for rotating the right traveling device 3R in the backward direction is discharged from the right hydraulic motor 31R via the third connection port 31P3. The hydraulic fluid for rotating the right traveling device 3R in the backward direction is input to the right hydraulic motor 31R via the fourth connection port 31P4, and the hydraulic fluid for rotating the right traveling device 3R in the forward direction is discharged from the right traveling device 3R. That is, the hydraulic motor (31L, 31R) is configured to drive the traveling device (3L, 3R). The hydraulic pumps (7L, 7R) are configured to discharge hydraulic fluid for driving the hydraulic motors (31L, 31R). The driving oil passages (PA5L, PA6L, PA5R, PA6R) are oil passages that connect the hydraulic pumps (7L, 7R) and the hydraulic motors (31L, 31R).
The left hydraulic pump 7L and a right hydraulic pump 7R are a swash plate type variable capacity axial pump which is driven by the power of the engine 6. The left hydraulic pump 7L which is connected to a left hydraulic motor 31L via a left hydraulic circuit CL includes a first port Pla and a second port PLb to which pilot pressure acts. The angle of the swash plate in the left hydraulic pump 7L is changed by the pilot pressure acting on the first port PLa and the second port PLb. Specifically, the left hydraulic pump 7L is configured to supply hydraulic fluid to a left hydraulic motor 31L via a left hydraulic circuit CL so as to drive a left traveling device 3L forward when the hydraulic pressure applied to a first port PLa is higher than the hydraulic pressure applied to a second port PLb, and to supply hydraulic fluid to the left hydraulic motor 31L via a left hydraulic circuit CL so as to drive the left traveling device 3L backward when the hydraulic pressure applied to a second port PLb is higher than the hydraulic pressure applied to a first port PLa.
The right hydraulic pump 7R is connected to the right hydraulic motor 31R via the right hydraulic circuit CR, and has a third port PRa and a fourth port PRb on which the pilot pressure acts. The right hydraulic pump 7R is configured such that the angle of the swash plate is changed by the pilot pressure acting on the third port PRa and the fourth port PRb, and supply hydraulic fluid to the right hydraulic motor 31R. To be more specific, the right hydraulic pump 7R is configured to supply the hydraulic fluid to the right hydraulic motor 31R via the right hydraulic circuit CR so as to drive the right traveling device 3R forward when the hydraulic pressure applied to the third port PRa is higher than the hydraulic pressure applied to the fourth port PRb, and to supply the hydraulic fluid to the right hydraulic motor 31R via the right hydraulic circuit CR so as to drive the right traveling device 3R backward when the hydraulic pressure applied to the fourth port PRb is higher than the hydraulic pressure applied to the third port PRa. The left hydraulic pump 7L and the right hydraulic pump 7R can change outputs (discharge amounts of the hydraulic fluid) and discharge directions of the hydraulic fluid in accordance with the angle of the swash plate.
The outputs of the left and right hydraulic pumps 7L and 7R and the discharge direction of the hydraulic fluid are changed by the operation device 56 for operating the traveling direction of the work vehicle 1. To be specific, the outputs of the left and right hydraulic pumps 7L and 7R and the discharge direction of the hydraulic fluid are changed in accordance with the operation of the operation lever 55 included in the operation device 56. That is, the operation device 56 is a device configured to select at least one of the left traveling device 3L and the right traveling device 3R and instruct at least one of the traveling devices to move forward or backward, thereby operating the traveling direction of the work vehicle. The user inputs an instruction of the traveling direction via the operation lever 55. The operation lever 55 may be referred to as an additional human-machine interface. A position of the operation lever 55 is, for example, an indicated position of the additional human-machine interface.
As shown in
The operation device 56 includes an operation valve OVA for forward movement, an operation valve OVB for backward movement, an operation valve OVC for right turning, an operation valve OVD for left turning, and an operation lever 55. The operation device 56 includes first to fourth shuttle valves SVa, SVb, SVc, and SVd. The operation valves OVA, OVB, OVC, and OVD are operated by one operation lever 55. The operation valves OVA, OVB, OVC, and OVD change the pressure of the hydraulic oil in accordance with the operation of the operation lever 55, and supply the changed hydraulic fluid to the first port PLa and the second port PLb of the left hydraulic pump 7L and the third port PRa and the fourth port PRb of the right hydraulic pump 7R. In this embodiment, the operation valves OVA, OVB, OVC, and OVD are operated by one operation lever 55, but the number of operation levers 55 may be plural.
The operation valves OVA, OVB, OVC, and OVD each have an input port (primary port), a discharge port, and an output port (secondary port). As shown in
The secondary ports of the operation valves OVA and OVC are connected to the input ports of the first shuttle valves SVa, and the output ports of the first shuttle valve SVa are connected to the first port PLa of the left hydraulic pump 7L via the first pilot oil passage PA11. The secondary ports of the operation valves OVA and OVD are connected to the inlet ports of the second shuttle valves SVb, and the outlet ports of the second shuttle valves SVb are connected to the third ports PRa of the right hydraulic pumps 7R via the third pilot oil passages PA13. The secondary ports of the operation valves OVB and OVD are connected to the inlet port of the third shuttle valve SVc, and the outlet port of the third shuttle valve SVc are connected to the second port PLb of the left hydraulic pump 7L via the second pilot oil passage PA12. The secondary ports of the operation valves OVB and OVC are connected to the inlet port of the fourth shuttle SVd, and the outlet port of the fourth shuttle SVd is connected to the fourth port PRb of the right hydraulic pump 7R via the fourth pilot passage PA14. That is, the pilot oil supply passage PA8, the first pilot oil passage PA11, and the fourth pilot oil passage PA14 connect the pilot pump 71 and the left hydraulic pump 7L. The pilot oil supply passage PA8, the second pilot oil passage PA12, and the third pilot oil passage PA13 connect the pilot pump 71 and the right hydraulic pump 7R.
When the operation lever 55 is tilted forward, the operation valve OVA for forward movement is operated, and a pilot pressure is output from the operation valve OVA. This pilot pressure acts on the first port PLa from the first shuttle valve SVa via the first pilot oil passage PA11 connecting the operation device 56 and the first port PLa of the left hydraulic pump 7L, and acts on the third port PRa via the third pilot oil passage PA13 connecting the operation device 56 and the third port PRa of the right hydraulic pump 7R from the second shuttle valve SVb. As a result, the output shafts of the left and right hydraulic pumps 7L and 7R rotate in the normal direction (forward direction) at a speed corresponding to the amount of tilt of the operation lever 55, and the work vehicle 1 moves straight forward.
Further, the operation lever 55 is tilted backward, the operation valve for backward movement is operated, and the pilot pressure is output from the operation valve OVB. The pilot pressure acts on the second port PLb of the left hydraulic pump 7L from the third shuttle valve SVc via the second pilot oil passage PA12 connecting the operation device 56 and the second port, and acts on the fourth port PRb from the fourth shuttle SVd via the fourth pilot oil passage PA14 connecting the operation device 56 and the fourth port PRb of the right hydraulic pump 7R. As a result, the output shafts of the left and right hydraulic pumps 7L and 7R are reversed (backward rotation) at a speed corresponding to the amount of tilt of the operation lever 55, so that the work vehicle 1 travels straight backward.
When the operation lever 55 is tilted to the right side, the operation valve OVC for right turning is operated, and the pilot pressure is output from the operation valve OVC. This pilot pressure acts on the first port PLa of the left hydraulic pump 7L from the first shuttle valve SVa via the first pilot oil passage PA11, and acts on the fourth port PRb of the right hydraulic pump 7R from the fourth shuttle valve SBd via the fourth pilot oil passage PA14. Thereby the vehicle curves to the right with a degree of curvature corresponding to the operation position in the right direction of the operation lever 55.
When the operation lever 55 is tilted to the left side, the operation valve OVD for left turning is operated, and the pilot pressure is output from the operation valve OVD. This pilot pressure acts on the third port PRa of the right hydraulic pump 7R from the second shuttle valves SVb via the third pilot oil passage PA13, and also acts on the second port PLb of the left hydraulic pump 7L from the third shuttle valve SVc via the second pilot oil passage PA12. Thus, the vehicle turns leftward with a degree of bending corresponding to the leftward operation position of the operation lever 55.
That is, when the operation lever 55 is tilted obliquely forward to the left, the work vehicle 1 moves forward at a speed corresponding to the operation position of the operation lever 55 in the front-rear direction, and curves to the left in a manner corresponding to the operation position of the operation lever 55 in the left direction. When the operation lever 55 is tilted obliquely forward to the right, the work vehicle 1 turns to the right while moving forward at a speed corresponding to the operation position of the operation lever 55. When the operation lever 55 is operated to tilt obliquely rearward to the left, the work vehicle 1 turns to the left while moving rearward at a speed corresponding to the operation position of the operation lever 55. When the operation lever 55 is tilted obliquely rearward to the right, the work vehicle 1 turns to the right while moving backward at a speed corresponding to the operation position of the operation lever 55.
Next, the detailed operation of the primary pressure control valve CV1 will be described. The work vehicle 1 includes a setting member 11 (see
The primary pressure control valve CV1 can set the a pilot pressure (primary pilot pressure) that acts on the input ports (primary-side ports) of the plurality of operation valves OVA, OVB, OVC, and OVD based on a decrease amount (drop amount) ΔE1 of the rotation speed of the engine 6 (engine rotation speed E1). That is, the primary pressure control valve CV1 is a control valve that is provided between the pilot pump 71 and the operation valves OVA, OVB, OVC, and OVD, and is configured to send the pilot oil to the operation valves OVA, OVB, OVC, and OVD and convert the pressures of the pilot oil supplied to the operation valves OVA, OVB, OVC, and OVD into the primary pilot pressures. The rotation speed of the engine 6 can be detected by a speed sensor 6a of the engine rotation speed E1. The engine rotation speed E1 detected by the speed sensor 6a is input to the controller 10. The speed sensor 6a may be referred to as a speed sensor.
When the amount of decrease ΔE1 is less than the anti-stall determination value, the controller 10 adjusts the opening degree of the primary pressure control valve CV1 so that the relationship between the engine rotation speed E1 and the primary pilot pressure matches the reference pilot pressure indicated by the setting line L1. Further, when the amount of decrease ΔE1 is equal to or greater than the anti-stall determination value, the controller 10 adjusts the opening degree of the primary pressure control valve CV1 so that the relationship between the engine rotation speed E1 and the primary pilot pressure matches the setting line L2 lower than the reference pilot pressure. In the setting line L2, the primary pilot pressure for a predetermined engine rotation speed E1 is lower than the primary pilot pressure of the setting line L1. That is, when focusing on the same engine rotation speed E1, the primary pilot pressure of the setting line L2 is set to be lower than the primary pilot pressure of the setting line L1. Therefore, the pressures (pilot pressures) of the hydraulic fluids entering the operation valves OVA, OVB, OVC, and OVD are suppressed to be low by the control based on the setting line L2. As a result, the angles of the swash plates of the left and right hydraulic pumps 7L and 7R are adjusted, and the load acting on the engine 6 is reduced, thereby preventing the engine 6 from stalling. Although one setting line L2 is shown in
Next, the pilot pressure (secondary pilot pressure) output from the secondary port of the operation valves OVA, OVB, OVC, and OVD will be described.
In the neutral region RA1, the secondary pilot pressure is not supplied even if the operation lever 55 is operated. On the other hand, in the full operation vicinity region RA2, the speed of the operation target is not adjusted, and therefore, the operation lever 55 is operated to the operation terminal position (G5 position) without stopping in the middle. In the intermediate region RA3, the speed of the operation target is adjusted to a speed desired by the operator by stopping the operation lever 55 at an arbitrary position in the region or changing the position. For example, the ratio of each of the operation regions RA1, RA3A, RA3B, and RA2 to the lever stroke is as follows.
In the characteristic diagram shown in
Based on the characteristics of the operation valves OVA, OVB, OVC, and OVD, the movement of the work vehicle 1 corresponding to the operation of the operation lever 55 will be described in more detail. When the operation amount of the operation lever 55 in the front-rear direction is larger than the operation amount in the right direction, the operation position in the right direction is operated from the G1 position to the G3 position, the left hydraulic pump 7L rotates in the same direction in a state where the magnitude of the rotation speed of the left hydraulic pump 7L is larger than the magnitude of the rotation speed of the right hydraulic pump 7R, whereby the work vehicle 1 turns right in a large circle. When the operation position of the operation lever 55 in the right direction becomes the same position as the operation position in the front-rear direction, the rotation speed of the right hydraulic pump 7R becomes 0, and only the left hydraulic pump 7L rotates, whereby the work vehicle 1 make a right pivot turn (right pivot turn). Further when the operation lever 55 is operated when the operation position in the right direction is between the G4 position and G5 position, the operation amount becomes larger than that of the operating position in the longitudinal direction, the output shaft of the left hydraulic pump 7L rotates in the normal direction and the output shaft of the right hydraulic pump 7R rotates in the reverse direction, so that the work vehicle 1 turns to the right side.
Further, when the operation amount of the operation lever 55 in the front-rear direction is larger than the operation amount of the operation lever 55 in the left direction and the operation position of the operation lever 55 in the left direction is operated from the G1 position to the G3 position, the right hydraulic pump 7R rotates in the same direction in a state where the magnitude of the rotation speed of the right hydraulic pump 7R is larger than the magnitude of the rotation speed of the left hydraulic pump 7L, whereby making the work vehicle curve advance to the left with a long turn. When the operation position of the operation lever 55 in the left direction is the same as the operation position in the front-rear direction, the rotation speed of the left hydraulic pump 7L becomes 0, and only the right hydraulic pump 7R rotates, this allows the work vehicle 1 pivot turn to the left. Further, when the operation lever 55 is operated to the left between the G4 position and the G5 position, the operation amount becomes larger than that of the operation position in the front-back direction, the right hydraulic pump 7R rotates in the normal direction, and the left hydraulic pump 7L rotates in the reverse direction, whereby making the work vehicle turn to the left. In the present embodiment, turning refers to the operation of the work vehicle 1 when the operation position in the right direction is operated between the G4 position to the G5 position, or when the operation position in the left direction is operated from the G4 position to the G5 position.
On the other hand, when the operation lever 55 is operated to the forward operation position between the G4 position and the G5 position, the operation amount becomes larger than that of the operation position in the lateral direction, and the left and right hydraulic pumps 7L and 7R rotate in the normal direction to move the work vehicle 1 forward at high speed. When the operation lever 55 is operated to the position between the G4 position and the G5 position, the operation amount in the rearward direction becomes larger than the operation amount in the lateral direction, and the drive shaft of the left and right hydraulic pumps 7L and 7R are reversed to move the work vehicle 1 backward at high speed. The other operations of the operation lever 55 in the front-rear direction are the same as those in the right-left direction.
The work vehicle 1 is provided with various switches and sensors connected to the controller 10 described above.
In the normal mode, the target rotation speed of the engine 6 is set by the operation of the setting member 11, and the primary pilot pressure corresponding to the target rotation speed is obtained based on the setting line L1 or L2 of
Referring to
The work vehicle 1 includes a hydraulic sensor SP5L for detecting the hydraulic pressure of the driving oil passage PA5L, a hydraulic sensor SP6L for detecting the hydraulic pressure of the driving oil passage PA6L, a hydraulic sensor SP5R for detecting the hydraulic pressure of the driving oil passage PA5R, and a hydraulic sensor SP6R for detecting the hydraulic pressure of the driving oil passage PA6R. That is, the hydraulic sensors (SP5L, SP6L, SP5R, SP6R) are configured to detect the hydraulic pressure of the hydraulic fluid in the driving oil passages (PA5L, PA6L, PA5R, PA6R). The states of the left hydraulic motor 31L and the right hydraulic motor 31R can be detected from the difference between the pressures of the hydraulic sensor SP5L and the hydraulic sensor SP6L and the difference between the pressures of the hydraulic sensor SP5R and the hydraulic sensor SP6R.
Referring to
The controller 10 includes a processor 10a and a memory 10b as shown in
The first reference information 10r1 represents a first correspondence relationship between the rotation speed RS of the engine 6 detected by the speed sensor 6a and the primary pilot pressure in the normal mode. That is, the first reference information 10r1 represents the first correspondence relationship represented by the setting line L1 of
The processor 10a executes the following control while executing the travel control program 10r1 with reference to the first reference information 10r1 and the second reference information 10r2. First, the processor 10a is configured to acquire the rotation speed RS of the engine 6 from the speed sensor 6a when the normal mode is selected by the creep setting member 16, to obtain the primary pilot pressure corresponding to the detected rotation speed RS of the engine 6 from the first reference information 10r1, and to control the primary pressure control valve CV1 so as to achieve the obtained primary pilot pressure. When the drop amount of the engine 6 is large when the normal mode is selected, the processor 10a (examples of determination circuitry and pump control circuitry) obtains the primary pilot pressure corresponding to the rotation speed RS of the engine 6 detected by the speed sensor 6a from the second reference information 10r2, and configured to control the primary pressure control valve CV1 so as to achieve the obtained primary pilot pressure.
The memory 10b further includes third reference information 10r3 and fourth reference information 10r4. When the creep mode is selected by the creep setting member 16, the processor 10a determines the target rotation speed RSi of the hydraulic motors (31L, 31R) by receiving the upper limit speed input by the creep setting member 16. The target rotation speed RSi is the target rotation speed RSiL of the hydraulic motors (31L, 31R) when the work vehicle 1 is assumed to travel straight. When the operation lever 55 is operated in this state, the operation device 56 sets the secondary pilot pressure based on the characteristics as shown in
In the creep mode, the processor 10a sets the target rotation speed of the engine 6 based on the operation amount of the creep setting member 16. The processor 10a (an example of prime mover control circuitry) outputs a rotation command indicating, for example, a fuel injection amount, an injection timing, and a fuel injection rate to the injector so that the determined target rotation speed of the engine 6 (an example of prime mover) is achieved. Alternatively, the processor 10a outputs a rotation command indicating a fuel injection pressure and the like to the supply pump and the common-rail so that the determined target rotation speed of the engine 6 is achieved. For example, the processor 10a may rotate the engine 6 at the same predetermined rotation speed at all the target rotation speeds RSi. When the setting member 11 is operated in the creep mode, the target rotation speed RSi or the target rotation speed RSiL of the engine 6 may be changed in response to the operation, as in the case of the creep setting member 16, instead of changing the target rotation speed of the engine 6 as in the normal mode.
The control current value u0V1 is preferably derived from the target rotation speed RSi based on the following. As described above, the processor 10a calculates the reference value u0v1 of the control current value of the primary pressure control valve CV1 so that the hydraulic motors (7L, 7R) rotate at the target rotation speed RSi in a state where the left and right traveling devices (3L, 3R) do not receive resistance from the road surface when the rotation speed of the engine 6 in the creep mode is known from the target rotation speed RSi and the primary pilot pressure corresponding to the target rotation speed RSi is applied to the hydraulic pumps (31L, 31R).
The feedback controller Cbbv1 is configured to derive an offset value uAV1 corresponding to a speed difference e of larger absolute values among speed differences e (eL, eR) obtained by subtracting the target rotation speed RSi from the rotation speeds (RSdL, RSdR) of the hydraulic motors (31L, 31R) detected by the rotation speed sensors (SR31L, SR31R) at every sampling interval Ts. The processor 10a (examples of motor rotation detection circuitry and determination circuitry) is configured to receive the rotation speeds (RSdL, RSdR) of the hydraulic motors (31L, 31R) detected at every sampling interval Ts from the rotation speed sensors (SR31L, SR31R) and calculate the speed difference e (eL, eR) obtained by subtracting the target rotation speed RSi from the rotation speeds (RSdL, RSdR) at the every sampling interval Ts. The processor 10a (an example of determination circuitry) is configured to calculate the offset value uAV1 corresponding to the speed difference e having a larger absolute magnitude of the speed differences e (eL, eR) at every sampling interval Ts. The processor 10a (an example of determination circuitry) input the sum of the reference value u0v1 and the offset value uAv1 to the primary pressure control valve uv1 as the control parameter uv1. That is, the processor 10a (an example of determination circuitry) applies the current of the control current value uv1 to the solenoid of the primary pressure control valve CV1. The processor 10a (an example of pump control circuitry) sends a command corresponding to the control parameter uv1 to the primary pressure control valve CV1 (control mechanism, hydraulic control circuit) which controls the displacement volume of the hydraulic pumps (7L, 7R). The processor 10a thereby controls the displacement volume of the hydraulic pumps (7L, 7R) in response to the control parameter uv1 described above. The processor 10a rotates the hydraulic motors (31L, 31R) by controlling the engine 6 to rotate the hydraulic pumps (7L, 7R).
The processor 10a updates the control parameter uv1 at every sampling interval Ts. More specifically, the processor 10a updates the offset value uAV1 at every sampling interval Ts.
The processor 10a is configured to perform the operations as above-described processing to increase, decrease, maintain and reset the offset value uAV1 at every sampling interval Ts with reference to the speed difference e. That is, when the speed difference e is continuously smaller than the predetermined negative second threshold value −e for a time period five times a sampling interval Ts, the offset value uAV1 is increased to five time of the second feedback control value d2v1. The initial value of the offset value uAV1 is 0. Since the reference value u0V1 of the control current value is a value that is assumed to have no external load, the speed difference e tends to be negative at the beginning of the control only by the control using the reference value u0V1, and the speed difference e is generally smaller than the second threshold value −ae, and the offset value uAV1 becomes positive by adding the third feedback control value uAV1 described later. Further, the processor 10a is configured to set the control parameter uV1 to the upper limit value umaxv1 when the value (uV1) obtained by adding the offset value uAv1 to the reference value u0v1 exceeds the predetermined upper limit value umaxv1.
When the speed difference e is smaller than the predetermined negative second threshold value −ae, the speed difference e is increased to the second feedback control value d2v1, whereby the offset value uAV1 is increased at the time of standstill when the running resistance is large, and the time until the start of running can be shortened. The absolute values d1v1 of the first feedback control value are larger than the absolute value d2v1 of the second feedback control value. Thus, the offset value uAV1 is rapidly decreased, and thereby it is possible to prevent the work vehicle 1 from being excessively accelerated due to a large decrease in the travel resistance at the start of the movement.
Further, the processor 10a is configured to add a third feedback control value d3v1 that is larger than the second feedback control value d2v1 to the offset value uAv1 when the operation lever 55 is shifted from the neutral position. Since the operation lever 55 is often set to the neutral position when the work vehicle 1 is stationary, the offset value uAv1 can be rapidly increased when the torque of the hydraulic motors (31L, 31R) is required from the stationary state to the start of movement, and thus the time until the start of travel can be shortened.
In the normal mode (No in step S2), in step S3, the processor 10a acquires the rotation speed RS of the engine 6 detected by the speed sensor 6a. Then, the processor 10a determines whether or not there is an engine drop. That is, in step S9, the processor 10a is configured to determine whether the amount of decrease ΔE1 of the engine 6 is equal to or greater than an anti-stall determination value. When the engine drop does not occur (No in step S3), in step S4, the processor 10a obtains the control parameter (the control current value of the primary pressure control valve CV1) corresponding to the primary pilot pressure from the first reference information 10r1 based on the rotation speed RS of the engine 6. When the engine drop is present (Yes in step S3), in step S5, the processor 10a obtains a control parameter (a control current value of the primary pressure control valve CV1) corresponding to the primary pilot pressure from the second reference information 10r2 based on the rotation speed RS of the engine 6. After the process of step S4 or step S5 is completed, the process of step S6 is executed.
In step S6, the processor 10a applies a current corresponding to the control parameter (the control current value of the primary pressure control valve CV1) obtained in step S4 or step S5 to the solenoid of the primary pressure control valve CV1 which sends to operation valve OVA, OVB, OVC, OVD. That is, the control method according to the present embodiment includes controlling the displacement volume of the hydraulic pumps (7L, 7R) in accordance with the control parameter (the control current value of the primary pressure control valve CV1). In step S7, the operation valves OVA, OVB, OVC, and OVD convert the primary pilot pressure into the secondary pilot pressure based on the operation lever 55 position (first operation amount) of the operation lever 55 (first operation device). In step S8, the pilot oil of the secondary pilot pressure is applied to ports (PLa, PRa, PLb, PRb) for providing hydraulic pressure to swash plates of hydraulic pumps (7L, 7R), and thereby the hydraulic pumps (7L, 7R) and the hydraulic motors (31L, 31R) are controlled. By means of the steps S1 and S8, the processor 10a is configured to rotate the hydraulic motors (31L, 31R) via the hydraulic pumps (7L, 7R) by sending commands to the engine 6 to drive the engine 6, which is configured to rotate the hydraulic pumps (7L, 7R), in response to the control parameters. The control method according to the present embodiment includes rotating the hydraulic motors (31L, 31R) by rotating the hydraulic pumps (7L, 7R).
In the creep mode (Yes in step S2), in step S9, the processor 10a receives an input corresponding to the target rotation speed RSi of the hydraulic motor (31L, 31R) configured to drive the traveling device (3L, 3R) from the creep setting member 16. That is, the control method according to the present embodiment acquires the target rotation speed RSi of the hydraulic motor (31L, 31R) configured to drive the traveling device (3L, 3R) via the creep setting member 16. In step S10, the processor 10a performs the processing of the feedforward controller Cfv1 and the feedback controller Cbbv1, and outputs the control parameter uV1. That is, the control method according to the present embodiment includes determining the control parameter uV1 for setting the displacement volume of the hydraulic pumps (7L, 7R) configured to supply the hydraulic motors (31L, 31R) with the hydraulic fluid in response to the operation of the creep setting member 16. Thereafter, in steps S6 to S8, the same control as in the normal mode is performed.
When the operation lever 55 is in the neutral position (Yes in step S11), the processor 10a sets the control parameter uV1 to 0 and resets the offset value uV1 to 0 in step 12.
When the operation lever 55 is not in the neutral position (No in step S11), in step S13, the processor 10a obtains the reference value u0V1 of the control parameter uV1 based on the target rotation speed RSi. In step S13, the processor 10a receives the rotation speeds (RSdL, RSdR) of the hydraulic motors (31L, 31R) detected at every sampling interval Ts from the rotation speed sensors (SR31L, SR31R). In step S15, the processor 10a calculates the speed difference e (eL, eR) obtained by subtracting the rotation speed (RSdL, RSdR) from the target rotation speed RSi at every sampling interval Ts.
Next, in step S16, the processor 10a determines whether or not the operation lever 55 is shifted from the neutral position. The processor 10a may determine that the operation lever 55 is in the neutral position at the immediately preceding sampling time and determine whether the operation lever 55 is determined not to be in the neutral position at step S11 at the current sampling time, but the processor 10a may determine that the operation lever 55 is shifted from the neutral position when the operation lever 55 is determined not to be in the neutral position at step S11 continuously for a predetermined multiple of the sampling interval Ts in consideration of noise or the like and the operation lever 55 is determined not to be in the neutral position immediately before that.
When it is determined that the operation lever 55 is shifted from the neutral position (Yes in step S16), in step S17, the processor 10a adds the third feedback control value d3v1 to the offset value uAv1. If it is determined that the operation lever 55 is not shifted from the neutral position (No in step S16) or if step S17 is finished, the process proceeds to step S18. In step S18, the processor 10a determines whether or not the speed difference e of which the absolute value is larger among the speed difference (eL, eR) is within the following range.
When the speed difference e is larger than the third value ag, in step S19, the processor 10a resets the offset value uAv1 to 0. When the speed difference e is larger than the first reference value af and equal to or smaller than the third reference value ag, the processor 10a subtracts the first feedback control value d1v1 from the offset value uAv1 in step S20. When the speed difference e is equal to or less than the first threshold value af and equal to or more than the second threshold value −ae, in step S21, the processor 10a does not change the offset value uAv1. When the speed difference e is smaller than the second threshold value −ae, the processor 10a adds the second feedback control value d2v1 to the offset value uAV1 in step S22. By processing from step S19 to step S22, the processor 10a calculates the offset value uAV1 corresponding to the speed difference e at every sampling interval Ts.
In step S23, the processor 10a determines whether or not the sum of the reference value u0V1 and the offset value uAV1 exceeds a predetermined upper limit value umaxv1. When the sum of the reference value u0V1 and the offset value uAV1 exceeds the upper limit value umaxv1 (Yes in step S23), in step S24, the processor 10a set the control parameter uV1 as the upper limit value umaxv1. When the sum of the reference value u0V1 and the offset value uAV1 is equal to or smaller than the upper limit value umaxv1 (No in step S23), in step S25, the processor 10a updates the control parameter uV1 at every sampling interval Ts by setting the control parameter uV1 to a value obtained by adding the offset value to the reference value.
The work vehicle 1 according to the present embodiment adds the second feedback control value d2v1 to the offset value uAV1 when the speed difference e is smaller than the second threshold value −ae. Therefore, even when the travel resistance is large at the start of travel of the work vehicle 1, the travel can be started quickly. When the speed difference e is greater than the first threshold value af and equal to or less than the third threshold value ag, the work vehicle 1 subtracts the first feedback control value d1v1, which is greater than the second feedback control value d2v1, from the offset value uAv1. Furthermore, when the speed difference e is greater than the third threshold value ag, in step S19, the processor 10a resets the offset value uAv1 to 0. Therefore, it is possible to prevent the work vehicle 1 from being excessively accelerated due to a large decrease in the travel resistance at the start of movement.
As a modification of the first embodiment, the control system 20A may be a combination of the feedback controller Cbv1 described in United States Patent Application Publication No. 2024/0060274 A1 as a feedback controller. United States Patent Application Publication No. 2024/0060274 A1 is incorporated by reference. Alternatively, the control system 20A may be a combination of the feedback controllers Cbv11 and Cbv12 described in United States Patent Application Publication No. 2024/0060274 A1 as a feedback controller.
In the first embodiment, the primary pilot pressure is controlled to realize the creep mode, but the secondary pilot pressure may be controlled.
The relief valves CV23 and CV24 are balance type relief valves whose set pressures to be opened are variable based on the pressures of the pilot oil, and include control ports 23a and 24a for receiving the pressures of the pilot oil. The relief valves CV23, CV24 are configured to open when the pressures on the input ports are greater than the pressures on the control ports 23a, 24a. At this time, the pilot oil is discharged to the hydraulic fluid tank 70. The proportional valves CV21 and CV22 are connected to the hydraulic fluid passages 21 and 22 connected to the control ports 23a and 24a, and are supplied with pilot fluid from the pilot pump 71. The proportional valves CV21 and CV22 are electromagnetic proportional valves whose opening degrees can be changed by exciting solenoids, and are controlled by the controller 10.
The proportional valves CV21, CV22 are connected to a pilot oil supply passage PA1, and are controlled to be a hydraulic pressure obtained by adding an offset a considering that pilot oil flows out from relief valves CV23, CV24, etc., to a primary pressure control valve CV1 in a first embodiment in the creep mode, and are operated so that the value of the setting line L1 plus the offset a is obtained when the anti-stall control is not performed in the normal mode, and the value of the setting line L2 plus the offset a is obtained when the anti-stall control is performed. The proportional valves CV21 and CV22 may be referred to as secondary pressure control valves CV2.
The controller 10 performs feedback control for controlling the control valves (proportional valves CV21 and CV22) of the pilot pressure of the hydraulic pumps (7L and 7R) based on the speed differences (eL and eR) between the target rotation speed RSi of the hydraulic motors (31L and 31R) corresponding to the target vehicle speed and the detected rotation speeds RSd. The control parameter is input to the secondary pressure control valve CV2 that adjusts the secondary pilot pressure, which is the hydraulic pressure of the pilot oil passage connecting the operation valves OVA, OVB, OVC, and OVD controlled by the travel instruction input device (operation lever 55) to which the user's instruction of the travel direction is input and the pilot ports (PLa, PRa, PLb, and PRb) of the hydraulic pumps (7L and 7R).
The discharge oil passage DR3 is connected to the first pilot oil passage PA11. The discharge oil passage DR4 is connected to the second pilot oil passage PA12. The discharge oil passage DR5 is connected to the third pilot oil passage PA13. The discharge oil passage DR6 is connected to the fourth pilot oil passage PA14. The check valves CK1 to CK4 block the discharge oil passages DR3 to DR4 unless the pressures on the sides of the throttle TH1 to TH4 become higher than the pressures on the sides of the relief valves CV23 and CV24 by a predetermined value or more.
Since the pilot pressure of the discharge oil passage DR3 and the discharge oil passage DR4 becomes high when the left hydraulic pump 7L rotates in the normal direction and the reverse direction, respectively, when the pilot pressure of one of the discharge oil passage becomes equal to the primary pilot pressure, the other becomes significantly smaller than the primary pilot pressure. Since the pilot pressure becomes high when the right hydraulic pump 7R rotates in the normal direction and in the reverse direction, respectively, the pilot pressure of one of the discharge oil passage DR5 and the discharge oil passage DR6 becomes much smaller than the primary pilot pressure when the pilot pressure of the other one of the discharge oil passage DR5 and the discharge oil passage DR6 becomes equal to the primary pilot pressure. Therefore, only one of the check valves CK1 and CK2 is normally opened. Therefore, the above-described control can be executed by controlling the pressures of the proportional valves CV21 and CV22 so that the pressures of the proportional valves CV21 and CV22 are pressures obtained by adding a loss of pressures due to the pilot oil flowing out from the relief valves CV23 and CV24 to the pressures by the control of the primary pressure control valve CV1 according to the first embodiment.
The throttle TH1 is provided on a first pilot oil passage PA11 between the first shuttle valve SVa and the discharge oil passage DR3, and is configured to reduce the flow rate of the pilot oil in the first pilot oil passage PA11. The throttle TH2 is provided in the second pilot oil passage PA12 between the second shuttle valves SVb and the discharge oil passage DR4, and is configured to reduce the flow rate of the pilot oil in the second pilot oil passage PA12. The throttle TH3 is provided in the third pilot oil passage PA13 between the third shuttle valves SVc and the discharge oil passage DR5, and is configured to reduce the flow rate of the pilot oil in the third pilot oil passage PA13. The throttle TH4 is provided in the fourth pilot oil passage PA14 between the fourth shuttle valves SVd and the discharge oil passage DR6, and is configured to reduce the flow rate of the pilot oil in the fourth pilot oil passage PA14.
The target rotation speed RSi is a target rotation speed of the hydraulic motors (31L, 31R) when the work vehicle 1 is assumed to travel straight. In the present embodiment, the secondary pilot pressure is an example of a control parameter for setting the displacement volume of the hydraulic pumps (7L, 7R) configured to supply the hydraulic motors (31L, 31R) with the hydraulic fluid. In the present embodiment, the secondary pressure control valve CV2 is an example of the control mechanism (hydraulic control circuit) configured to control the hydraulic pressure of the pilot oil that changes the displacement volume of the hydraulic pumps (31L, 31R). Since the secondary pilot pressure is determined based on the current applied to the solenoid of the secondary pressure control valve CV2 (control mechanism, hydraulic control circuit), the control parameter may be a current value (control current value) for controlling the secondary pressure control valve CV2 (control mechanism, hydraulic control circuit). In the present embodiment, the control parameter is a current value for controlling the secondary pressure control valve CV2 (hydraulic control circuit, control mechanism).
The control current value u0V2 is preferably derived from the target rotation speed RSi based on the following. As described above, the processor 10a determines the reference value u0v2 of the control current value of the secondary pressure control valve CV2 and the additional secondary pressure control valve ACV2 so that the hydraulic motors (31L, 31R) rotate at the target rotation speed RSi in a state where the left and right traveling devices (3L, 3R) do not receive resistance from the road surface when the rotation speed of the engine 6 in the creep mode is known from the target rotation speed RSi and the secondary pilot pressure corresponding to the target rotation speed RSi is applied to the hydraulic pumps.
The feedback controller Cbbv2 derives an offset value uAV2 corresponding to a speed difference e (eL, eR) obtained by subtracting the target rotation speed RSi from the rotation speed (RSdL, RSdR) of the hydraulic motor (31L, 31R) detected by the rotation speed sensor (SR31L, SR31R) at every sampling interval Ts, the speed difference e having a larger absolute magnitude. The processor 10a is configured to receive the rotation speeds (RSdL, RSdR) of the hydraulic motors (31L, 31R) detected at every sampling interval Ts from the rotation speed sensors (SR31L, SR31R) and calculate the speed difference e (eL, eR) obtained by subtracting the target rotation speed RSi from the rotation speeds (RSdL, RSdR) at every sampling interval Ts.
The processor 10a is configured to calculate the offset value uAV2 corresponding to the speed difference e having a larger absolute magnitude of the speed differences e (eL, eR) at every sampling interval Ts. Then, the processor 10a inputs the sum of the reference value u0V2 and the offset value uAV2 to the secondary pressure control valve CV2 and the additional secondary pressure control valve ACV2 as the control parameter uV2. That is, the processor 10a applies the current of the control current value u0V2 to the solenoid of the secondary pressure control valve CV2. The processor 10a sends a command corresponding to the control parameter uV2 to the secondary pressure control valve CV2 (control mechanism, hydraulic control circuit) which controls the displacement volume of the hydraulic pumps (7L, 7R). The processor 10a thereby controls the displacement volume of the hydraulic pumps (7L, 7R) in response to the control parameter uV2 described above. The processor 10a rotates the hydraulic motors (31L, 31R) by controlling the engine 6 to rotate the hydraulic pumps (7L, 7R).
The processor 10a updates the control parameter uV2 at every sampling interval Ts. More specifically, the processor 10a updates the offset value uAV2 at every sampling interval Ts. The updating method and the thresholds af, −ae, and ag (see
However, the magnitude relationship of the absolute values of the first feedback control value d1v2, the second feedback control value d2v2, the third feedback control value d3v2, and the upper limit value umaxv2 is the same as that in the first embodiment. Thus, the offset value uAV1 can be rapidly decreased to prevent the work vehicle 1 from being excessively accelerated due to a large decrease in the travel resistance at the start of movement, and the offset value uAV1 can be rapidly increased when the torque of the hydraulic motor (31L, 31R) is required from the standstill to the start of movement, so that the time until the start of travel can be shortened.
In the creep mode (Yes in step S2), in step S10A after step S9, the processor 10a executes the processing of the feedforward controller Cfv2 and the feedback controller Cbbv2, and outputs the control parameter uV2. That is, the control method according to the present embodiment includes determining the control parameter uV2 for setting the displacement volume of the hydraulic pumps (7L, 7R) configured to supply the hydraulic motors (31L, 31R) with the hydraulic fluid in response to the operation of the creep setting member 16. The determination method is the same as that in the first embodiment.
In the method of controlling the work vehicle 1 or the work vehicle 1 according to the second embodiment, as in the first embodiment, even when the travel resistance is large, the secondary pilot pressure can be controlled so that the travel can be started quickly. In addition, in the control method or the work vehicle 1, it is possible to perform control of the secondary pilot pressure that can suppress the work vehicle 1 from accelerating too much due to a large decrease in the travel resistance at the start of movement.
As a modification of the second embodiment, the control system 20B may be a combination of the feedback controller Cbv2 described in United States Patent Application Publication No. 2024/0060274 A1 as a feedback controller. Alternatively, the control system 20A may be a combination of the feedback controllers Cbv21 and Cbv22 described in United States Patent Application Publication No. 2024/0060274 A1 as a feedback controller. In the second embodiment described above, the hydraulic pumps (7L, 7R) and the hydraulic motors (31L, 31R) are controlled by the same feedback loop. However, the control of the left hydraulic pumps 7L and the left hydraulic motors 31L and the control of the right hydraulic pumps 7R and the right hydraulic motors 31R may be controlled by separate feedback loops.
Referring to
The feedback controller Cbbv2L derives an offset value uAv2L corresponding to a speed difference eL obtained by subtracting the target rotation speed RSiL from the rotation speed RSdL of the hydraulic motor 31L detected by the rotation speed sensor SR31L at every sampling interval Ts. The feedback controller Cbbv2R derives an offset value uAv2R corresponding to a speed difference eR obtained by subtracting the target rotation speed RSiR from the rotation speed RSdR of the hydraulic motor 31R detected by the rotation speed sensor SR31R at every sampling interval Ts.
The processor 10a inputs the sum of the reference value u0V2L and the offset value uAV2L to the proportional valve CV21 as the control parameter uv2L. That is, the processor 10a applies the current of the control current value uV2L to the solenoid of the proportional valve CV21. The processor 10a thereby controls the displacement volume of the hydraulic pump 7L in response to the control parameter uv2L as described above. The processor 10a inputs the sum of the reference value u0V2R and the offset value uAV2R to the proportional valve CV22 as the control parameter uV2R. That is, the processor 10a applies the current of the control current valve uV2R to the solenoid of the proportional valve CV22. The processor 10a thereby controls the displacement volume of the hydraulic pump uV2R in response to the control parameters uV2R described above. As described above, the control of the left hydraulic pump 7L and the left hydraulic motor 31L and the control of the right hydraulic pump 7R and the right hydraulic motor 31R can be performed separately.
Although the operation lever 55 according to the above-described embodiment directly controls the operation valves OVA, OVB, OVC, and OVD, the work vehicle 1 may detect the operation amount of the operation lever 55 by a separate sensor such as a potentiometer and control a control valve that controls the first pump pilot pressure and the second pump pilot pressure based on the operation amount detected by the sensor. In this case, the same control as that of the second embodiment can be realized by adjusting the operation amount detected by the sensor.
In the present embodiment, the pilot oil supply passage PA8 connects the pilot control valves CV31 to CV34 and the pilot oil supply passage PA8, and the first to fourth pilot oil passages PA11 to PA14 are connected to the pilot control valves CV31 to CV34, respectively. In the present embodiment, the pilot oil supply passages PA1 and PA8 and the first to fourth pilot oil passages PA11 to PA14 correspond to a pilot oil supplying circuit that connects the pilot pump and the first pump pilot port or the second pump pilot port. In the present embodiment, since the operation valves OVA, OVB, OVC, and OVD are not provided, there is no difference between the primary pilot pressure and the secondary pilot pressure. Therefore, in the present embodiment, these pressures are simply referred to as pilot pressures without being distinguished from each other.
In the normal mode, the controller 10 is configured to control the pilot control valves CV31 to CV34 in order to output the pilot pressure corresponding to
The target rotation speed RSi is a target rotation speed of the hydraulic motors (31L, 31R) when the work vehicle 1 is assumed to travel straight. In the present embodiment, the deemed operation amount r is an example of a control parameter for setting the displacement volume of the hydraulic pumps (7L, 7R) configured to supply the hydraulic motors (31L, 31R) with the hydraulic fluid. Note that the control parameter may be the output pressure of the pilot control valves CV31 to CV34, but is substantially the same as that in the second embodiment, and thus the description thereof will be omitted. In the present embodiment, the pilot control valves CV31 to CV34 are an example of the control mechanism (hydraulic control circuit) configured to control the hydraulic pressure of the pilot oil for changing the displacement volumes of the hydraulic pumps (31L, 31R).
The feedback controller CbbR derives the deemed adjustment operation amount r1 corresponding to the speed difference e having a larger absolute magnitude among the speed differences e (eL, eR) obtained by subtracting the target rotation speed RSi from the rotation speeds (RSdL, RSdR) of the hydraulic motors (31L, 31R) detected by the rotation speed sensors (SR31L, SR31R) at every sampling interval Ts. The deemed adjustment amount r1 is referred to as an offset value of the control parameter. Then, the processor 10a sets the sum of the deemed reference manipulated variable r0 and the deemed adjustment manipulated variable r1 as a deemed manipulated variable (control parameter) r. The converter Cbbv holds the relationship between the deemed operation amount r and the pilot pressure Pt as shown in
The processor 10a updates the control parameter r at every sampling interval Ts. More specifically, the processor 10a updates the offset value r1 at every sampling interval Ts. The updating method and the thresholds af, −ae, and ag (see
However, the magnitude relationship of the absolute values of the first feedback control value d1r, the second feedback control value d2r, the third feedback control value d3r, and the upper limit value umaxr is the same as that in the first embodiment. Thus, the offset value r1 can be rapidly decreased to prevent the work vehicle 1 from being excessively accelerated due to a large decrease in the travel resistance at the start of movement, and the offset value r1 can be rapidly increased when the torque of the hydraulic motor (31L, 31R) is required from the standstill to the start of movement, so that the time until the start of travel can be shortened.
When the engine drop does not occur (No in step S3), in step S4B, the processor 10a determines the maximum output pressure (Pc) of
In step S10B instead of step S10, the processor 10a executes the processing of the feedforward controller CfR and the feedback controller CbbR, and outputs the control parameter r. That is, the control method according to the present embodiment includes determining the control parameter r for setting the displacement volume of the hydraulic pumps (7L, 7R) configured to supply the hydraulic motors (31L, 31R) with the hydraulic fluid in response to the operation of the creep setting member 16. The determination method is the same as that of the first embodiment except that the determination of whether the operation lever 55 is in the neutral position or has shifted from the neutral position is performed from the output of the operation detection sensor 18 because the position of the operation lever 55 is detected by the operation detection sensor 18, and the determination of whether the operation lever 55 has deviated from the position corresponding to the neutral region RA1 in
Thereafter, in step S43, the processor 10a is configured to determine whether the first operation amount is equal to or larger than the deemed operation amount r. In the creep mode, the first operation amount is normally operated to be equal to or larger than the deemed operation amount r. When the first operation amount is smaller than the deemed operation amount (control parameter) r (No in step S43), the process proceeds to step S42. When the first operation amount is equal to or larger than the control parameter r (Yes in Step S43), in step S44, the processor 10a determines the pilot pressure according to the control parameter r, and controls the pilot control valves CV31 to CV34 so that the determined pilot pressure is applied.
In the method for controlling the work vehicle 1 or the work vehicle 1 according to the third embodiment, as in the first embodiment, for example, even when the travel resistance is large at the start of travel of the work vehicle, the travel can be started quickly. In addition, in the control method or the work vehicle 1, it is possible to prevent the work vehicle 1 from being excessively accelerated due to a large decrease in the travel resistance at the start of movement.
Instead of the third embodiment, the ports (PLa, PRa, PLb, PRb) of the hydraulic pumps (7L, 7R) may be configured to receive electromagnetic input, such as solenoids. In this case, the pilot control valves CV31 to 34 may be omitted. In this case, the control current value uV is input to the solenoids of the hydraulic pumps (7L, 7R). Instead of the pilot control valves CV31 to 34, devices that are provided in the hydraulic pumps (7L, 7R) and electromagnetically input may be regarded as the control mechanism (hydraulic control circuit).
In addition to the above embodiments, the control system 20A may be combined with a feedback controller CbR described in United States Patent Application Publication No. 2024/0060274 A1 as a feedback controller. Alternatively, the control system 20A may be a combination of the feedback controllers CbR1 and CbR2 described in United States Patent Application Publication No. 2024/0060274 A1 as a feedback controller. In the third embodiment, as in the second embodiment, the control of the left hydraulic pump 7L and the left hydraulic motor 31L and the control of the right hydraulic pump 7R and the right hydraulic motor 31R may be controlled by separate feedback loops.
In the above-described embodiment, the case where the hydraulic pumps (7L, 7R) are rotated by the engine 6 has been described, but the hydraulic pumps (7L, 7R) may be rotated by another prime mover such as an electric motor.
The values of the various thresholds may be changed according to the characteristics of the left hydraulic pump 7L, the right hydraulic pump 7R, the left hydraulic motor 31L, and the right hydraulic motor 31R, the characteristics of the reduction gear connected to the left hydraulic motor 31L and the reduction gear connected to the right hydraulic motor 31R, and the characteristics of the various control valves.
The control systems 20A to 20C may further include other control such as D control in addition to the above example.
In this application, the word “comprise” and its derivatives are used as open-ended terms to describe the presence of elements but not to exclude the presence of other elements not listed. This applies to “having”, “including” and derivatives thereof.
The terms “member,” “part,” “element,” “body,” and “structure” may have a plurality of meanings, such as a single portion or a plurality of portions.
The ordinal numbers such as “first” and “second” are merely terms for identifying the configuration, and do not have other meanings (for example, a specific order). For example, the presence of a “first element” does not imply the presence of a “second element,” and the presence of a “second element” does not imply the presence of a “first element.”
Terms of degree such as “substantially”, “about”, and “approximately” can mean a reasonable amount of deviation such that the end result is not significantly changed, unless the embodiment is specifically described otherwise. All numerical values recited herein may be construed to include terms such as “substantially,” “about,” and “approximately.”
The phrase “at least one of A and B” as used herein should be interpreted to include A alone, B alone, and both A and B.
Obviously, numerous modifications and variations of the present invention are possible in light of the above teachings. Thus, it is to be understood that the invention may be practiced otherwise than as specifically described herein without departing from the scope of the invention.
Number | Date | Country | Kind |
---|---|---|---|
2023-118988 | Jul 2023 | JP | national |