Traction control method and apparatus for a work vehicle with independent drives

Abstract

A method and apparatus for controlling traction of a vehicle with independent drives or motors connected to the wheels or other ground engaging apparatuses. Nominal torque allocations can be determined for a set of motors, the motors connected to ground engaging elements and including a front set of motors and a rear set of motors. The nominal torque allocations can be modified based on a lateral differential correction and a fore-aft differential correction to produce modified torque commands and the modified torque commands can be applied to the set of motors.

Claims

1. A work vehicle comprising: a front-left wheel; a front-left motor mechanically coupled to the front-left wheel to provide torque to the front-left wheel; a front-right wheel; a front-right motor mechanically coupled to the front-right wheel to provide torque to the front-right wheel; a rear-left wheel; a rear-left motor mechanically coupled to the rear-left wheel to provide torque to the rear-left wheel; a rear-right wheel; a rear-right motor mechanically coupled to the rear-right wheel to provide torque to the rear-right wheel; and a traction controller electrically connected to the front-left motor, the front-right motor, the rear-left motor, and the rear-right motor, the traction controller configured to determine a front lateral differential correction, a rear lateral differential correction, and a fore-aft differential correction and apply an individual torque command to each of the front-left, front-right, rear-left, and rear-right motors, the individual torque command for the front-left motor based on at least in part a commanded torque, the front lateral differential correction, and the fore-aft differential correction, the individual torque command for the front-right motor based on at least in part the commanded torque, the front lateral differential correction, and the fore-aft differential correction, the individual torque command for the rear-left motor based on at least in part the commanded torque, a rear lateral differential correction, and the fore-aft differential correction, the individual torque command for the rear-right motor based on at least in part the commanded torque, the rear lateral differential correction, and the fore-aft differential correction, wherein the controller is configured to apply an individual torque command for the front-left motor equal to a front-left motor nominal torque command plus the front lateral differential correction plus the fore-aft differential correction; wherein the controller is configured to apply an individual torque command for the front-right motor equal to a front-right motor nominal torque command minus the front lateral differential correction plus the fore-aft differential correction; wherein the controller is configured to apply an individual torque command for the rear-left motor equal to a rear-left motor nominal torque command plus the rear lateral differential correction minus the fore-aft differential correction; and wherein the controller is configured to apply an individual torque command for the rear-right motor equal to a rear-right motor nominal torque command minus the rear lateral differential correction minus the fore-aft differential correction.

2. The work vehicle of claim 1, wherein the front-left motor nominal torque command equals the front-right motor nominal torque command; and wherein the rear-left motor nominal torque command equals the rear-right motor nominal torque command.

3. A method of controlling a work vehicle, the method comprising: determining nominal torque allocations to a set of motors, the motors connected to ground engaging elements and including a front set of motors and a rear set of motors; modifying the nominal torque allocations based on a lateral differential correction and a fore-aft differential correction to produce modified torque commands; applying the modified torque commands to the set of motors; determining a fore-aft differential speed, wherein the fore-aft differential correction comprises a fore-aft integral term and a fore-aft proportional term, the fore-aft integral term based on at least in part the fore-aft differential speed and the fore-aft proportional term based on at least in part the fore-aft differential speed; and determining a front lateral differential speed and determining a rear lateral differential speed, wherein a front lateral differential correction comprises a front lateral proportional term based on at least in part the front lateral differential speed, and wherein a rear lateral differential correction comprises a rear lateral proportional term based on at least in part the rear lateral differential speed.

4. The method of claim 3, wherein each set of motors includes a right and a left motor, the modified torque allocation for the front-left motor equals a front-left motor nominal torque command plus the front lateral differential correction plus the fore-aft differential correction; wherein modified torque command for the front-right motor equals a front-right motor nominal torque command minus the front lateral differential correction plus the fore-aft differential correction; wherein the modified torque command for the rear-left motor equals a rear-left motor nominal torque command plus the rear lateral differential correction minus the fore-aft differential correction; and wherein the modified torque command for the rear-right motor equals a rear-right motor nominal torque command minus the rear lateral differential correction minus the fore-aft differential correction.

