Method of using feedforward compensation based on pressure feedback for controlling swash plate angle in a hydrostatic power unit of a continuously variable transmission

09550490 ยท 2017-01-24

Assignee

Inventors

Cpc classification

International classification

Abstract

A swash plate angle for a hydrostatic power unit of a continuously variable hydromechanical transmission is determined using a feedforward compensation term, to reduce reliance on closed loop control. The feedforward term is based on knowledge of the hydrostatic power unit determined as a function of knowledge of certain parameters, including, but not limited to, hydrostatic power unit pressure, swash plate angle, desired hydrostatic power unit ratio, and pump speed.

Claims

1. A method for automatically controlling an angle of a swash plate of a hydrostatic power unit of a continuously variable hydro-mechanical transmission, the method comprising: determining, with a processor-based controller, a desired hydrostatic reciprocal ratio of the hydrostatic drive unit based on a desired transmission reciprocal ratio for the transmission; determining, with the processor-based controller, a feedforward control term based on the desired hydrostatic reciprocal ratio of the hydrostatic power unit, a pump speed for the hydrostatic power unit, and a pressure for the hydrostatic power unit; determining, with the processor-based controller, a closed-loop control term based on an error calculated as a function of the desired hydrostatic reciprocal ratio; calculating, with the processor-based controller, a swash plate command based on the feedforward control term and the closed-loop control term; and transmitting, with the processor-based controller, the swash plate command for adjusting the angle of the swash plate.

2. The method of claim 1, wherein the pressure corresponds to an estimated pressure for the hydrostatic power unit, the estimated pressure being determined as a function of at least a calculated driveline torque for the transmission, and the pump speed.

3. The method of claim 1, wherein the close-loop control term is determined by the processor-based controller implementing a PID control loop.

4. The method of claim 1, wherein the desired hydrostatic reciprocal ratio is defined as a motor speed for the hydrostatic power unit divided by the pump speed.

5. A method for automatically controlling an angle of a swash plate of a hydrostatic power unit of a continuously variable hydro-mechanical transmission, the method comprising: determining, with a processor-based controller, a desired hydrostatic reciprocal ratio of the hydrostatic drive unit based on a desired transmission reciprocal ratio for the transmission; determining, with the processor-based controller, a feedforward control term based on the desired hydrostatic reciprocal ratio and an estimated pressure for the hydrostatic power unit; determining, with the processor-based controller, a closed-loop control term based on an error calculated as a function of the desired hydrostatic reciprocal ratio; calculating, with the processor-based controller, a swash plate command based on the feedforward control term and the closed-loop control term; and transmitting, with the processor-based controller, the swash plate command for adjusting the angle of the swash plate.

6. The method of claim 5, wherein the feedforward term is additionally determined as a function of a pump speed for the hydrostatic power unit.

7. The method of claim 5, wherein the estimated pressure of the hydrostatic power unit is determined as a function of at least a calculated driveline torque value for the transmission, and a pump speed for the hydrostatic power unit.

8. The method of claim 5, wherein the desired hydrostatic reciprocal ratio is defined as a motor speed for the hydrostatic power unit divided by a pump speed for the hydrostatic power unit.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) FIG. 1 is a side view of a representative work machine including a continuously variable hydro-mechanical transmission automatically controllable according to the invention for controlling swash plate angle;

(2) FIG. 2 is a simplified schematic representation of the hydro-mechanical transmission of the work machine of FIG. 1;

(3) FIG. 3 is a simplified diagrammatic representation of transmission ratio verses hydrostatic power unit ratio for the transmission of FIG. 2;

(4) FIG. 4 is a simplified diagrammatic representation of the swash plate control for the hydrostatic power unit of the transmission of FIG. 2; and

(5) FIG. 5 is a simplified diagrammatic representation of the DHRR PID control for the transmission of FIG. 2.

DETAILED DESCRIPTION OF THE INVENTION

