The present application claims priority under 35 U. S. C. § 119 to Japanese Patent Application No. 2023-148800, filed Sep. 13, 2023. The contents of this application are incorporated herein by reference in their entirety.
The present disclosure relates to a work vehicle, a method for controlling the work vehicle, and a controller for the work vehicle.
U.S. Pat. No. 7,894,962 discloses a work vehicle capable of executing automatic implement return control for changing the position and posture of an implement and an arm from those when a load is dumped to a reference position and posture of the implement and the arm stored in advance.
In accordance with one aspect of the present disclosure, a work vehicle includes a joint, an implement, an arm assembly, a vehicle body, a traveling device, a first hydraulic cylinder, a second hydraulic cylinder, a hydraulic circuit, an implement posture detection sensor, an arm posture detection sensor, a memory, control circuitry, and an input device. The implement is connected to the joint and includes an implement tip opposite to the joint. The arm assembly includes an arm distal end and arm proximal end opposite to the arm distal end. The arm distal end is connected to the joint to swingably support the implement. The vehicle body is configured to swingably support the arm proximal end. The traveling device is configured to move the vehicle body. The first hydraulic cylinder is configured to control an implement direction from the joint to the implement tip. The second hydraulic cylinder is configured to control an arm height which is a height of the arm distal end with respect to a ground contact surface of the traveling device in a height direction perpendicular to the traveling direction of the traveling device. The hydraulic circuit is configured to control the first hydraulic cylinder and the second hydraulic cylinder. The implement posture detection sensor is configured to detect the implement direction. The arm posture detection sensor is configured to detect the arm height. The memory is configured to store first information corresponding to a reference direction which is a standard of the implement direction, and second information corresponding to a reference height which is a standard of the arm height. The control circuitry is configured to control the hydraulic circuit. The input device is configured to receive an instruction to perform automatic control for changing the implement direction and the arm height respectively to the reference direction and the reference height. The control circuitry is configured to control the hydraulic circuit so that the arm height and the implement direction respectively approach the reference height and the reference direction in response to the instruction received by the input device. The control circuitry is configured to control the hydraulic circuit so that during the automatic control, the implement direction is changed to the reference direction when the arm height reaches a target height which is greater than the reference height.
In accordance with another aspect of the present disclosure, a control method of a work vehicle includes acquiring a reference direction which is a standard of an implement direction from a joint to an implement tip of an implement, the joint rotatably connecting the implement to an arm distal end of the work vehicle. The control method includes acquiring a reference height which is a standard of an arm height which is a height of the implement tip with respect to a ground contact surface of a traveling device of the work vehicle in a height direction perpendicular to a traveling direction of the traveling device. The control method includes controlling a second hydraulic cylinder of the work vehicle such that the arm height approaches the reference height in response to an instruction to perform automatic control to change the implement direction and the arm height to the reference direction and the reference height, respectively. The control method includes controlling a first hydraulic cylinder of the work vehicle to change the implement direction in accordance with change in the arm height such that the implement direction is changed to the reference direction when the arm height reaches a target height which is greater than the reference height.
In accordance with further aspect of the present disclosure, a controller for a work vehicle, includes a memory and a processor. The memory is configured to store a first reference value and a second reference value, the first reference value corresponding to a reference direction which is a standard of an implement direction of a first parameter, the first parameter representing the implement direction representing an implement direction to an implement tip of an implement from a joint that rotatably connects the implement, the second reference value corresponding to a reference height which is a standard of an arm height of a second parameter, the second parameter representing the arm height which is a height of the implement tip with respect to a ground contact surface of a traveling device of the work vehicle in a height direction perpendicular to a traveling direction of the traveling device. The process is configured to control a second hydraulic cylinder of the work vehicle such that the arm height approaches the reference height in response to an instruction to perform automatic control to change the implement direction and the arm height to the reference direction and the reference height, respectively. The process is configured to control a first hydraulic cylinder of the work vehicle to change the implement direction in accordance with change in the arm height such that the implement direction is changed to the reference direction when the arm height reaches a target height which is greater than the reference height.
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.
Hereinafter, embodiments of the present disclosure will be described with reference to the accompanying drawings. Similar reference numerals indicate corresponding or identical configurations in each figure.
Referring to
The first link 44 is rotatable around a fulcrum shaft 46 with respect to the vehicle body 2. The second link 59 is rotatable around a fulcrum shaft 59P with respect to the vehicle body 2. An arm 45 is rotatable around a joint shaft 47 with respect to the first link 44. The arm 45 is rotatable about the joint shaft 59D with respect to the second link 59. The arm 45 operates with one degree-of-freedom because of a link defined by two free ends (joint shaft 47, joint shaft 59D) of the four joint link mechanism LK including two fixed ends (fulcrum shaft 46, fulcrum shaft 59P) and two free ends (joint shaft 47, joint shaft 59D). That is, the position of the joint 43 is uniquely determined by the rotation angle θJ of the fulcrum shaft 59P.
The work vehicle 1 further includes a plurality of second hydraulic cylinder 48. Each of the plurality of second hydraulic cylinder 48 is rotatably connected to the vehicle body 2 and the arm 45, and moves the first link 44, the arm 45, and the like to raise and lower the implement 41. That is, each of the plurality of second hydraulic cylinder 48 is configured to control an arm height HA which is a height of the arm distal end 45D with respect to the ground contact surface GL of the traveling device 3 in the height direction DH perpendicular to the traveling direction of the traveling device 3. For convenience, the height of arm distal end 45D is the height of joint 43. That is, the arm height HA is a distance between the ground contact surface GL of the traveling device 3 and the joint 43 in the height direction DH. The work vehicle 1 includes an arm posture detection sensor 56 configured to detect a rotation angle θJ of the fulcrum shaft 59P to detect the position of the arm distal end 45D (joint 43). The arm posture detection sensor 56 is a rotation angle detection sensor configured to detect rotation angle θJ of a joint (fulcrum shaft 59P) of the link mechanism LK. In
The work vehicle 1 further includes at least one first hydraulic cylinder 49. The at least one first hydraulic cylinder 49 is configured to control the implement direction 41D from the joint 43 towards the implement tip 41T. The work vehicle 1 is provided with an implement posture detection sensor 57 for detecting an implement direction 41D. The implement posture detection sensor 57 includes, as an example, a first inertial measurement unit (IMU) 57a attached to the implement 41 and a second inertial measurement unit (IMU) 57b attached to the vehicle body 2. The first inertial measurement unit 57a and the second inertial measurement unit 57b each include at least an accelerometer and a gyroscope, and can detect the gravity direction DG. That is, the first inertial measurement unit 57a can detect the second angle θIG formed by the implement direction 41D and the gravity direction DG. The second inertial measurement unit 57b can detect a first angle θVG (not illustrated) formed by the vehicle reference direction (a posture of the vehicle body 2 is defined by the vehicle reference direction. For example, the vehicle reference direction is the vehicle downward direction DD) and the gravity direction DG.
The arm posture detection sensor 56 may be a linear sensor 56p that detects the position PA of the second hydraulic cylinder 48 instead of the potentiometer 56r. The implement posture detection sensor 57 may be a linear sensor 57p that detects the position PI of the first hydraulic cylinder 49, instead of the first inertial measurement unit 57a and the second inertial measurement unit 57b. An example of such a linear sensor is a sensor for detecting a stroke in a hydraulic cylinder, which is described in introduction of products, KYB Giho No. 54 (April 2017), pages 75 to 78. The implement posture detection sensor 57 may be a potentiometer 57r for detecting rotation angle θR of the joint 43, instead of the first inertial measurement unit 57a, the second inertial measurement unit 57b or the linear sensor 57p. The position PI and the rotation angle θR of the first hydraulic cylinder 49 are another example of the first parameter. The position PA of the second hydraulic cylinder 48 is another example of the second parameter.
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 the operator's seat 54 and the operation lever 55 (the arm input member 63 and the implement input member 68) in the cabin 5. As shown in
In the embodiment according to the present application, a front-back direction DFB (forward direction DD/backward direction DB) means a front-back direction (forward direction/backward direction) as seen from an operator seated on the operator'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 work vehicle 1 includes hydraulic circuit 100 and a controller (control circuitry) 15. The hydraulic circuit 100 is configured to control the first hydraulic cylinder 49 and the second hydraulic cylinder 48.
The first hydraulic cylinder 49 includes a first chamber CB1 into which the hydraulic fluid flows when the implement tip 41T is tilted downward and a second chamber CB2 into which the hydraulic fluid flows when the implement tip 41T is tilted upward. The second hydraulic cylinder 48 includes a third chamber CB3 into which the hydraulic fluid flows when the arm distal end 45D is raised, and a fourth chamber CB4 into which the hydraulic fluid flows when the arm distal end 45D is lowered. The hydraulic pump 11 is configured to be driven by the engine 6 and supply the hydraulic fluid stored in the hydraulic fluid tank 10 to a first hydraulic cylinder 49 and a second hydraulic cylinder 48. The hydraulic pump 11 is for example a variable displacement hydraulic pump. A port connected to a swash plate of the hydraulic pump 11 is connected to a regulator valve 79 described later, and the pressure of the hydraulic fluid output from the hydraulic pump 11 is regulated. The pilot pump 12 is configured to be driven by the engine 6 and discharge pilot oil for controlling the second control valve 20 and the first control valve 25. Among the hydraulic fluid stored in the hydraulic fluid tank 10, the hydraulic fluid discharged from the pilot pump 12 and used for control may be referred to as pilot oil, and the pressure of the pilot oil may be referred to as pilot pressure. The pilot pump 12 is, for example, a fixed displacement hydraulic pump.
A first oil passage R1 connects a hydraulic pump 11 with a first chamber CB1 of the first hydraulic cylinder 49. The first control valve 25 is provided in the first oil passage R1. The first control valve 25 is provided in the first cylinder hydraulic circuit C1 between the hydraulic pump 11 and the first hydraulic cylinder 49. The first control valve 25 includes pilot ports 25P1, 25P2 and is configured to control the hydraulic fluid supplied to the first chamber CB1 and the second chamber CB2 of the first hydraulic cylinder in response to the hydraulic pressure of the pilot oil applied to the pilot ports 25P1, 25P2. The first oil passage R1 includes a partial oil passage R10 common to a third oil passage R3 extending from the hydraulic pump 11 to the joint J11, and a partial oil passage R11 extending from the joint J11 to the first control valve 25, a partial oil passage R12 connecting different connection ports of the first control valve 25 to each other, and a partial oil passage R13 extending from the first control valve 25 to a first chamber CB1 of the first hydraulic cylinder 49. The second oil passage R2 connects the first control valve 25 and the second chamber CB2 of the first hydraulic cylinder 49. The first oil passage R1 and the second oil passage R2 are branched by being connected to different ports of the first control valve 25.
To be more specific, the first control valve 25 includes a first implement control valve port YP1, a second implement control valve port YP2, a third implement control valve port YP3, a fourth implement control valve port YP4, and a fifth implement control valve port YP5. The first implement control valve port YP1 is connected to the hydraulic pump 11 via a first oil passage R1. The second implement control valve port YP2 is connected to the first chamber CB1 of the first hydraulic cylinder 49 via the first oil passage R1. The third implement control valve port YP3 is connected to the second oil passage R2. When the pilot pressure pp1 applied to the pilot port 25P1 is higher than the pilot pressure pp2 applied to the pilot port 25P2 by a predetermined pressure or more, the first control valve 25 switches the first spool position to the first hydraulic cylinder extension control position BEP at which the first and second implement control valve ports YP1 and YP2 are communicated with each other via the fourth implement control valve port YP4 and the third implement control valve port YP3 is communicated with a first drain oil passage DR1 (described later) via the fifth implement control valve port YP5. Referring to
When the pilot pressure pp2 applied to the pilot port 25P2 is higher than the pilot pressure pp1 applied to the pilot port 25P1 by the predetermined pressure or more, the first control valve 25 switches the first spool position to the first hydraulic cylinder retraction control position in which the first implement control valve port YP1 and the third implement control valve port YP3 are communicated with each other via the fourth implement control valve port YP4 and the second implement control valve port YP2 is communicated with the DR1 (described later) via the fifth implement control valve port. YP2. Note that the first valve housing 25B has a bypass oil passage BYP for connecting the second implement control valve port YP2 and the fifth implement control valve port YP5. The bypass oil passage BYP is also shown in
When the absolute value of the difference between the pilot pressure PP2 applied to the pilot port 25P2 and the pilot pressure pp1 applied to the pilot port 25P1 is equal to or less than the predetermined value, the first control valve 25 switches the first spool position to the first hydraulic cylinder rest control position BNP where the first, second, third, fourth, and fifth implement control valve ports YP1, YP2, YP3, YP4, and YP5 are isolated. In the schematic views of the first control valve 25 shown in
As shown in
The first control valve 25 is configured to change a first opening area AS1, which is a dimension of a first opening SP1 that communicates an oil passage connecting the first supplied oil chamber (CB1 or CB2) and the first control valve 25 with an oil passage connecting the hydraulic pump 11 and the first control valve 25, in accordance with the first spool position. As the maximum value of the first opening area AS1 is sufficiently smaller than the dimension of the second axial opening XAP2 of the second notch NC2, when the first opening SP1 is regarded as an orifice, it is known that the flow rate of the hydraulic fluid passing through the first opening SP1 is proportional to the product of the first opening area AS1 and the square root of difference between input and output pressures of first opening SP1. The first pressure compensation valve 77 controls the difference between the input and output pressure of the first opening SP1 to be the first pressure, and therefore the first control valve 25 can adjust the amount of the hydraulic fluid supplied to the first supplied oil chamber (CB1 or CB2) per unit time by changing the first opening area AS1 at the first hydraulic cylinder extension control position BEP and the first hydraulic cylinder retraction control position BSP. The third opening SP3 can be referred to as an opening of the first control valve 25 that allows an oil passage connecting the first discharged oil chamber (CB2 or CB1) and the first control valve 25 to communicate with a first drain oil passage DR1 (described later). The dimension of the third opening SP3 varies according to the first opening area AS1. In
The third oil passage R3 connects the hydraulic pump 11 and the third chamber CB3 of the second hydraulic cylinder 48. The third oil passage R3 includes a partial oil passage R10 which is common to a first oil passage R1 extending from a hydraulic pump 11 and a partial oil passage R31 branched from the first oil passage R1 in the joint J11. The second control valve 20 is provided in the third oil passage R3. The second control valve 20 is provided in a second cylinder hydraulic circuit C2 between the hydraulic pump 11 and the second hydraulic cylinder 48. The second control valve 20 includes a pilot port 20P1, 20P2, and is configured to control the hydraulic fluid supplied to the third chamber CB3 and the fourth chamber CB4 of the second hydraulic cylinder 48 in response to the oil pressure of the pilot oil applied to the pilot ports 20P1, 20P2. The third oil passage R3 further includes a partial oil passage R32 connecting different connection ports of the second control valve 20 to each other and a partial oil passage R33 extending to the third chamber CB3 of the second hydraulic cylinder 48. The fourth oil passage R4 connects the second control valve 20 and the fourth chamber CB4 of the second hydraulic cylinder 48. Third oil passage R3 and the fourth oil passage R4 are branched by being connected to different ports of the first control valve 25.
To be more specific, the second control valve 20 further includes a first arm control valve port XP1, a second arm control valve port XP2, a third arm control valve port XP3, and a fourth arm control valve port XP4, and a fifth arm control valve port XP5. The first arm control valve port XP1 is connected to the hydraulic pump 11 via a third oil passage R3. The second arm control valve port XP2 is connected to the fourth oil passage R4.
The third arm control valve port XP3 is connected to the third chamber CB3 of the second hydraulic cylinder 48 via the third oil passage R3. When the pilot pressure pp3 applied to the pilot port 20P1 is higher than the pilot pressure pp4 applied to the pilot port 20P2 by a predetermined pressure or more, the second control valve 20 makes a first arm control valve port XP1 to communicate with a third arm control valve port XP3 via the fourth arm control valve port XP4, and switches the second hydraulic cylinder extension control position AEP at which the second arm control valve port XP2 is communicated with a first drain oil passage DR1 (described later) via the fifth arm control valve port XP5. Referring to
When the pilot pressure pp4 applied to the pilot port 20P4 is higher than the pilot pressure pp3 applied to the pilot port 20P1 by the predetermined pressure, the second control valve 20 switches the second spool position to the second hydraulic cylinder retraction control position ASP at which the first arm control valve port XP1 and the second arm control valve port XP2 are communicated with each other via the fourth arm control valve port XP4, and the third arm control valve port XP3 is communicated with the first drain oil passage lpt via the fifth arm control valve port XP5. The second valve housing 20B includes a bypass oil passage BYP for connecting the third arm control valve port XP3 and the fifth arm control valve port XP5. The bypass oil passage BYP is also shown in
When the difference between the pilot pressure pp4 applied to the pilot port 20P2 and the pilot pressure pp3 applied to the pilot port 20P1 is equal to or smaller than the predetermined pressure, the second control valve 20 switches the second spool position to the second hydraulic cylinder rest control position ANP for isolating the first arm control valve port XP1, the second arm control valve port XP2, the third arm control valve port XP3, the fourth arm control valve port XP4 and the fifth arm control valve port XP5. In the schematic views of the first control valve 25 shown in
As shown in
The second control valve 20 is configured to change a second opening area AS2, which is a dimension of a second opening SP2 of the second control valve 20 that communicates an oil passage connecting the second supplied oil chamber (CB3 or CB4) and the second control valve 20 with an oil passage connecting the hydraulic pump 11 and the second control valve 20, according to the second spool position. The maximum value of the second opening area AS2 is sufficiently smaller than the fifth axial opening XAP5 of the fifth notch NC5, and therefore, when the second opening SP2 is regarded as an orifice, the flow rate of the hydraulic fluid passing through the second opening SP2 is known to be proportional to the product of the square root of the difference between the input and output pressures of the second opening SP2 and the second opening area AS2. As the pressure difference between the input and output of the second opening SP2 is controlled by the second pressure compensation valve 76 to be the first pressure, the second control valve 20 is controlled such that the second control valve 20 can adjust the amount of hydraulic fluid supplied per unit time to the second supplied oil chamber (CB3 or CB4) by changing the second opening area AS2 in each of the second hydraulic cylinder extension control position AEP or second hydraulic cylinder retraction control position ASP, respectively. The fourth opening SP4 can be referred to as an opening of the second control valve 20 that allows an oil passage connecting the second discharged oil chamber (CB3 or CB4) and the second control valve 20 to communicate with a first drain oil passage DR1 (described later). The fourth opening SP4 varies in size in accordance with the second opening area AS2. In
The difference between the pressures at the input and output of the first opening SP1 of the first pressure compensation valve 77 and the difference between the pressures at the input and output of the second opening SP2 of the second pressure compensation valve 76 are set to the same first pressure. Therefore, the ratio between the flow rate of the hydraulic fluid per unit time via the first control valve 25 and the flow rate of the hydraulic fluid per unit time via the second control valve 20 can be adjusted by the ratio between the first opening area AS1 and the second opening area AS2. The second pressure compensation valve 76 and the first pressure compensation valve 77 are collectively referred to as a pressure control mechanism 78.
The pressure control mechanism 78 further includes a shuttle valve 83 that outputs a higher one of the oil pressure applied to the first supplied oil chamber (CB1 or CB2) and the hydraulic pressure applied to the second supplied oil chamber (CB3 or CB4), and a regulator valve 79 for the pressure output from the hydraulic pump 11 to be equal to or higher than the above described first pressure. The regulator valve 79 is switched to the first position PV1 when the oil pressure is lower than the higher oil pressure and higher than the first pressure, and is switched to the second position PV2 when the hydraulic pressure is higher than the higher hydraulic pressure by the first hydraulic pressure or more. Thus, even if the hydraulic pressure increases while at least one of the first hydraulic cylinder 49 and the second hydraulic cylinder 48 is being controlled, the hydraulic pump 11 can supply a pressure higher than the first pressure, and therefore the first hydraulic cylinder 49 and the second hydraulic cylinder 48 can be continuously controlled. When the hydraulic pump 11 is controlled in this way, the difference between the lower one of the hydraulic pressure s applied to the first supplied oil chamber (CB1 or CB2) and the second supplied oil chamber (CB3 or CB4) and the hydraulic pressure of the hydraulic fluid output from the hydraulic pump 11 is larger than the first pressure. However, the functions of the first and second pressure compensation valves 77 and 76 adjust the difference between the pressures at the input and output of the first opening SP1 and the difference between the pressures at the input and output of the second opening SP2 to the same first pressures. The pressure control mechanism 78 may use another hydraulic control component to set the hydraulic pressure to be equal to or higher than the first hydraulic pressure, which is higher than the hydraulic pressure applied to the first supplied oil chamber (CB1 or CB2) or the hydraulic pressure applied to the second supplied oil chamber (CB3 or CB4).
Thus, as the pressure control mechanism 78 can adjust the amount of hydraulic fluid via the first control valve 25 by the first opening area AS1, the first control valve 25 is configured to adjust the hydraulic fluid per unit time supplied to the first supplied oil chamber (CB1 or CB2) per unit time and the amount of hydraulic fluid discharged from the first discharged oil chamber (CB2 or CB1) per unit time in accordance with the first spool position, which is the position of the first spool SPL1. As the pressure control mechanism 78 can adjust the amount of hydraulic fluid via the second control valve 20 by the second opening area AS2, the second control valve 20 is configured to adjust the amount of hydraulic fluid supplied to the second supplied oil chamber (CB3 or CB4) per unit time and the amount of hydraulic fluid discharged from the second discharged oil chamber (CB4 or CB3) per unit time in accordance with the second spool position, which is the position of the second spool SPL2.
The first pilot oil passage PR1 connects the pilot ports 20P1, 20P2 with a pilot pump 12. To be specific, the first pilot oil passage PR1 includes a partial oil passage PR10f common to the second pilot oil passage PR2 extending from the pilot pump 12 to the third pilot control valve 60 and the fourth pilot control valve 61, a partial oil passage PR11 extending from the third pilot control valve 60 to the pilot port 20P1, and a partial oil passage PR12 extending from the fourth pilot control valve 61 to the pilot port 20P2. The hydraulic circuit 100 further includes an additional solenoid valve 14 provided in the partial oil passage PR10. That is, the additional solenoid valve 14 is provided in at least one of the first pilot oil passage PR1 between the pilot pump 12 and the third pilot control valve 60 and the fourth pilot control valve 61 and the second pilot oil passage PR2 between the pilot pump 12 and the first pilot control valve 65 and the second pilot control valve 66. The additional solenoid valve 14 is a solenoid valve capable of changing the pressure of the hydraulic fluid output from the pilot pump 12. The pressure of the hydraulic fluid can be changed by control from the controller 15.
The third pilot control valve 60 is a solenoid control valve provided in the first pilot oil passage PR1. The third pilot control valve 60 includes a solenoid 60s and controls the hydraulic pressure of the pilot oil applied to the pilot port 20P1 based on the control amount u3 applied to the solenoid 60s. The arm input member 63 is provided with a rotation detection sensor 18 such as a potentiometer, and the controller 15 acquires an operation amount of the arm input member 63 operated for lifting and lowering the arm 45 from the rotation detection sensor 18, and outputs a control amount U3 applied to the solenoid 60s based on the operation amount. The fourth pilot control valve 61 is a solenoid control valve provided in the first pilot oil passage PR1. The fourth pilot control valve 61 includes a solenoid 61s and controls the hydraulic pressure of the pilot oil applied to the pilot port 20P2 based on the control amount u4 applied to the solenoid 61s. The controller 15 acquires the operation amount of the arm input member 63 operated for raising and lowering the arm 45 from the rotation detection sensor 18, and outputs the control amount u4 to be applied to the solenoid 61s based on the operation amount. When the arm input member 63 is tilted forward, the controller 15 operates the third pilot control valve 60, and the pilot pressure pp3 is output from the third pilot control valve 60 to the partial oil passage PR11. The pilot pressure pp3 acts on the pilot port 20P1 of the second control valve 20. When the arm input member 63 is tilted rearward, the controller 15 operates the fourth pilot control valve 61 to output the pilot pressure pp4 to the partial oil passage PR12 from the fourth pilot control valve 61. The pilot pressure pp4 acts on the pilot port 20P2 of the second control valve 20.
To be more specific, when an operation for raising the arm 45 is performed by the arm input member 63 (an operation for tilting the arm input member 63 rearward), the pilot pressure pp3 applied to the pilot port 20P1 becomes larger than the pilot pressure pp4 applied to the pilot port 20P2 by the predetermined pressure. When an operation for lowering the arm 45 is performed by the arm input member 63 (an operation of tilting the arm input member 63 forward), the pilot pressure pp4 applied to the pilot port 20P2 becomes higher than the pilot pressure pp3 applied to the pilot port 20P1 by the predetermined pressure. When the operation amount of the arm input member 63 is smaller than the predetermined amount, the absolute value of the difference between the pilot pressure pp4 applied to the pilot port 20P2 and the pilot pressure pp3 applied to the pilot port 20P1 is equal to or smaller than the predetermined pressure.
The second pilot oil passage PR2 connects the pilot ports 25P1 and 25P2 to the pilot pump 12. To be specific, the second pilot oil passage PR2 includes a partial oil passage PR10 common to the first pilot oil passage PR1 extending from the pilot pump 12 to the first pilot control valve 65 and the second pilot control valve 66, a partial oil passage PR21 extending from the first pilot control valve 65 to the pilot port 25P1, and a partial oil passage PR22 extending from the second pilot control valve 66 to the pilot port 25P2. The first pilot control valve 65 is a solenoid control valve provided in the second pilot oil passage PR2. The first pilot control valve 65 includes a solenoid 65s, and controls the hydraulic pressure of the pilot oil applied to the pilot port 25P1 based on a control amount u1 applied to the solenoid 65s. The implement input member 68 is mounted with the rotation detection sensor 19 such as a potentiometer, and the controller 15 acquires the tilt angle of the implement input member 68 detected by the rotation detection sensor 19, and outputs a control amount u1 to be applied to the solenoid 65s based on the operation amount. The second pilot control valve 66 is a solenoid control valve provided in the second pilot oil passage PR2. The second pilot control valve 66 includes a solenoid 66s, and controls the hydraulic pressure of the pilot oil applied to the pilot port 25P2 based on the control amount u2 applied to the solenoid 66s. The controller 15 acquires the tilt angle of the implement input member 68 detected by the rotation detection sensor 19, and outputs a control amount u2 to be applied to the solenoid 66s based on the operation amount.
When the implement input member 68 is tilted to the right side, the controller 15 operates the first pilot control valve 65, and the pilot pressure pp1 is output from the first pilot control valve 65 to the partial oil passage PR21. The pilot pressure pp1 acts on the pilot port 25P1 of the first control valve 25. When the implement input member 68 is tilted to the left side, the controller 15 operates the second pilot control valve 66, and the pilot pressure PP2 is output from the second pilot control valve 66 to the partial oil passage pp2. The pilot pressure pp2 acts on the pilot port 25P2 of the first control valve 25.
To be more specific, when an operation for tilting the implement tip 41T downward by the implement input member 68 (an operation for tilting the implement input member 68 to the right side) is performed, the pilot pressure pp1 applied to the pilot port 25P1 becomes larger than the pilot pressure pp2 applied to the pilot port 25P2 by the predetermined pressure. When an operation for tilting the implement tip 41T upward is performed by the implement input member 68 (an operation of tilting the implement input member 68 to the left side), the pilot pressure pp2 applied to the pilot port 25P2 becomes larger than the pilot pressure pp1 applied to the pilot port 25P1 by the predetermined pressure. When the operation amount of the implement input member 68 is smaller than the predetermined amount, the difference between the pilot pressure pp2 applied to the pilot port 25P2 and the pilot pressure pp1 applied to the pilot port 25P1 is equal to or smaller than the predetermined pressure.
Although the arm input member 63 and the implement input member 68 are shown as separate members in
The bypass oil passage BR1 is configured to connect the fourth oil passage R4 and the first oil passage R1. The bypass oil passage BR1 is connected to the fourth oil passage R4 at the first joint J1. The bypass oil passage BR1 is connected to the first oil passage R1 at the third joint J3. The switching mechanism 70 is configured to control connection and disconnection of the fourth oil passage R4 and the first oil passage R1 by the bypass oil passage BR1. The controller 15 is configured to control the switching mechanism 70 to connect the fourth oil passage R4 and the first oil passage R1 when it is determined that the horizontal control of the implement 41 is performed. The controller 15 is, for example, a hardware controller such as an ECU. Accordingly, the controller 15 comprises electronic circuit such as a hardware processor 15P and a memory 15M. The memory 15M may be referred to as a memory.
The switching mechanism 70 includes a solenoid valve 71 and a first switching valve 72. The first switching valve 72 is provided in the fourth oil passage R4 between the first joint J1 and the second control valve 20, and has a first pilot port PP1. The first switching valve 72 is configured to block the connection between the second control valve 20 and the fourth chamber CB4 of the second hydraulic cylinder 48 via the fourth oil passage R4 when the pilot oil is applied to the first pilot port PP1 at a first threshold pressure or higher, and to connect the second control valve 20 and the fourth chamber CB4 via the fourth oil passage R4 when the pilot oil is applied to the first pilot port PP1 at a first threshold pressure or lower. The solenoid valve 71 can be switched between a second position VP2 for communicating the first pilot port PP1 with the hydraulic fluid tank 10 and a first position VP1 for connecting the first pilot port PP1 to an oil passage capable of applying a pilot pressure equal to or higher than a first threshold pressure to the first pilot port PP1.
The solenoid of the solenoid valve 71 is connected to the controller 15. For example, when it is determined that the horizontal control of the implement 41 is performed, the controller 15 transmits an electric signal for switching the solenoid valve 71 to the first position VP1 to the solenoid valve 71.
The work vehicle 1 further includes an ON/OFF changeover switch 16 which is connected to the controller 15. When the switch 16 is turned ON, the controller 15 transmits an electric signal for switching the solenoid valve 71 to the first position VP1. The switch 16 is turned on when the above-described horizontal control is performed.
The work vehicle 1 further includes an additional bypass oil passage BR2 that connects the second oil passage R2 and a fourth oil passage R4 between the first switching valve 72 and the second control valve 20. The additional bypass oil passage BR2 is connected to the fourth oil passage R4 at the second joint J2, and is connected to the second oil passage R2 at the fourth joint J4. The switching mechanism 70 further includes a second switching valve 73 provided in the bypass oil passage BR1 and a third switching valve 74 provided in the additional bypass oil passage BR2. The additional bypass oil passage BR2 includes a partial oil passage BR20 from the second joint J2 to the third switching valve 74, and a partial oil passage BR21 from the third switching valve 74 to the fourth joint J4. The work vehicle 1 further includes a first connection passage CR1 connecting an additional bypass oil passage BR2 an additional bypass oil passage BR2 (partial oil passage BR20) between the second joint J2 and the third switching valve 74, a second connection passage CR2 connecting a bypass oil passage BR1 (partial oil passage BR11) between the third joint J3 and the second switching valve 73, and a third connection passage CR3 connecting the second switching valve 73 and the bypass oil passage BR1 (partial oil passage BR11) between the second connection passage CR2 and the second switching valve 73
When the first pressure of the bypass oil passage BR1 (partial oil passage BR10) between the first joint J1 and the second switching valve 73 is larger than the second oil pressure of the first connection passage CR1, the second switching valve 73 is configured to switch to the first communication position CP1 to connect the first joint J1 and the third joint J3. When the second oil pressure is equal to or greater than the first pressure, the second switching valve 73 is configured to switch to the first blocking position BP1 to block the first joint J1 and the third joint J3. When it is switched to the first blocking position BP1, the second switching valve 73 is configured to connect the partial oil passage BR10 and the first connection passage CR1. When it is switched to the first communication position CP1, the second switching valve 73 is configured to block the partial oil passage BR10 and the first connection passage CR1.
The third switching valve 74 switches to any one of the second shutoff position BP2, the twenty first communication position CP21, and the twenty second communication position CP22 based on the third oil pressure of the additional bypass oil passage BR2 (partial oil passage BR2) between the second joint J2 and the third switching valve 74; and the fourth oil pressure in the second connection passage CR2. Note that the twenty first communication position CP21 and the twenty second communication position CP22 are collectively referred to as a second communication position CP2. Since the check valve CKV is provided between the second connection passage CR2 and the third joint J3, the hydraulic pressure of the first oil passage R1 does not affect the hydraulic pressure of the second connection passage CR2. The third switching valve 74 is configured to switch to a second communication position CP2 for communicating the second joint J2 with the fourth joint J4 when the third oil pressure is smaller than the fourth oil pressure, and to switch to a second shutoff position BP2 for shutting off the communication between the second joint J2 and the fourth joint J4 when the fourth oil pressure is equal to or smaller than the third oil pressure. The third switching valve 74 switches to a twenty first communication position CP21 to communicate the second joint J2 with the fourth joint J4, and disconnect the third connection passage CR3 and the partial oil passage BR11. On the other hand, when the third oil pressure is smaller than the fourth oil pressure by a predetermined pressure or more, the switching to the twenty first communication position CP21 is performed, the second joint J2 and the fourth joint J4 are communicated, and the third connection passage CR3 and the bypass oil passage BR1 (partial oil passage BR11) are connected. This can prevent the oil pressure of the bypass oil passage BR1 (partial oil passage BR11) from becoming too high.
The work vehicle 1 further includes a first drain oil passage DR1 that connects the fourth chamber CB4 and the hydraulic fluid tank 10 when the second control valve 20 and the fourth chamber CB4 of the second hydraulic cylinder 48 is connected via the fourth oil passage R4 by the first switching valve 72. The switching mechanism 70 further includes a third pilot oil passage PR3 connected to a first counterbalance valve BV1 provided in the first drain oil passage DR1, the fourth switching valve 75, and the first pilot port PP1 of the first switching valve 72 and the fourth switching valve, the switching and the first pilot port PP1 of the first switching valve 72, and a fourth pilot oil passage PR4 connecting the fourth switching valve 75 and the first drain oil passage DR1 between the first switching valve 72 and the first counterbalance valve BV1, and a second drain oil passage DR2 connecting the fourth switching valve 75 and the hydraulic fluid tank 10. The first counterbalance valve BV1 is a control valve configured to be opened when the pressure in the joint J8 shown in the figure becomes higher than the hydraulic pressure in the joint J9 by a predetermined value or more, and to allow the hydraulic fluid to flow from the joint J8 to the joint J9. The first threshold pressure is lower than the predetermined pressure at which the first counterbalance valve BV1 opens. Note that the same counterbalance valves BV2 to BV4 are connected to the fourth to sixth drain oil passages DR4 to DR6 connected to the third oil passage R3, the first oil passage R1, and the second oil passage R2, respectively. The fourth to sixth drain oil passages DR4 to DR6 are connected to the first drain oil passage DR1.
The fourth switching valve 75 includes a first connection port ZP1 connected to the third pilot oil passage PR3, a second connection port ZP2 connected to the fourth pilot oil passage PR4, a third connection port ZP3 connected to the second drain oil passage DR2, and a switching-valve pilot port 75P to which a pilot pressure is applied by the solenoid valve 71. When the pilot oil pressure is applied to the switching-valve pilot port 75P by the second threshold or more, the fourth switching valve 75 is switched to the drain position DP at which the first connection port ZP1, the second connection port ZP2, and the third connection port ZP3 are communicated with each other. When the pilot oil pressure smaller than the second threshold pressure is applied to the switching-valve pilot port 75P, the fourth switching valve 75 is switched to the pressurizing position UP at which the first connection port ZP1 and the second connection port ZP2 are communicated with each other and the third connection port ZP3 is disconnected from the first connection port ZP1 and the second connection port ZP2.
When the solenoid valve 71 is switched to the second position VP2 by the controller 15, the pilot oil pressure is applied to the switching-valve pilot port 75P at a second threshold pressure or higher. Thus, the fourth switching valve 75 is switched to the drain position DP, and the pilot pressure applied to the first pilot port PP1 becomes lower than the first threshold pressure. In this case, the first switching valve 72 is opened, and the second control valve 20 and the fourth chamber CB4 are connected via the fourth oil passage R4, and the fourth oil passage R4 and the first drain oil passage DR1 to the first counterbalance valve BV1 are connected.
At this time, when the arm input member 63 is tilted forward, the pilot pressure pp3 applied to the pilot port 20P2 becomes larger than the pilot pressure pp4 applied to the pilot port 20P2 by the predetermined pressure, and thus the second control valve 20 is switched to the second hydraulic cylinder extension control position AEP. Therefore, the hydraulic fluid having a pressure higher than the third threshold pressure from the hydraulic pump 11 is supplied to the third chamber CB3 of the second hydraulic cylinder 48 through the second control valve 20. As a result, the hydraulic fluid is output from the fourth chamber CB4 of the second hydraulic cylinder 48 to the fourth oil passage R4. Since the first switching valve 72 is opened, the hydraulic fluid is sent to the second arm control valve port XP2 of the second control valve 20 and is discharged to the third drain oil passage DR3 connected to the first drain oil passage DR1.
When the arm input member 63 is tilted rearward, the pilot pressure pp4 applied to the pilot port 20P2 becomes higher than the pilot pressure pp3 applied to the pilot port 20P1 by the predetermined pressure, and thus the second control valve 20 is switched to the second hydraulic cylinder retraction control position ASP. Therefore, the hydraulic fluid having a pressure higher than the third threshold pressure is supplied to the fourth chamber CB4 of the second hydraulic cylinder 48 via the second control valve 20 and the first switching valve 72. Thus, the hydraulic fluid is output from the third chamber CB3 of the second hydraulic cylinder 48 to the third oil passage R3. The hydraulic fluid is sent to the third arm control valve port XP3 of the second control valve 20 and is discharged to the third drain oil passage DR3 connected to the first drain oil passage DR1.
When the solenoid valve 71 is switched to the second position VP2 by the controller 15, the control of the implement 41 is performed independently of the control of the arm 45 except for automatic implement return control described later. In this state, when the implement input member 68 is tilted to the right, the pilot pressure pp1 applied to the pilot port 25P1 becomes larger than the pilot pressure pp2 applied to the pilot port 25P2 by the predetermined pressure, and thus the first control valve 25 is switched to the first hydraulic cylinder extension control position BEP. Therefore, the hydraulic fluid having a pressure higher than the fourth threshold pressure is supplied to the first chamber CB1 of the first hydraulic cylinder 49 through the first control valve 25. Thus, the hydraulic fluid is output from the second chamber CB2 of the first hydraulic cylinder 49 to the second oil passage R2. The hydraulic fluid is sent to the third implement control valve port YP3 of the first control valve 25 and is discharged to the seventh drain oil passage DR7 connected to the first drain oil passage DR1.
When the implement input member 68 is tilted to the left, the pilot pressure pp2 applied to the pilot port 25P2 becomes larger than the pilot pressure pp2 applied to the pilot port 25P1 by the predetermined pressure, and thus the first control valve 25 is switched to the first hydraulic cylinder retraction control position BSP. Therefore, the hydraulic fluid having a pressure higher than the fourth threshold pressure is supplied to the second chamber CB2 of the first hydraulic cylinder 49 through the first control valve 25. Thus, the hydraulic fluid is output from the first chamber CB1 of the first hydraulic cylinder 49 to the first oil passage R1. The hydraulic fluid is sent to the second implement control valve port YP2 of the first control valve 25 and is discharged to the seventh drain oil passage DR7 connected to the first drain oil passage DR1.
After the solenoid valve 71 is switched to the second position VP2, when the solenoid valve 71 is switched to the first position VP1 by the controller 15, pilot oil pressure lower than the second threshold pressure is applied to the switching-valve pilot port 75P, and the fourth switching valve 75 is switched to the pressurizing position UP. At the beginning of the switching, the pilot pressure applied to the first pilot port PP1 is lower than the first threshold pressure, but the pilot pressure immediately increases due to the hydraulic fluid flowing from the fourth oil passage R4. Since the predetermined pressure at which the first counterbalance valve opens is higher than the first threshold pressure, the pilot pressure exceeds the first threshold pressure, and the first switching valve 72 is closed. Therefore, the connection between the second control valve 20 and the fourth chamber CB4 of the second hydraulic cylinder 48 via the fourth oil passage R4 is cut off.
When the first switching valve 72 is closed, if the operation of raising the arm 45 is performed (the operation of tilting the arm input member 63 rearward) and the implement 41 is not operated (the operation of tilting the implement input member 68 to nothing), the second control valve 20 is switched to the second hydraulic cylinder extension control position AEP and the first control valve 25 is switched to the first hydraulic cylinder rest control position BNP. When the arm input member 63 and the implement input member 68 are the same, the same input member is not tilted to the left or right but tilted to the rear side.
At this time, as described above, the hydraulic fluid flows out from the fourth chamber CB4 of the second hydraulic cylinder 48, but flows from the first joint J1 to the second switching valve 73 because the first switching valve 72 is closed. Further, since the additional bypass oil passage BR2 and the first connection passage CR1 connected thereto are connected to the third drain oil passage DR3, the first pressure of the bypass oil passage BR1 (partial oil passage BR10) between the first joint J1 and the second switching valve 73 is larger than the second oil pressure of the first connection passage CR1. As a result, the second switching valve 73 is switched to the first communication position CP1. At this time, the hydraulic fluid is sent from the second switching valve 73 to the first chamber CB1 of the first hydraulic cylinder 49 via the bypass oil passage BR1 (partial oil passage R1) and the first oil passage R1 (partial oil passages R13). At this time, the hydraulic fluid is output from the second chamber CB2 of the first hydraulic cylinder 49 to the second oil passage R2 and the additional bypass oil passage BR2 (partial oil passage BR21), however, since the third switching valve 74 is located at the second shutoff position BP2, the hydraulic fluid cannot flow, and the oil pressure of the second connection passage CR2 rises. When the difference between the fourth oil pressure of the second connection passage CR2 and the third oil pressure of the additional bypass oil passage BR2 (partial passage BR20) exceeds the connection threshold pressure, the switching to either the twenty first communication position CP21 or the twenty second communication position CP22 is performed based on the difference between the third oil pressure of the additional bypass oil passage BR2 (partial passage BR20) and the fourth oil pressure of the second connection passage CR2. When the difference between the fourth oil pressure and the third oil pressure is smaller than a predetermined switching threshold value, the third switching valve 74 is switched to the twenty first communication position CP21. When the difference between the fourth oil pressure and the third oil pressure is equal to or larger than a predetermined switching threshold value, the third switching valve 74 is switched to the twenty second communication position CP22. When the third switching valve 74 is switched to the twenty first communication position CP21 or the twenty second communication position CP22, the hydraulic fluid output from the second chamber CB2 of the first hydraulic cylinder 49 is discharged to the hydraulic fluid tank 10 via the additional bypass oil passage BR2 and the third drain oil passage DR3.
However, when the hydraulic fluid flows out from the fourth chamber CB4 of the second hydraulic cylinder 48, when the second oil pressure of the first connection passage CR1 is increased and the second switching valve 73 is switched to the first blocking position BP1, the hydraulic fluid flowing out from the fourth chamber CB4 is discharged to the hydraulic fluid tank 10 through the first connection passage CR1, the additional bypass oil passage BR2, and the third drain oil passage DR3. Thus, as the hydraulic fluid flows into the third chamber CB3 of the second hydraulic cylinder 48, part of the oil discharged from the fourth chamber CB4 of the second hydraulic cylinder 48 flows into the first chamber CB1 of the first hydraulic cylinder 49, and the rest is discharged to the hydraulic fluid tank 10. The amount of the hydraulic fluid discharged to the hydraulic fluid tank 10 is adjusted by empirically adjusting the size of the throttle at the first blocking position BP1 of the second switching valve 73 so that the change in the elevation angle of the arm 45 with respect to the vehicle body 2 per unit amount of the hydraulic fluid discharged to the hydraulic fluid tank 10 is substantially equal to the change in the swing angle with respect to the arm 45. Therefore, it is controlled to change the swing angle of the implement tip 41T to the arm 45 corresponding to the elevation angle of the arm, and to make a direction from the joint 43 to the implement tip 41T face toward substantially the horizontal direction. Such control is called horizontal control.
When the first switching valve 72 is closed, if the operation of lowering the arm 45 is performed (the operation of tilting the arm input member 63 forward) and the implement 41 is not operated (the operation of tilting the implement input member 68 to nothing), the second control valve 20 is switched to the second hydraulic cylinder retraction control position ASP and the first control valve 25 is switched to the first hydraulic cylinder rest control position BNP. At this time, the hydraulic fluid having a pressure that exceeds the third threshold pressure is output from the second arm control valve port XP2. Since the third threshold pressure is higher than the first threshold pressure and the threshold pressure for opening the first counterbalance valve BV1, the hydraulic fluid is sent to the fourth chamber CB4 of the second hydraulic cylinder 48 via the fourth oil passage R4 by pushing and opening the first switching valve 72. At this time, the hydraulic fluid is discharged from the third chamber CB3 of the second hydraulic cylinder 48 to the hydraulic fluid tank 10 via the third oil passage R3 and the third drain oil passage DR3.
Next, the automatic implement return control will be described.
Referring to
At this time, the memory 15M stores the second reference position REF_PA, which is the position PA of the second hydraulic cylinder 48, as the control target corresponding to REF_H.
Referring to
Further, the memory 15M stores a table (first relational data) representing a first correspondence relationship between the angle of which the adjustment angle θA (HA) to be changed in accordance with the arm height HA is added to the implement inclination angle θI and the position PI of the first hydraulic cylinder 49. When the implement posture detection sensor 57 is comprised of the first inertial measurement unit 57a and the second inertial measurement unit 57b, the hardware processor 15P controls the position PI of the first hydraulic cylinder 49 while referring to the implement inclination angle θI detected by the implement posture detection sensor 57 in order to control the implement direction 41D, and determine the angle obtained by adding the adjustment angle θA (HA) to the implement inclination angle θI with reference to the fifth correspondence relationship in order to determine the position Pr of the first hydraulic cylinder 49 corresponding to the above-described STA_D and REF_D. The hardware processor 15P obtains the position PI of the first hydraulic cylinder 49 from the angle obtained by adding the adjustment angle θA (HA) to the implement inclination angle θI based on the first correspondence relationship. At this time, the memory 15M stores, as a control target corresponding to REF_D, the reference inclination angle REF_θI, which is the implement inclination angle θI corresponding to REF_D, plus the adjustment angle θA (REF_H) [the reference inclination angle REF_θI when θA (REF_H)=0], and the first reference position REF_PI, which is the position PI of the first hydraulic cylinder 49 at that time.
Referring to
Referring to
The present automatic implement return control is characterized in that the first hydraulic cylinder 49 is controlled to be the same relative posture with respect to the arm distal end 45D of the implement 41 at the reference height REF_H at the target height TAR_H which is the arm height HA between the initial height STA_H and the reference height REF_H, and thereafter the arm height HA is changed to the reference height REF_H by controlling the second hydraulic cylinder 48 without changing the position PI of the first hydraulic cylinder 49. That is, the controller 15 is configured to determine the arm height HA of the arm distal end 45D when the implement tip 41T is directed to the reference direction REF_D in the middle of the automatic implement return control as the target height TAR_H. The controller 15 is configured to control the hydraulic circuit 100 so that the arm height HA is changed from the initial height STA_H to the reference height REF_H.
The controller 15 is configured to control the hydraulic circuit 100 so that the implement direction 41D becomes the reference direction REF_D when the arm height HA changes to the target height TAR_H in the middle of the automatic implement return control when the instruction to start the automatic implement return control is received by the input device 17. For example, the target height TAR_H is a value obtained by adding a predetermined offset value Hoff to the reference height REF_H. That is, the target height TAR_H is greater than the reference height REF_H.
The controller 15 performs the following processing when executing the control target calculation module 151. At the start of the automatic implement return control, which is the time point when the input device 17 receives the instruction to start the automatic implement return control, the controller 15 acquires the second initial rotation angle STA_θJ of the fulcrum shaft 59P or the second initial position STA_PA of the second hydraulic cylinder 48 corresponding to the initial height STA_H obtained from the arm posture detection sensor 56 at that time. When the arm posture detection sensor 56 is the potentiometer 56r and acquires the second initial rotation angle STA_θJ, the controller 15 obtains the second initial position STA_PA corresponding to the initial height STA_H which is the position PA of the second hydraulic cylinder 48 based on the second correspondence relationship. When the arm posture detection sensor 56 is the potentiometer 56r and acquires the second initial rotation angle STA_θJ, the controller 15 obtains the initial height STA_H with reference to the third correspondence relationship. When the arm posture detection sensor 56 is the linear sensor 56p and acquires the second initial position STA_PA, the controller 15 obtains the initial height STA_H with reference to the fourth correspondence relationship.
Next, the controller 15 obtains STA_θI, which is the implement inclination angle θI corresponding to the initial orientation STA_D obtained from the implement posture detection sensor 57, from the output of the implement posture detection sensor 57. STA_θI corresponds to the first initial position STA_PI which is the position PI of the first hydraulic cylinder 49 at the time when the instruction to start the automatic implement return control is received by the input device 17. The controller 15 obtains the adjustment angle θA (STA_H) from the initial height STA_H based on the fifth correspondence relationship. The controller obtains a first initial position STA_PI which is the position PI of the first hydraulic cylinder 49 at the time when the instruction to start the automatic implement return control is received by the input device 17, from STA_θI+θA (STA_H) based on the first correspondence relationship. The controller 15 generates a map M1 including L1 represented such that the implement inclination angle θI linearly changes from STA_θI to REF_θI+θA (TAR_H) and L2 represented such that the arm height HA linearly changes from the initial height STA_H at the start of the automatic implement return control to the reference height REF_H. The horizontal axis of the map M1 is the timing t, the arm height HA at the timing t corresponds to the coordinate of the vertical axis on the right side of the point P on the L2, and the implement inclination angle θI at the timing t corresponds to the coordinate of the vertical axis on the left side of the point Q on the L1. The above is the processing of the control target calculation module 151.
The controller 15 performs feedforward control so that the arm height HA obtained from the second parameters (the rotation angle θJ and the position PA) detected by the arm posture detection sensor 56 decreases monotonously as indicated by 56r in
When the arm height HA at the timing t when the second hydraulic cylinder 48 is controlled in this way is HA (t), the controller 15 controls the first hydraulic cylinder 49 so as to approach the implement inclination angle θI (t) in the correspondence relationship as shown in
And when the implement inclination angle θI, which is the first parameter, becomes a first reference value REF_θI+θA (TAR_H), until the position PA of the second hydraulic cylinder 48 changes to the second reference position REF_PA, the controller 15 controls the hydraulic circuit 100 not to change the position PI of the first hydraulic cylinder 49. The dotted line L3 in
In this control, when the target height TAR_H is determined, the controller 15 determines the reference rotation angle REF_θR of the joint 43 at which the arm height HA becomes the target height TAR_H. REF_θR is the rotation angle θR of the joint 43 corresponding to the reference direction REF_D. That is, REF_θR is the first reference value of the first parameter corresponding to the target height TAR_H. That is, the controller 15 determines the first reference value REF_θR of the first parameter corresponding to the target height TAR_H. REF_θR is input to the control target calculation module 151.
The controller 15 performs the following processing when executing the control target calculation module 151. At the start of the automatic implement return control, the controller 15 obtains STA_θR, which is the rotation angle θR of the joint 43 corresponding to the initial orientation STA_D obtained from the implement posture detection sensor 57 at that time, from the output of the implement posture detection sensor 57. STA_θR is a parameter corresponding to the first initial position STA_PI which is the position PI of the first hydraulic cylinder 49 at the time when the instruction to start the automatic implement return control is received by the input device 17. The controller 15 generates a map M2 including L1 represented such that the rotation angle θR linearly changes from STA_θR to REF_θR and a L2 represented such that the arm height HA linearly changes from the initial height STA_H at the start of the automatic implement return control to the reference height REF_H. The horizontal axis of the map M2 is the timing t, the arm height HA at the timing t corresponds to the coordinate of the vertical axis on the right side of the point P on the L2, and the rotation angle θR of the joint 43 at the timing t corresponds to the coordinate of the vertical axis on the left side of the point Q on the L1. The above is the processing of the control target calculation module 151.
In
When the rotation angle θR of the joint 43 becomes REF_θR, that is, when the position PI of the first hydraulic cylinder 49 becomes the first reference position REF_PI, the controller 15 controls the hydraulic circuit 100 so that the position PI of the first hydraulic cylinder does not change until the position PA of the second hydraulic cylinder 48 changes to the second reference position REF_PA. The straight line L3 in
In this control, when the target height TAR_H is determined, the controller 15 determines the position REF_PI of the first hydraulic cylinder 49 at which the arm height HA becomes the target height TAR_H. REF_PI is a first reference position which is the position PA of the first hydraulic cylinder 49 corresponding to the reference direction REF_D. In addition, REF_PI is the first reference value of the first parameter corresponding to the target height TAR_H. That is, the controller 15 determines the first reference value REF_PI of the first parameter corresponding to the target height TAR_H. REF_PI is input to the control target calculation module 151.
The controller 15 performs the following processing when executing the control target calculation module 151. At the start of the automatic implement return control, the controller 15 obtains the first initial position STA_PI obtained from the implement posture detection sensor 57 at that time from the output of the implement posture detection sensor 57. The controller 15 generates a map M3 including L1 represented such that the position PA of the first hydraulic cylinder 49 linearly changes from STA_PI to REF_PI and L2 represented such that the arm height HA linearly changes from the initial height STA_H at the start of the automatic implement return control to the reference height REF_H. The horizontal axis of the map M3 is the timing t, the arm height HA at the timing t corresponds to the coordinate of the vertical axis on the right side of the point P on the L2, and the position PA of the first hydraulic cylinder 49 at the timing t corresponds to the coordinate of the vertical axis on the left side of the point Q on the L1. The above is the processing of the control target calculation module 151.
In
When the position PI of the first hydraulic cylinder 49 reaches the first reference position REF_PI, the controller 15 controls the hydraulic circuit 100 so that the position PI of the first hydraulic cylinder 49 does not change until the position PA of the second hydraulic cylinder 48 changes to the second reference position REF_PA. A straight line L3 in
The first reference position REF_PI, the second reference position REF_PA, the target height TAR_H, and the second target position TAR_PA are determined as follows. The work vehicle 1 further includes an additional input device 13 that receives a registration instruction for registering the reference direction REF_D and the reference height REF_H. The additional input device 13 is, for example, a button, a switch, a dial, or a touch panel. In the case where the arm posture detection sensor 56 is formed of the potentiometer 56r, when the additional input device 13 receives the registration instruction, the controller 15 obtains the position PA of the second hydraulic cylinder 48 from the rotation angle θJ of the fulcrum shaft 59P (joints) at the time when the registration instruction is received, based on the second correspondence relationship. The controller 15 sets the obtained position PA as the second reference position REF_PA. The controller 15 obtains the reference height REF_H from the rotation angle θJ of the fulcrum shaft 59P (joint) at the time when the registration instruction is received based on the third correspondence relationship. The controller 15 sets a value obtained by adding the offset value Hoff to the obtained reference height REF_H as the target height TAR_H. The controller 15 obtains the second target position TAR_PA from the target height TAR_H based on the fourth correspondence relationship. The second target position TAR_PA thus determined is stored in the memory 15M.
In the case where the arm posture detection sensor 56 is formed of the linear sensor 56p, when the additional input device 13 receives the registration instruction, the controller 15 obtains the position PA of the second hydraulic cylinder 48 detected by the linear sensor 56p at the time when the registration instruction is received. The controller 15 sets the obtained position PA as the second reference position REF_PA. The controller 15 obtains the reference height REF_H from the second reference position REF_PA based on the fourth correspondence relationship. The controller 15 sets a value obtained by adding the offset value Hoff to the obtained reference height REF_H as the target height TAR_H. The controller 15 obtains the second target position TAR_PA from the target height TAR_H based on the fourth correspondence relationship. The second target position TAR_PA thus determined is stored in the memory 15M.
In a case where the implement posture detection sensor 57 is configured of a first inertial measurement unit 57a and a second inertial measurement unit 57b, when the additional input device 13 receives the registration instruction, the controller 15 obtains the reference inclination angle REF_θI, which is the implement inclination angle θI at the time when the registration instruction is received, from the output of the first inertial measurement unit 57a and the output of the second inertial measurement unit 57b at the time when the registration instruction is received, and stores the reference inclination angle REF_θI in the memory 15M. The controller 15 obtains the reference height REF_H from the second reference position REF_PA based on the fourth correspondence relationship and obtains the adjustment angle θA (REF_H) from the reference height REF_H based on the fifth correspondence relationship. The controller obtains the first reference position REF_PI from REF_θI+θA (REF_H) based on the first correspondence relationship.
When the implement posture detection sensor 57 is constituted of a potentiometer 57r, when the additional input device 13 receives a registration instruction, the controller 15 obtains the reference rotation angle REF_θR which is the rotation angle θR of the joint 43 at the time of receiving the registration instruction from the output of the potentiometer 57r at the time of receiving the registration instruction, stores the reference rotation angle REF_θR in the memory 15M. The controller 15 calculates the first reference position REF_PI from the reference rotation angle REF_θR with reference to the sixth correspondence relationship. In the case where the implement posture detection sensor 57 is formed of the linear sensor 57p, when the additional input device 13 receives the registration instruction, the controller 15 obtains the first reference position REF_PI from the output of the linear sensor 57p at the time when the registration instruction is received.
Next, the feedforward control of the first hydraulic cylinder 49 and the feedforward control of the second hydraulic cylinder 48 will be described. The hydraulic circuit 100 as described above is configured to equalize the difference between the pressure difference of input-output of the first control valve 25 and the pressure difference of the input-output of the second control valve 20, therefore, the ratio of the flow rate of the hydraulic fluid per unit time through the first control valve 25 and the flow rate of the hydraulic fluid per unit time through the second control valve 20 can be adjusted by the ratio of the first opening area AS1 set by the first control valve 25 to the second opening area AS2 set by the second control valve 20. By utilizing this, the feed-forward control described below is performed at the start timing TSTA of the automatic implement return control and the timing TTAR at which the arm height HA becomes the target height TAR_H shown in
First, when the input device 17 receives an instruction to start the automatic implement return control, the controller 15 executing the control target calculation module 151 obtains a first initial position STA_PI which is the position PI of the first hydraulic cylinder 49 at the time of receiving the instruction and a second initial position STA_PA which is the position PA of the second hydraulic cylinder 48 at the time of receiving the instruction by the above-described method. The controller 15 acquires the first reference position REF_PI, the second reference position REF_PA, and the second target position TAR_PA from the memory 15M. The controller 15 is configured to calculate the first volume V1 of the hydraulic fluid supplied from the hydraulic pump 11 to the first hydraulic cylinder 49 in order to set the position PI of the first hydraulic cylinder 49 as the first reference position REF_PI from the first initial position STA_PI and the first reference position REF_PI. The controller 15 is configured to calculate the second volume V2 of the hydraulic fluid supplied from the hydraulic pump 11 to the second hydraulic cylinder 48 in order to set the position PA of the second hydraulic cylinder 48 as the second target position TAR_PA from the second initial position STA_PA and the second target position TAR_PA.
Next, when the input device 17 receives the instruction to start the automatic implement return control, the controller 15 obtains the maximum allowable value SEM of the sum of the first opening area AS1 and the second opening area AS2 from the rotation speed of the engine 6 at the time when the instruction is received. To be specific, the memory 15M stores a table representing a correspondence relationship between the rotation speed of the engine 6 and the maximum allowable value SEM, and the hardware processor 15P acquires the rotation speed of the engine 6 detected by the rotation speed detection sensor 6a and obtains the maximum allowable value SEM from the rotation speed with reference to the table. The controller 15 determines a limit value SAM which is the sum of the maximum value SMA1 of the first opening area AS1 when the first control valve 25 is switched to the first hydraulic cylinder retraction control position BSP and the maximum value SMA2 of the second opening area AS2 when the second control valve 20 is switched to the second hydraulic cylinder retraction control position ASP. The controller 15 determines the reference value SFF which is smaller value among the maximum allowable value SEM and the limit value SAM. The limit value SAM is known from the specifications of the first control valve 25 and the specifications of the second control valve 20, and is stored in the memory 15M in advance.
The controller 15 calculates the reference area SB1 which is a reference of the first opening area AS1 based on the following (Equation 1).
That is, the reference area SB1 is (first volume V1/(first volume V1+second volume V2)) times the reference value SFF. The controller 15 controls the first opening area AS1 of the first control valve 25 based on the reference area SB1 until the positions PI of the first hydraulic cylinder 49 changes from the first initial position STA_PI to the first reference positions REF_PI.
The controller 15 further performs the following processing. The controller 15 sets the corrected area SB2 to the first target area TS1 when the corrected area SB2 obtained by multiplying the reference area SB1 by the first correction coefficient K1 associated with the rotation speed of the engine 6 is equal to or less than the maximum value SMA1 of the first opening area AS1.
The controller 15 performs the feedforward control so that the first opening area AS1 of the first control valve 25 is set to the first target area TS1 while the position PI of the first hydraulic cylinder 49 is changed from the first initial position STA_PI to the first reference position REF_PI. To be more specific, in the execution of the feedforward controller Cfv1, the controller 15 determines a feedforward control amount (FF control amount) u1o of the first pilot control valve 65 and an FF control amount u2o of the second pilot control valve 66 so that the first opening area AS1 of the first control valve 25 becomes the first target area TS1, and outputs the FF control amount u1o to the solenoid 65s of the first pilot control valve 65 and the FF control amount u2o to the solenoid 66s of the second pilot control valve 66.
The controller 15 performs the feedforward control so that the second opening area AS2 of the second control valve 20 is set to the area obtained by subtracting the first target area TS1 from the reference value SFF until the position PI of the first hydraulic cylinder 49 is changed from the first initial position STA_PI to the first reference position REF_PI. In particular, in the execution of the feedforward controller Cfv2, the controller 15 determines the control amount u3 of the third pilot control valve 60 and the control amount u4 of the fourth pilot control valve 61 so that the second opening area AS2 of the second control valve 20 become the second target area TS2, and outputs the control amount u3 to the solenoid 60s of the third pilot control valve 60 and the control amount u4 to the solenoid of the fourth pilot control valve 61.
When the corrected area SB2 becomes equal to or smaller than the maximum value SMA1 of the first opening area AS1 and the feed-forward control is performed, while the position PI of the first hydraulic cylinder 49 becomes the first reference position REF_PI from the initial position STA_PI, the controller controls the hydraulic circuit 100 so that the absolute value of the amount of change in the positions PI of the first hydraulic cylinder 49 per unit time becomes (absolute value of the difference between the first reference position REF_PI and the first initial position STA_PI/absolute value of the difference between the second target position TAR_PA and the second initial position STA_PA) times as much as the absolute value of the amount in change in the positions PA of the second hydraulic cylinder 48 per unit time.
Next, the feedback control will be described. Referring to
Then, the controller 15 acquires the detected value (θI*, θR*, or PI*) of the first parameter detected by the implement posture detection sensor 57. In the following embodiments, PI* may also be referred to as a detected position PI* of the first hydraulic cylinder 49. The controller 15 that executes the feedback controller cbv1 performs feedback control on the first opening area as1 of the first control valve 25 so as to bring the detected value closer to the target value when the absolute value of the difference between the detected value and the first reference value REF_PI is greater than the absolute value of the difference between the target value and the first reference value by a first threshold value or more.
In
In
In
As described above, by performing the feedback control in addition to the feedforward control, during the position PI of the first hydraulic cylinder 49 becomes the first reference position REF_PI from the first initial position STA_PI, the controller 15 controls the hydraulic circuit 100 so that the absolute value of the amount of change in the positions PI of the first hydraulic cylinder 49 per unit time becomes (absolute value of the difference between the first reference position REF_PI and the first initial position STA_PI/absolute value of the difference between the second target position TAR_PA and the second initial position STA_PA). times as much as the absolute value of the amount of change in the positions PA of the second hydraulic cylinder 48 per unit time.
After starting the feedback control, when the absolute value of the difference between the detected value and the first reference value becomes smaller than the value obtained by adding the second threshold value which is smaller than the first threshold value to the absolute value of the difference between the target value and the first reference value, the controller 15 performs feedforward control such that the first opening area AS1 of the first control valve 25 is set to a value obtained by multiplying the first target area TS1 by a second correction coefficient K2, the second correction coefficient K2 being obtained by dividing the control amount (larger one of u1o and u2o) of the first control valve 25 in case where the feedback control is performed immediately before falling below the second threshold value by the control amount (the larger one of and AS1) of the first control valve 25 in case where the feedforward control is performed such the first opening area AS is set to the first target area TS1.
In
The feedback end range FER1 is a range of θI (t)−D2_θI or more. D2_θI is smaller than the D1_θI. In the case where the implement posture detection sensor 57 is constituted by the first inertial measurement unit 57a and the second inertial measurement unit 57b, when the detected value θI* falls within the feedback end range FER1, the controller 15 acquires the control amounts u1 and u2 immediately before the feedback control is ended. The controller 15 uses a umax which is larger among the control amounts u1 and u2 for calculating the second correction coefficient K2. Further, the controller 15 acquires the control amounts u1o and u2o of the first control valve 25 in the case where the feedforward control is performed so that the first opening area AS1 become the first target area TS1. The controller 15 uses umaxo which is larger among the u1o and u2o for calculating the second correction coefficient K2. Note that, from the nature of the present control, when umax is u1, umaxo is u1o, and when umax is u2, umaxo is u2o.
In
In
In the above-described control method, the first hydraulic cylinder 49 is controlled so that the implement direction 41D becomes the reference direction REF_D as quickly as possible. Therefore, if the movement of the implement 41 is suddenly stopped when the implement direction 41D becomes the reference direction REF_D, the implement 41 vibrates greatly. Similarly, in the above-described control method, the second hydraulic cylinder 48 is controlled so that the arm height HA becomes the reference height REF_H as quickly as possible. Therefore, if the movement of the arm 45 is suddenly stopped when the arm height HA becomes the reference height REF_H, the arm 45 vibrates greatly. Such large vibrations apply a large load to hydraulic devices such as the first hydraulic cylinder 49 and the second hydraulic cylinder 48, and are therefore not preferable from the viewpoint of durability. Therefore, the amount of positional change (shift) per unit time of the first hydraulic cylinder 49 is reduced when the implement direction 41D approaches the reference direction REF_D, and the amount of positional change (shift) per unit time of the second hydraulic cylinder 48 is reduced when the arm height HA approaches the reference height REF_H. Thus, even when the movement of the implement 41 is stopped when the implement direction 41D becomes the reference direction REF_D, the vibration of the implement 41 is suppressed, and even when the movement of the arm 45 is stopped when the arm height HA becomes the reference height REF_H, the vibration of the arm 45 is suppressed. Such control is called cushion control.
The controller 15 obtains the detected position PI* of the first hydraulic cylinder 49 detected by the implement posture detection sensor 57. When the implement posture detection sensor 57 includes the first inertial measurement unit 57a and the second inertial measurement unit 57b, the estimated value HA* of the arm height HA is obtained from the rotation angle θJ* detected by the arm posture detection sensor 56 (potentiometers 56r) or the estimated value HA* of the arm height HA is obtained from the detected position PA* detected by the arm posture detection sensor 56 (linear sensors 56p). The controller 15 obtains the detected position PI* from the detected value θI* detected by the implement posture detection sensor 57 and the adjustment angle θA (HA*) based on the first correspondence relationship. When the implement posture detection sensor 57 is the potentiometer 57r, the detected position PI* is obtained from the detected value θR* based on the sixth correspondence relationship. The controller 15 obtains the displacing speed VEST1 of the first hydraulic cylinder 49, which is the amount of change in the detected position PI* of the first hydraulic cylinder 49 per unit time, from a temporal change in the detected positions PI*. The controller 15 may obtain the displacing speed VEST1 of the first hydraulic cylinder 49 based on only the detected value θI* on the assumption that the adjustment angle θA (HA*) hardly changes regardless of the estimated value HA* of the arm height HA.
The controller 15 calculates a first deceleration time TRED1 of the first hydraulic cylinder 49 by dividing the difference between the displacement speed VEST1 of the first hydraulic cylinder 49 and the first approach speed VAPP1 by the first deceleration speed DV1.
The controller 15 calculates the deceleration start position SR_PI of the first hydraulic cylinder which starts deceleration from the displacement speed VEST1 of the first hydraulic cylinder based on the displacement speed VEST1 of the first hydraulic cylinder 49 and the first deceleration time TRED1. In detail, the controller 15 sets a value obtained by adding a value obtained by multiplying the displacement speed VEST1 of the first hydraulic cylinder by the first deceleration time TRED1 to the first reference position REF_P1 as the deceleration start position SR_P1.
When the implement posture detection sensor 57 is the potentiometer 57r, the controller 15 determines that the detected position PI* of the first hydraulic cylinder 49 has reached the deceleration start position SR-PI when the rotation angle θR corresponding to the deceleration start position SR-PI has been reached, with reference to the sixth correspondence relationship. When the implement posture detection sensor 57 includes the first inertial measurement unit 57a and the second inertial measurement unit 57b, the controller 15 obtains the implement inclination angle θI+adjustment angle θA (HA) corresponding to the deceleration start position SR-PI by referring to the first correspondence relationship and also using the detection result of the arm posture detection sensor 56 and determines that the detected position PI* of the first hydraulic cylinder 49 has reached the deceleration start position SR-PI when the implement inclination angle θI+the adjustment angle θA (HA) has been reached
The controller 15 is configured to control the first opening area AS1 of the first hydraulic cylinder such that the displacing speed VEST1 of the first hydraulic cylinder 49 is reduced based on the first deceleration VEST1 until the displacement speed VEST1 of the first hydraulic cylinder 49 becomes the first approach speed VAPP1 after the detected position P1*| has reached to the deceleration start point SR_P1 (timing TSR1). In concrete terms, the controller 15 linearly decreases the control amounts u1o, u2o of the feedforward controller Cfv1 so that the first opening area AS1 becomes VAPP1/VEST1 times as much as the first target area TS1 (or K1×TS1) at the time of feedforward control after the first deceleration time TRED1 from the timing TSR1. Note that feedback control is not performed during cushion control.
As a result, the position PI of the first hydraulic cylinder 49 reaches the first reference position REF_PI at a timing TRINI slightly delayed from the timing TTAR at which the arm height HA set in the maps M1 to M3 becomes the target height TAR_H. When the implement posture detection sensor 57 is a potentiometer 57r or a linear sensor 57p, the position Prof the first hydraulic cylinder 49 can be controlled to the first reference position REF_PI even if there is a time delay. However, when the implement posture detection sensor 57 includes the first inertial measurement unit 57a and the second inertial measurement unit 57b, there is a problem in that the arm height HA at the timing TFIN1 becomes a height (TAR_H−Δ H) slightly lower than the target height TAR_H. The implement inclination angle θI obtained from the first inertial measurement unit 57a and the second inertial measurement unit 57b is ideally REF_θI+θA (TAR_H-A H), however, since it is difficult to calculate ΔH, the first reference value REF_θI+θA (TAR_H) is obtained. Therefore, the control is performed with the state where the implement tip 41T is directed upward by the deviation θA (TAR_H)−θA (TAR_H−ΔH) of the adjustment angle as a target. Therefore, when the arm height HA becomes the reference height REF_H, the position PI of the first hydraulic cylinder 49 is individually controlled and corrected.
The controller 15 obtains the detected position PA* of the second hydraulic cylinder 48 detected by the arm posture detection sensor 56. When the arm posture detection sensor 56 is the potentiometer 56r, the detected position PA* is obtained from the rotation angle θJ* detected by the potentiometer 56r with reference to the second correspondence relationship. When the arm posture detection sensor 56 is the linear sensor 56p, the detected value detected from the linear sensor 56p is set as the detected position PA*. The controller 15 obtains the displacement speed VEST2 of the second hydraulic cylinder 48, which is the amount of change in the detected position PA* of the second hydraulic cylinder 48 per unit time, from a temporal change in the detected positions PA*.
The controller 15 calculates the second deceleration time TRED2 by dividing the difference between the displacement speed VEST2 of the second hydraulic cylinder 48 and the second approach speed VAPP2 by the second deceleration DV2. The controller 15 calculates the deceleration start position SR_PA of the second hydraulic cylinder 48 at which the second hydraulic cylinder 48 start to decelerate from the displacement speed VEST2, based on the displacement speed VEST2 of the second hydraulic cylinder 48, the second deceleration time TRED2, and the second reference position REF_PA. To be more specific, the controller 15 sets a value obtained by adding a value obtained by multiplying the displacement speed VEST2 of the second hydraulic cylinder 48 by the second deceleration time TRED2 to the second reference position REF_PA as the deceleration start position SR_PA.
When the arm posture detection sensor 56 is the potentiometer 56r, with reference to the second correspondence relationship, the controller 15 determines that the detected position PA* of the second hydraulic cylinder 48 has reached the deceleration start position SR_PA when the rotation angle θJ corresponding to the deceleration start position SR_PA is reached. When the arm posture detection sensor 56 is the linear sensor 56p, the controller 15 determines whether or not the detected position PA* detected by the linear sensor 56p has reached the deceleration start position SR_PA.
The controller 15 controls the second opening area AS2 of the second control valve 20 so as to decelerate the displacement speed VEST2 of the second hydraulic cylinder 48 based on the second deceleration DV2 until the displacement speed VEST2 of the second hydraulic cylinder 48 become the second approach speed VAPP2 after the detected position PA* of the second hydraulic cylinder 48 reach the deceleration start position SR-PA (timing DV2). In concrete terms, the controller 15 linearly decreases the control amounts u3 and u4 of the feedforward controller Cfv2 so that the second opening area AS2 becomes VAPP2/VEST2 times as much as the second target area Cfv2 at the time of feedforward control after the second deceleration time TRED2 from the timing TSR2. As a result, the position PA of the second hydraulic cylinder 48 reaches the second reference position REF_PA at a timing TFIN2 slightly delayed from the timing TREF at which the arm height HA set in the maps M1 to M3 becomes the target height TAR_H.
Next, a method of controlling the work vehicle 1 according to the present embodiment will be described.
In step S2, the controller 15 acquires a reference height REF_H that serves as a reference for an arm height HA, which is the height of the arm distal end 45D with respect to the ground contact surface GL of the traveling device 3 in the height direction DH perpendicular to the travel direction of the traveling device 3. In particular, the hardware processor 15P of the controller 15 obtains the second reference value (REF_θJ, REF_PA) of the first parameter corresponding to the reference direction REF_D stored in the memory 15M of the controller 15.
In step S3, the controller 15 determines a target height TAR_H which is the arm height HA of the arm distal end 45D when the implement tip 41T is oriented in the reference direction REF_D and which is larger than the reference height REF_H. In response to this, the first reference value (REF_θI+θA (TAR_H)) of the first parameter corresponding to the reference direction REF_D stored in the memory 15M of the controller 15 is acquired.
In step S4, the controller 15 determines whether or not an instruction to perform automatic control for changing the implement direction 41D and the arm height HA to the reference direction REF_D and the reference height REF_H, respectively, is received. Specifically, the controller 15 determines whether or not an instruction has been received by the input device 17. If the instruction has not been received (NO in step S4), step S4 is repeated. When the instruction is received (YES in step S4), the controller 15 controls the second hydraulic cylinder 48 so that the arm height HA becomes the reference height REF_H in step S5. Specifically, the controller 15 performs the above-described feedforward control and cushion control on the second hydraulic cylinder 48.
As parallel processing of step S5, in step S6, the controller 15 controls the first hydraulic cylinder 49 so that the implement direction 41D becomes the reference direction REF_D when the arm height HA changes to the target height TAR_H. Specifically, the controller 15 performs the above-described feed-forward control, feedback control, and cushion control on the second hydraulic cylinder 48. After the completion of step S6, the process proceeds to step S5. In step S7, the controller 15 determines whether or not the arm height HA has reached the reference height REF_H. In step S7, since the controller 15 has been controlled in step S6 to set the implement tip 41T to face upward as a target, the controller 15 controls the first hydraulic cylinder 49 to finely adjust the implement direction 41D to the reference direction REF_D. To be more specific, for example, when the implement posture detection sensor 57 is composed of the first inertial measurement unit 57a and the second inertial measurement unit 57b, the first hydraulic cylinder 49 is controlled to perform fine adjustment so that the implement inclination angle θI becomes REF_θI+θA (REF_H) [REF_θI when θA (REF_H)=0].
The controller 15 of the work vehicle 1 according to the present embodiment controls the first hydraulic cylinder 49 so that the implement direction 41D becomes the reference direction REF_D when the arm height HA changes to the target height TAR_H that is greater than the reference height REF_H. This makes it possible to reliably prevent the implement tip 41T from hitting the ground when the arm height HA becomes the reference height REF_H.
In the above-described embodiment, the hydraulic circuit 100 is a circuit capable of mechanically realizing the horizontal control, but may be a simpler hydraulic circuit.
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 embodiment are possible in light of the above teachings.
Thus, it is to be understood that the embodiment may be practiced otherwise than as specifically described herein without departing from the scope of the disclosure.
Number | Date | Country | Kind |
---|---|---|---|
2023-148800 | Sep 2023 | JP | national |