5. The method of claim 4, wherein the front-left motor nominal torque command equals the front-right motor nominal torque command; and wherein the rear-left motor nominal torque command equals the rear-right motor nominal torque command.

6. The method of claim 4, wherein the fore-aft integral term is a deadband integral term and the fore-aft proportional term is a deadband proportional term.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

(1) The detailed description of the drawings refers to the accompanying figures in which:

(2) FIG. 1 is a is a side view of a work machine in accordance with an embodiment of the present disclosure;

(3) FIG. 2A is a flow chart showing a method for controlling traction of a work machine shown in FIG. 1;

(4) FIG. 2B is an illustration of a model of the drivetrain shown in FIG. 1;

(5) FIG. 3 is a flow chart showing a method for controlling traction of a work machine shown in FIG. 1

(6) FIG. 4 is a schematicized control circuit illustrating aspects of the present disclosure;

(7) FIG. 5 is a graph utilized to help describe aspects of the present disclosure;

(8) FIG. 6 is a block diagram of a drive system;

(9) FIG. 7 is a schematic representation of an articulated vehicle, such as the work machine of FIG. 1;

(10) FIG. 8 is a perspective view of a work machine in accordance with an embodiment of the present disclosure; and

(11) FIG. 9 is a perspective view of a work machine in accordance with an embodiment of the present disclosure.

(12) Like reference numerals are used to indicate like elements throughout the several figures.

DETAILED DESCRIPTION

(13) Referring now to the drawings, and in particular FIGS. 1, 6, and 7, there is shown a work machine 10 in accordance with an embodiment of the present disclosure. Work machine 10 may be used for performing, for example, agricultural, industrial, construction, forestry work and/or mining operations, and may be an articulated wheel driven loader 10. Work machine 10 is a payload carrying vehicle that generally carries the payload in a manner that is exposed to the elements and is a load that can vary rapidly and/or be distributed in the load carrying portion in an uneven, unpredictable manner. For purposes of this application a loader vehicle shall include vehicles that have at least two drive units including a loader, a skid steer loader, a backhoe, a fork lift, a dump truck, a motor grader, a log skidder, a feller buncher, a log harvester, a log forwarder, and a vehicle that has an apparatus that can pick up a load from the ground. Embodiments of the present disclosure may also be used with other work vehicles that would benefit from such use, such as, for example, tractors, combines, self-propelled sprayers and other suitable vehicles.

(14) Loader 10 includes a cab 12 in which the operator is housed along with controls for the control of the functions of loader 10. Loader 10 includes a front section, illustrated as a loader section 14 and a rear section, illustrated as a power section 16. Loader section 14 and power section 16 are connected at an articulation point and move relative to each other about this point by way of an articulation section 18. Portions of the power system may reside in either section 14 or 16.

(15) Loader 10 includes wheels 20, 22, 24 and 26; each driven by a separate drive mechanism, such as motors 21, 23, 25, and 27, respectively. Drive system 28 includes a traction controller 60 that is connected with motors 21, 23, 25, and 27, operator inputs 62 and optionally sensors 34, which may be integral to the motors. Motors 21, 23, 25, and 27 may be electrically driven drive units (e.g., switched reluctance, permanent magnet, induction) each being associated with an individual wheel 20, 22, 24 and 26. Sensors 34 can detect, among other things, the rotational speed of each of motors 21, 23, 25, and 27 or wheels 20, 22, 24 and 26. In another embodiment, motors 32 are controlled by motor controllers and or inverters that can provide information about the rotation speed of motors 21, 23, 25, and 27 and/or wheels 20, 22, 24, and 26. In other embodiments, motors 21, 23, 25, and 27 have integral sensing to determine motor speed.

(16) Wheel 20 rotates about an axis 36, wheel 22 rotates about an axis 38, wheel 24 rotates about an axis 40, and wheel 26 rotates about an axis 42. Axes 38 and 40 may be coaxial and in a like manner axes 36 and 42 may be coaxial. An angle 44 may be described as existing between the coaxial axes as illustrated in FIG. 7. Center line 46 of loader section 14 and center line 48 of power section 16 form an angle 50 known as the articulation angle between section 14 and 16, which corresponds to angle 44.