(6) Referring now to the drawings, in FIG. 1 a representative vehicle which is a work machine 1 is shown, which is a tractor representative of those that can be used for a variety of uses, including, but not limited to, agriculture, construction, earth moving and forestry. Work machine 1 includes a power source 4 which will be, for instance, an internal combustion engine, and is mechanically coupled to a continuously variable hydro-mechanical transmission, a representative embodiment 10 of which is shown schematically in FIG. 2. Transmission 10 is automatically operable via a method of controlling swash plate angle according to the invention, as will be explained.

(7) Referring also to FIG. 2, transmission 10 is contained in a transmission housing 11 and includes a hydrostatic power unit 12 and a planetary power unit 30 which are coupled to a driveline including a range gear set 58 mounted within transmission housing 11 and coupled to a load L which here is the drive wheels of machine 1 as shown in FIG. 1. It should be understood that machine 1 can alternatively include a load L that comprises a track drive, or an operating system of the machine such as but not limited to, a power take off (PTO).

(8) Hydrostatic power unit 12 of transmission 10 includes a fluid pump 16 coupled by fluid conduits 17 in a closed loop to a fluid motor 18. Motor 18 is coupled to power source 4 via an input gear N6 and having an output gear N10. The power to the hydrostatic power unit 12 is provided by a driven gear N4 mounted on the forward shaft and engaged with gear N6. Output gear N10 is connected to ring gear NR of planetary power unit 30 via gears N11 and N12.

(9) Machine 1 includes a processor based controller 100 in connection with an input device 102 located preferably in operator cab 104 of machine 1, via a suitable communications path 108, to adjust the angle of a swash plate of pump 16, denoted by the term SPA, for controlling operation of the transmission. As an exemplary embodiment, pump 16 can be an electronically controlled variable displacement hydraulic pump of well known construction.

(10) Planetary power unit 30 includes a primary sun gear NS1 on a planetary input shaft 32 connectable with power source 4 via a forward directional clutch 54 or a reverse directional clutch 52. Power unit 30 is selectively coupled to the load L, coupled to the hydrostatic power unit 12 and selectively coupled to the power source 4, under automatic control of controller 100. For connection to the load L, the hydro-mechanical transmission 10 includes an output shaft 60 coupled to the load L which carries an input gear N18 engaged with an output gear N17 on a range 1/2 shaft of range gear set 58, and a gear N22 engaged with a gear N19 on a range 3/4 shaft. The range 1/2 shaft can be coupled to planetary power unit 30 via automatic operation of range selectors or clutches R1 and R2 for power flow through gears N13 and N14, or N15 and N16, respectively. The range 3/4 shaft can be coupled to unit 30 via range selectors or clutches R3 and R4 for power flow via gears N13 and N20, or N15 and N21. Range 1/2 shaft and range 3/4 shaft can also be simultaneously coupled to power unit 30, to provide dual power flow.

(11) The control of the various clutches will be automatically controlled by controller 100, using actuators 106 connected to controller 100 via suitable conductive paths 108. Transmission 10 also includes appropriate sensors, including pressure sensors 110 for sensing pressure conditions in conduits 17 connecting pump 16 and motor 18, and speed sensors 112 for sensing speeds of load shaft 60, all connected to controller 100 via conductive paths 108. Controller 100 is also connected to engine 4 for receiving speed and other information therefrom.

(12) In operation, the continuously variable hydro-mechanical transmission 10 can be operated to have a combined hydrostatic and mechanical power flow by engaging the reverse clutch 52 to power planetary power unit 30 via gears N1, N3, N5 and N7, or engaging forward clutch 54 to power it via gears N1, N8, and N2. It is also possible to operate transmission 10 for a pure hydrostatic power flow by disengaging both clutches 52 and 54, and engaging two range clutches. Typically, the R1 and R2 range clutches, and the R1 and R4 clutches.

(13) As a result, with transmission 10, there is no selection for a work range or road range per se. However, the transmission provides a seamless transition between ranges to provide work/road configurations as desired. Speed change from zero to maximum speed is achieved in a smooth and continuous manner by changing the SPA of the pump 16 under control of controller 100. For each speed range, substantially the full range of travel of the swash plate is used. That is, the swash plate will be at one end of the range its travel for minimum speed within the range, it will be at the other end for maximum speed in that range, and the zero tilt or neutral position of the swash plate will be an intermediate position for the speed range, not the zero speed position as it is for some other transmissions. This presents a challenge for execution of some transmission commands that require a change of state wherein the swash plate will have to be tilted to a position significantly different from the present position. And, the direction of power flow through the hydrostatic power unit will often reverse during these range changes.