(17) In one embodiment of the present disclosure, power section 16 includes an engine that may be electrically (e.g., via a generator and inverter system or other apparatus for providing electrical power) or hydraulically coupled to drive units in each of wheels 20, 22, 24 and 26. Although the drive units may be of any type, for the ease of explanation the drive units will be considered electrically driven motors that are independently driven at a commanded torque with the command being issued from the controller 60. The present disclosure affords the opportunity to provide a traction control system that allows for independent tuning of fore-aft speed error and lateral speed errors, both front and rear.

(18) The traction controller can be a traction control unit (TCU). The TCU can comprise a microprocessor which is used to execute a traction control program. The TCU can contain circuitry to process both analog and digital on/off type inputs from sensors that are then used by the microprocessor to determine the current traction operation. The traction control program can be used to process measured operating conditions to derive the appropriate control output signals to run various traction control actuators. Additional parameters affecting the desired tractive operating conditions can be received from other control modules. The main traction control program, control algorithms, lookup tables, constants and other important aspects of the traction control program can be stored in a memory (e.g., a flash memory) so that the TCU operating characteristics can be upgraded in the field. Some often used routines such as table lookups can be stored in a non-volatile ROM, if available, since these routines will be generally required by every conceivable control program. Flash memory reprogramming routines may also be stored in the non-volatile ROM, allowing the microprocessor to execute a flash reprogramming program while the flash memory is unavailable for program execution. An EEPROM can be used to store serial numbers, unique ID codes and adaptation values. A RAM can be used to store temporary results. An inter-control module can transfers data to and from other vehicle systems. A communication port can provide a connection means for the TCU for diagnostic tests, error codes and TCU reprogramming. Similarly, the vehicle can include an engine control unit (ECU) that controls the internal combustion engine. Alternately, the TCU and ECU can be combined into a single controller or controller system.

(19) FIGS. 2A and 2B illustrate the traction control system and method. In step 200, the nominal torque allocations to the motors are determined based on a desired torque provided via the operator input 62. In an embodiment, the desired torque is divided equally amongst the motors to determine the nominal torque allocations. In other embodiments, the desired torque could be allocated differently depending on machine characteristics, operation characteristics, or user preference. The torque command magnitudes can be limited as a function of motor speed to be less than the motor torque curve. The commands can then be scaled by the motor reference torque. The motor torque commands can also be converted from the machine frame of reference to the motor frame of reference. In the machine frame of reference, positive torque accelerates the machine forward. In the motor frame of reference, positive torque accelerates the motor clockwise when looking at the output shaft.

(20) As discussed in more detail below, each motor command is adjusted by the traction control correction in step 210. FIG. 2B shows a model 240 of the disclosed differential traction control system. Model 240 shows the disclosed system in reference to a conventional drivetrain with limited slip axles. Rear wheels 250 and 252 have speeds 252 and 256, respectively, and front wheels 262 and 264 have speeds 262 and 264, respectively. Speeds 252, 256, 262, and 266 can include articulation angle compensation and be based on speed sensors on the machine or motors or be provided the motor controller. The disclosed differential traction control utilizes differential speeds components to control the traction. Rear differential correction torque 258 includes a rear lateral proportional term based on the difference between speeds 252 and 256.

(21) Front differential correction torque 268 includes a front lateral proportional term based on the difference between speeds 262 and 264. Fore-aft differential correction torque 270 includes a fore-aft proportional term and a fore-aft integral term, both terms based on the difference between the average front speeds 262, 264 and the average rear speeds 252, 254. The lateral differential control can be compared to a conventional axle differential. The integral differential control can be compared to a torsional spring coupling and may exhibit similar behavior characteristics as drivetrain windup, but it can be wound as discussed below.

(22) The correction torques can include a deadband, as discussed further below. The torque commands for rear motors are based on the nominal torque allocation, the fore-aft differential correction torque 270, and the rear lateral differential correction torque 258. The torque commands for the front motors are based on the nominal torque allocation, the fore-aft differential correction torque 270, and the front lateral differential correction torque 268.

(23) In other embodiments, the lateral differential correction torques can include an integral term. Also the gains of the proportional and integral terms may be user selectable (e.g. on a user display or other input), which enables that component to be disabled or varied based on operator preferences.

(24) In step 220, the torque commands are applied to the motors 21, 23, 25, and 27. Then the method returns to step 210 to make further modifications based on changing speeds 252, 256, 262, and 266. When the operator commands a different desired torque, the method returns to step 200.

(25) Referring now to FIG. 3, a traction control method starts at step 300 with the determination of the centerline speeds. The speeds used for traction control can be modified as a function of articulation angle and articulation angular velocity such that the desired differential speed while steering is zero. These are called centerline speeds, because they represent the speed of the axle center as estimated from each motor speed. Given the articulation angle , the modified motor speeds in kph are:

(26) $v_j=\left(\frac{\frac{{}_j}{r_{\mathrm{fd}}}\frac{}{30}\stackrel{.}{}\frac{}{180}\frac{W}{4r}}{1\frac{}{180}\frac{W}{2L}}\right)3.6r,$
where is motor speed in rpm, r.sub.fd is the final drive ratio, r is the nominal tire radius, W is the tread width, and L is the wheel base. The top operator corresponds to left motors, the bottom to right motors. The articulation angular velocity term, which is the top right term, may be omitted. In step 305, the rear right motor centerline speed is v.sub.RR, the rear left motor centerline speed is v.sub.RL, the front right centerline speed is v.sub.FR, and the front left centerline speed is v.sub.FL. As discussed above, the motor speeds can be sensed or otherwise provided. The articulation angle can be sensed or otherwise provided as well. The tire radius and tread width can be set to average sizes, but these parameters could also be input to the system.

(27) In step 306, the differential speeds are determined. The traction control correction is an adjustment of the motor torque commands in order to reduce the relative speed of the motors. It is a state feedback control on three objectives, namely front differential speed v.sub.F, rear differential speed v.sub.R, and fore-aft differential speed v.sub.FA as follows:
v.sub.F=v.sub.FLv.sub.FR
v.sub.R=v.sub.RLv.sub.RR
v.sub.FA=v.sub.FL+v.sub.FRv.sub.RLv.sub.RR
where v.sub.FA is the difference between the average front speed and the average rear speed, times two.

(28) In step 315, the slip target(s), which also can be called the deadband speed, v.sub.db is/are determined as a function of an estimated ground speed v, as illustrated in graph 352 of FIG. 5. The control system addresses slip issues when the slips is more or less than the allowed slip. The slip targets for the proportional terms and the integral terms may be the same or different. The slip targets may be provided in a lookup table. The slip targets may be a small percentage at digging speed (e.g. 1%-3%) and a larger percentage at transport speed (10% to 20%). Furthermore, the deadband speed, or slip targets, could be adjusted by the operator.

(29) In step 310, the deadband proportional terms T.sub.p are determined for front lateral T.sub.pF, rear lateral T.sub.pR, and fore-aft T.sub.pFA. The deadband fore-aft proportional term (i.e., proportional effort) T.sub.pFA is