(14) Transmission 10 includes a parking brake 114 in connection with load shaft 60 (or the MFD shaft), which is utilized according to the invention for enabling shuttle shifts and other operations. Parking brake 114 is connected to controller 100 via a suitable conductive path 108 for automatic operative control thereby, including to proportionally or gradually engage, and release or disengage, under certain conditions. To achieve this latter capability, as a non-limiting example, parking brake 114 can be controlled using a proportional pressure reducing valve operated by an electrical signal from controller 100. For operation when machine 1 is not operating, parking brake 114 can be engaged by a spring or other biasing element or elements, or by mechanical means.

(15) Other conditions wherein parking brake 114 will be automatically controlled by controller 100 to engage, or remain engaged if already engaged, can include, but are not limited to, when power source 4 of machine 1 is turned off, the transmission is disengaged, the operator leaves the operator seat, and a time out condition wherein the operator leaves the FNR lever in F for a period of time without movement. Controller 100 will also control the parking brake to remain engaged when a command is received to disengage the parking brake, until certain conditions are met, as will be explained. Other conditions include when a command is received via an input device 102, e.g., FNR lever or the like, to change the operating state of the transmission. Such commands can include a change to, or in close proximity to, a neutral or zero movement state, or a clutch command.

(16) Referring also to FIG. 3, a graphical representation of the relationship of transmission ratio TRR, to hydrostatic power unit ratio (motor speed/pump speed) HRR, is shown, for the four selectable forward ranges: namely, forward range 1 or low; forward range 2; forward range 3; and forward range 4. HRR directly relates to swash plate angle, which is the parameter controlled by controller 100 according to the invention as will be explained. In FIG. 3, it should be noted that for each of the ranges, the zero tilt position of the swash plate lies between the maximum degrees of tilt in the opposite directions of movement of the swash plate. Thus, at the lowest hydrostatic power unit ratio for forward range 1, the swash plate will be near maximum tilt in the left hand direction as depicted, which is also the zero speed ratio for the transmission for that direction, while at the highest ratio for that range the swash plate will be near its maximum tilt in the opposite direction, which is the right hand direction as depicted. It can be noted that for the reverse direction, the opposite is true. Thus, it can also be understood that to go from zero speed in the lowest range in the forward direction to zero speed in the lowest range in the reverse direction, the swash plate must travel substantially its entire range of movement.

(17) One of the main functions of controller 100 is to control HRR. A vehicle control logic VCL determines desired vehicle actions. The VCL portion of the software handles the user interface. Driveline control logic DCL controls operation of controller 100 for executing the desired actions required by transmission 10. Controller 100 calculates the DTRR and DTOA, based on operator inputs and strategy to control engine speed. The controller then achieves this DTRR and DTOA through control of the clutches and HRR. The swash plate directly controls the speed of the vehicle (except during shuttle shifts that slip clutches or when clutch is depressed). The performance of the hydrostatic power unit thus directly impacts the performance of the vehicle. The design of the controls should optimize the performance of the swash plate movement. The swash plate control can be divided into several different areas, illustrated in FIG. 4, and described below. The desired TRR or DTRR supplied by the VCL cannot be used to directly control the swash plate since it could result in excessive accelerations. It must be limited by the Desired Transmission Output Acceleration supplied by the VCL. The DTRR and DTOA should be viewed as connected, and often the DTOA controls how the vehicle feels.

(18) Controller Transmission Reciprocal Ratio (CTRR)

(19) The DTRR supplied by the VCL cannot be used to directly control the swash plate since it could result in excessive accelerations. It must be limited by the Desired Transmission Output Acceleration supplied by the Logic Controller. The DTRR and DTOA should be viewed as connected, and often the DTOA controls how the vehicle feels. This limited version of DTRR is called CTRR (Controller Transmission Reciprocal Ratio).