(30) $T_{\mathrm{pFA}}=\{\begin{array}{c}{K}_{\mathrm{pFA}}\left(v_{\mathrm{FA}}-v_{\mathrm{db}}\right),\mathrm{if}{v}_{\mathrm{FA}}>v_{\mathrm{db}}\\ K_{\mathrm{pFA}}\left(v_{\mathrm{FA}}+v_{\mathrm{db}}\right),\mathrm{if}{v}_{\mathrm{FA}}<-v_{\mathrm{db}}\\ 0\mathrm{otherwise}\end{array}$
Lateral proportional terms are determined similarly.
In step 320, the fore-aft deadband integral term T.sub.i is determined. The integral term consists of two accumulators, one has a reference of +v.sub.db and is limited to be positive, and the other has a reference of v.sub.db and is limited to be negative. These integrators share a common state. The integral term is also reduced toward zero as the nominal torque command decreases by

(31) $T_{\mathrm{cmd}}=\max \left(-1500,\min \left(0,K_{\mathrm{cmd}}\left(T_{\mathrm{cmd}\left(k\right)}-T_{\mathrm{cmd}\left(k-1\right)}\right)\mathrm{FNR}\right)\right)$$\mathrm{FNR}=\{\begin{array}{c}1\mathrm{for}\mathrm{FORWARD}\\ 0\mathrm{for}\mathrm{NEUTRAL}\\ -1\mathrm{for}\mathrm{REVERSE}\end{array}$
The fore-aft deadband integral term (i.e., the integral effort) is

(32) $T_{i\left(k\right)}=\{\begin{array}{c}{T}_{i\left(k-1\right)}+K_{i}T\left(v_{\mathrm{FA}\left(k\right)}-v_{\mathrm{db}}\right)+T_{\mathrm{cmd}},\mathrm{if}{T}_{i\left(k-1\right)}+K_i{\mathrm{Tv}}_{\mathrm{FA}\left(k\right)}+T_{\mathrm{cmd}}>K_i{\mathrm{Tv}}_{\mathrm{db}}\\ T_{i\left(k-1\right)}+K_{i}T\left(v_{\mathrm{FA}\left(k\right)}+v_{\mathrm{db}}\right)-T_{\mathrm{cmd}},\mathrm{if}{T}_{i\left(k-1\right)}+K_i{\mathrm{Tv}}_{\mathrm{FA}\left(k\right)}-T_{\mathrm{cmd}}<-K_i{\mathrm{Tv}}_{\mathrm{db}}\\ 0\mathrm{otherwise}\end{array}$
where Ti(k1) is the integral effort from the previous time step. This is also illustrated in block diagram form in FIG. 4 that shows an example control circuit 350, where the sample T is omitted, but can be considered part of the integral gain. The Tcmd term is also omitted from FIG. 4. When the FNR input is zero and the torque command is zero, the integral efforts are unwound toward zero exponentially to prevent wind up of the integrator, so that
T.sub.i(k)=(1K.sub.unwind)T.sub.i(k1), if FNR=0 AND T.sub.cmd=0, OR if brake pedal>70%

(33) The fore-aft deadband integral term is protected against overflow based on operator inputs (e.g. commanded brake pedal or neutral). Hence, the integrator can be unwound if certain conditions are met. In other embodiments, lateral deadband integral terms could be used and can be determined similarly.

(34) In step 325, the traction control efforts for the front lateral, rear lateral, and fore-aft are determined. The front lateral effort is named the front differential correction torque T.sub.F, the rear lateral effort is named the rear differential correction torque T.sub.R, and the fore-aft lateral effort is named the fore-aft differential torque T.sub.FA. These correction torques are determined as follows:
T.sub.F=T.sub.pF
T.sub.R=T.sub.pR
T.sub.FA=T.sub.pFA+Ti
In alternate embodiments, the lateral correction torques can include an integral term. A user may also be also be able to select whether the correction torques include an integral term or change the gain (e.g., a button or switch depressed to disable/enable the integrator or dial to change the gain).

(35) In step 330, the nominal torque command for the wheels are determined (T.sub.cmdW.sub.F and T.sub.cmdW.sub.R) as discussed above with respect to step 200 of FIG. 2A. In step 335, the individual torque commands for each wheel is determined as follows:
T.sub.FL=T.sub.cmdW.sub.F+T.sub.F+T.sub.FA
T.sub.FR=T.sub.cmdW.sub.FT.sub.F+T.sub.FA
T.sub.RL=T.sub.cmdW.sub.R+T.sub.RT.sub.FA
T.sub.RR=T.sub.cmdW.sub.RT.sub.RT.sub.FA
The nominal torque commands for the front and rear are represented by different variables to allow for different torque commands to the front and rear, but they can be the same. Furthermore, the nominal torque commands for each wheel may have a separate variable.

(36) In step 340, the individual torque commands for each wheel are applied to the motors. In some embodiments, differential traction control can be enabled only if all of the motors are in enabled state, and only if all of the motor speed measurements are valid. Lateral differential speed control can be enabled only if the articulation angle sensor is calibrated and the data is valid. In alternate embodiments, the differential control methods and system may be utilized to adjust the set of wheels that is slipping or may be used to just control the rear wheels. Also, the lateral gains could be collectively set to zero to disable them or not used/determined. In another embodiment, the fore-aft differential could be disabled or not used/determined. The lateral and fore-aft terms could also have different gains, or the gains could be selectively set (e.g., an operator depresses a button to disable the integrator). Alternately, an integrator could be enabled for the lateral, which would exhibit similar behavior to locking a lateral differential. In some embodiments, the control system could reduce the wheels that are slipping instead of increasing the other wheels.

(37) As described in the present disclosure, the motors are electric motors, but could be hydraulic or other suitable motors that can be controlled in accordance with the embodiments. The present disclosure has been described with respect to wheels, but the disclosed embodiments could be used with other ground engaging elements.

(38) The traction system and method disclosed in the present disclosure may be used with other work vehicles, such as tractor 400 shown in FIG. 8 and self-propelled sprayer 402 shown in FIG. 9. Furthermore, the embodiments disclosed in the present disclosure can be used for work vehicles with bogies or multiple axles. On a work vehicle with bogies, the two wheels on a bogie on the same side of the vehicle can be compared, and then the average of those two wheels can be compared with the average of the two opposite wheels of the bogie on the opposite side of the vehicle. On a work vehicle with multiple axles, the axles can be grouped according to the arrangement of the axles on the machine. For example, on an articulated dump truck, the two rear axles can be compared and then the average of the two rear axles can be compared with the front axle. On a forestry forwarder, the two rear axles can be compared, the two front axles can be compared, and the two rear axles can be compared with the two front axles. Or all axles could be compared to the overall average speed (e.g., a virtual speed).

(39) While the disclosure has been illustrated and described in detail in the drawings and foregoing description, such illustration and description is not restrictive in character, it being understood that illustrative embodiment(s) have been shown and described and that all changes and modifications that come within the spirit of the disclosure are desired to be protected. Alternative embodiments of the present disclosure may not include all of the features described yet still benefit from at least some of the advantages of such features. Those of ordinary skill in the art may devise their own implementations that incorporate one or more of the features of the present disclosure and fall within the spirit and scope of the appended claims.

(40) A description of the variables, expressions, and terms used in the present disclosure follows for the purposes of reference thereto:

(41) TABLE-US-00001 Variable Units Type Description T.sub.cmd Nm Input Total nominal torque command FNR Input Direction command v kph Input Ground speed estimate N.sub.FL rpm Input Front left motor speed N.sub.FR rpm Input Front right motor speed N.sub.RL rpm Input Rear left motor speed N.sub.RR rpm Input Rear right motor speed v.sub.FL kph Input Front left motor centerline speed v.sub.FR kph Input Front right motor centerline speed v.sub.RL kph Input Rear left motor centerline speed v.sub.RR kph Input Rear right motor centerline speed v.sub.F kph Front differential centerline speed v.sub.R kph Rear differential centerline speed v.sub.FA kph Fore-aft differential centerline speed v.sub.db kph Table Integrator deadband speed, vs. ground speed K.sub.p Nm/kph Parameter Lateral proportional gain K.sub.pFA Nm/kph Parameter For-aft proportional gain K.sub.i Nm/kph .Math. s Parameter For-aft integral gain K.sub.unwind T.sup.1 Parameter Integrator unwinding factor W.sub.F Parameter Nominal torque allocation factor, front W.sub.R Parameter Nominal torque allocation factor, rear T.sub.F Nm Front differential correction torque T.sub.R Nm Rear differential correction torque T.sub.FA Nm For-aft differential correction torque T.sub.FL Nm Output Front left motor command T.sub.FR Nm Output Front right motor command T.sub.RL Nm Output Rear left motor command T.sub.RR Nm Output Rear right motor command