(20) CTRR must be initialized to zero when the controller turns off the parking brake and enters the first range. CTRR is limited so that it does not go beyond the shift point until the shift completes (since actual TRR may lag CTRR). Note CTRR is also limited when the range is limited due to faults.

(21) The CTRR may also be manipulated during range shifting and shuttle shifting, to avoid poor performance. For example, to prevent shifting back and forth if the DTRR commanded by VCL is near the shift point, hysteresis is added to DTRR before it is used by the DCL in most all instances. The DCL will not achieve the exact DTRR commanded by the VCL near the shift point, but the VCL can still adjust the engine speed to achieve the exact ground speed desired.

(22) As the CTRR approaches the DTRR, the DTOA used for CTRR calculation is reduced to improve the feel and reduce any overshoot. This is also done as the CTRR approaches zero.

(23) During shuttle shifts directional swaps, the CTRR does jump directly to the Opposite TRR, determined from the DTRR commanded by the VCL (which immediately jumps to the reverse direction to command a shuttle) and parameters that determine how shuttle shifts are performed. DTOA is not used to ramp the CTRR during a directional swap, but is used control vehicle deceleration and reacceleration by modulating the pressures in the clutches or park brake, as explained later in sections on shuttle shifting.

(24) A version of CTRR without DTOA limiting is created so that ultimately it can be used to prevent controller windup by indicating how far CTRR is from the DTRR command, but properly take into account range limiting and such. In HS mode, CTRR is calculated in a similar way, but without any changes for range shifts or shuttles.

(25) Desired Hydrostatic Reciprocal Ratio (DHRR)

(26) From CTRR, the desired ratio across the HSU is calculated (DHRR). The required ratio across the HSU for a given TRR varies depending on the range clutches engaged. This is illustrated in FIG. 3. The HRR needed for a given TRR and range is derived by equations below. This will be termed the Desired HRR or DHRR. As the DTRR increases, the HRR increases in the first range, then decreases in the second range. As the shift occurs, the method for determining the DHRR must change.

(27) The SPA will be controlled in a closed loop fashion to achieve the HRR, which will then in turn provide the correct TRR. In this simple way, the correct ratio is controlled. The transmission output speed is not directly needed.

(28) The only common reason that the TRR would not be accurately achieved is if the clutches are slipping. In this case, the SPA will not be adjusted to maintain the speed, since this would simply result in additional clutch slippage and possibly more damage. This should not occur in a correctly functioning transmission, and is monitored as a fault condition.

(29) Only exactly at the shift point is the DHRR the same in two different ranges, for a given TRR. Since shifts cannot always occur exactly at the ideal shift point, and shifts are not instantaneous, a transition is needed from calculating the DHRR from one equation in the off-going range to another in the on-coming range.

(30) The rate of change of DHRR is also controlled, even after the CTRR rate of change control using DTOA. This is done to reduce the rate of change near the shift point to improve the shift quality. Different rate limits are also used when positioning the swash plate before engaging (to avoid overshoot and minimize time to engage) and during shuttle shifts that move the swash plate while driveline is disengaged.

(31) PID Closed Loop Control to Achieve DHRR

(32) Referring also to FIG. 5, now that the desired ratio (DHRR) is determined, a closed loop control system is used to achieve the target, by changing the swash plate command. This closed loop control will be active in one form or another through all modes (range shifting, powered zero, hydrostatic, cold start, even shutdown). The same PID control will be used, although the target (DHRR) and gains modifications may be done differently.

(33) The swash plate control uses a common Proportional, Integral and Derivative (PID) approach, but with the gains adjusted according to lookup tables using several other factors. The integral sum is also adjusted during the range shift, to compensate for hysteresis in the HSU.

(34) One important aspect of the closed-loop PID control of the swash plate is the open loop (feedforward) term calculated from the swash plate angle. The feed forward term is calculated from first principles using the equation for relating HRR to SPA below. The volumetric efficiency is calculated using a three dimensional lookup table (three inputs, one output). The volumetric efficiency changes from greater than one to less than one as the power through the HSU changes direction. This is a discontinuity that is compensated for using this feed forward technique.

(35) Rather than using the measured pressure for the feedforward term, a special estimated pressure is constructed. First the driveline torque is calculated, which is explained below. The driveline torque should be relatively constant, especially before and after a shift. During a range shift clutch swap, this driveline torque estimate is held constant and not updated with new pressure values, since the pressure during the range shift clutch swap does not reflect the driveline torque (due to transients). An estimated HSU pressure is calculated for the oncoming range using the driveline torque. This also allows the swash plate to be commanded to the correct position needed after the shift before the shift actually occurs, which is useful to compensate for the delay in moving the swash plate.

(36) The rate of change of the DHRR is also carefully controlled using shift status information, to improve the performance. As the DHRR approaches the shift point, the rate of change is reduced, to allow the TRR to catch up and reduce the error, which reduces the chance of overshoot.

(37) The integral term includes several features aimed at controlling windup (excess in the integral sum from long periods of error, leading to overshoot). The primary mechanism used is to cut the integral gain all the way to zero if the error between the DTRR and rate limited CTRR is high (although the actual limit is in terms of HRR). This allows the feedforward term to drive the command until closer to the target.

(38) In conclusion, this approach also allows for fast step response and minimal overshoot needed for engaging and shuttling, which is challenging with the transmission architecture, and also good tracking with little error for smaller movements.

(39) HRR from Displacements and Efficiencies

(40) The speed ratio across the pump (HRR) can be written,

(41) HRR = motor pump = V pump V motor .Math. Total_Vol ( P HSU , SPA , pump ) .Math. SPA
where V.sub.pump and V.sub.motor are the volumes of the pump and motor, .sub.motor is the speed of the motor, .sub.pump is the pump speed, and .sub.Total.sub._.sub.Vol is the total volumetric efficiency of the pump and motor that depends on the HSU pressure, Swash Plate Angle (SPA) and the pump speed. The efficiency will be calculated using test data provided by the HSU manufacturer or from testing and recorded, using a three dimensional lookup table (three inputs, one output). The efficiencies are less than one when the pump is functioning as a pump (non-regeneration mode) and greater than one if the pump is functioning as a motor (regeneration mode). This can also be viewed as dividing by the efficiency rather than multiplying by it, but this requires writing another equation.

(42) This equation can be solved for SPA, except that the volumetric efficiency is a function of SPA. The algebraic loop can be resolved by simply using the feedforward SPA term (output of the lookup table) from the last loop.

(43) For non-regeneration mode, indicated by a positive sign(P.sub.HSU.Math..sub.motor)

(44) SPA = V motor Total_Vol ( P HSU , SPA , pump ) .Math. V pump .Math. HRR
For regeneration mode, indicated by a negative sign(P.sub.HSU.Math..sub.motor)

(45) SPA = Total_Vol ( P HSU , SPA , pump ) .Math. V motor V pump .Math. HRR
Transmission Torque Equations

(46) The torque in the motor in N*m is equal to

(47) T motor = P HSU .Math. V motor 2 .Math. .Math. Motor_Mech
where the pressure is in Pa (N/m^2) and the motor volume is in m^3. The pressure is positive for non-regenerative mode and negative for re-generation mode. Note that the efficiency term is the mechanical efficiency of the motor alone, not the total for the HSU. If we convert the pressure in bar and motor volume in cubic cm,

(48) T motor = P HSU .Math. V motor 2 .Math. .Math. 10 .Math. Motor_Mech
and again the torque is in N*m.

(49) Motor efficiency will be measured on a test platform, using torque transducers on the axle loads.

(50) The motor efficiency is less than one for non-regeneration mode, indicated by a positive sign(P.sub.HSU.Math..sub.motor), and greater than one for regeneration mode, indicated by a negative sign(P.sub.HSU.Math..sub.motor). Generally the motor efficiency varies with Pressure, SPA and pump speed.

(51) As noted above, driveline torque may also be used to estimate HSU pressure for on-coming range during range shifts. Motor efficiency is determined from a look up table that is a function of pressure.

(52) The torque at the planetary output can be written in terms of the motor torque,

(53) For Range 1 and 3,

(54) T P 13 = T m .Math. ( N 12 N 10 ) K 1 .Math. ( K 1 - 1 )
where

(55) K 1 = - N R N P 2 .Math. N P 1 N S 1
and where N.sub.12 is the number of teeth of gear N12 and N.sub.10 is the number of teeth of gear N10. Additionally, N.sub.R is the number of teeth of the ring gear of the planetary; N.sub.P1 is the number of teeth of each planet gear NP1; N.sub.P2 is the number of teeth of each planet gear NP2; and N.sub.S1 is the number of teeth of the primary sun gear NS1.
For Range 2 and 4,

(56) T P 24 = T m .Math. ( N 12 N 10 ) ( ( K 2 - 1 ) K 1 ( K 2 - K 1 ) ) .Math. [ ( K 2 - 1 ) .Math. K 1 ( K 2 - K 1 ) - 1 ]
where

(57) K 2 = N S 2 N P 2 .Math. N P 1 N S 1
and N.sub.S2 is the number of teeth of the secondary sun gear NS2.

(58) The output torque can now be written in terms of the planetary torque, for each range,

(59) For Range 1,

(60) 0 T O 1 = T P ( N 13 N 14 ) .Math. ( N 17 N 18 ) .Math. plantery
where N.sub.13 is the number of teeth of the gear N13; N.sub.14 is the number of teeth of gear N14; N.sub.17 is the number of teeth of gear N17; N.sub.18 is the number of teeth of gear N18, and n is the efficiency of the planetary power unit, which can be known or determined through testing.
For Range 2,

(61) T O 2 = T P ( N 15 N 16 ) .Math. ( N 17 N 18 ) .Math. plantery
where N.sub.15 is the number of teeth of the gear N15; and N.sub.16 is the number of teeth of gear N16.
For Range 3,

(62) T O 3 = T P ( N 13 N 20 ) .Math. ( N 19 N 22 ) .Math. plantery
where N.sub.19 is the number of teeth of the gear N19; N.sub.20 is the number of teeth of gear N20; N.sub.21 is the number of teeth of gear N21; and N.sub.22 is the number of teeth of gear N22.
For Range 4,

(63) T O 4 = T P ( N 15 N 21 ) .Math. ( N 19 N 22 ) .Math. plantery
The output torque is then given in terms of the motor torque, for each range by,
T.sub.O1=M.sub.O1.Math.M.sub.P13.Math.T.sub.m
T.sub.O2=M.sub.O2.Math.M.sub.P24.Math.T.sub.m
T.sub.O3=M.sub.O3.Math.M.sub.P13.Math.T.sub.m
T.sub.O4=M.sub.O4.Math.M.sub.P24.Math.T.sub.m
Where

(64) M P 13 = ( N 12 N 10 ) K 1 .Math. ( K 1 - 1 ) M P 24 = ( N 12 N 10 ) ( ( K 2 - 1 ) .Math. K 1 ( K 2 - K 1 ) ) .Math. [ ( K 2 - 1 ) .Math. K 1 ( K 2 - K 1 ) - 1 ] M O 1 = 1 ( N 13 N 14 ) .Math. ( N 17 N 18 ) .Math. plantery M O 2 = 1 ( N 15 N 16 ) .Math. ( N 17 N 18 ) .Math. plantery M O 3 = 1 ( N 13 N 20 ) .Math. ( N 19 N 22 ) .Math. plantery M O 4 = 1 ( N 15 N 21 ) .Math. ( N 19 N 22 ) .Math. plantery
The output torque is related to the drawbar force (or traction force),
F.sub.drawbar=T.sub.O.Math.Ratio.sub.Final.sub._.sub.Drive/Tire_Radius
The torque at each clutch can be related to the output torque of the transmission,

(65) T C 1 C 2 = T O .Math. ( N 17 N 18 ) T C 3 C 4 = T O .Math. ( N 19 N 22 )

(66) It will be understood that the foregoing descriptions are for preferred embodiments of this invention and that the invention is not limited to the specific forms shown. Other modifications may be made in the design and arrangement of other elements without departing from the scope of the invention as expressed in the appended claims.