Method and apparatus for controlling an implement of a work machine using linkage angles

Abstract

An apparatus for controllably moving a work implement is disclosed. The implement is connected to a work machine and is moveable in response to operation of a hydraulic cylinder. The apparatus includes an operator controlled joystick. A joystick position sensor senses the position of the joystick and responsively generates an operator command signal. Boom and bucket angle sensors sense the position of the work implement and responsively produces an boom angle signal and a bucket angle signal respectively. A microprocessor based controller receives the boom angle, bucket angle, and operator command signals, modifies the operator command signal, and produces an electrical valve signal in response to the modified operator command signal. An electrohydraulic valve receives the electrical valve signal, and controllably provides hydraulic fluid flow to the hydraulic cylinder in response to a magnitude of the electrical valve signal.

Description

TECHNICAL FIELD

This invention relates generally to a method and apparatus for controlling the movement of a work implement of a work machine and, more particularly, to an apparatus and method that controls the movement of the work implement based on the angular position of the boom and the bucket and the operator command.

BACKGROUND ART

Work machines such as wheel type loaders include work implements capable of being moved through a number of positions during a work cycle. Such implements typically include buckets, forks, and other material handling apparatus. The typical work cycle associated with a bucket includes sequentially positioning the bucket and associated lift arm in a digging position for filling the bucket with material, a carrying position, a raised position, and a dumping position for removing material from the bucket.

Control levers are mounted at the operator's station and are connected to an electrohydraulic circuit for moving the bucket and/or lift arms. The operator must manually move the control levers to open and close hydraulic valves that direct pressurized fluid to hydraulic cylinders which in turn cause the implement to move. For example, when the lift arms are to be raised, the operator moves the control lever associated with the lift arm hydraulic circuit to a position at which a hydraulic valve causes pressurized fluid to flow to the head end of a lift cylinder, thus causing the lift arms to rise. When the control lever returns to a neutral position, the hydraulic valve closes and pressurized fluid no longer flows to the lift cylinder.

In normal operation, the work implement is often abruptly started or brought to an abrupt stop after performing a desired work cycle function, which results in rapid changes in velocity and acceleration of the bucket and/or lift arm, machine, and operator. This can occur, for example, when the implement is moved to the end of its desired range of motion. The geometric relationship between the linear movement of the tilt or lift cylinders and the corresponding angular movement of the bucket or lift arm can produce operator discomfort as a result of the rapid changes in velocity and acceleration. The forces absorbed by the linkage assembly and the associated hydraulic circuitry may result in increased maintenance and accelerated failure of the associated parts. Another potential result of the geometric relationship is excessive angular rotation of the lift arm or bucket near some linear cylinder positions which may result in poor performance.

Stresses are also produced when the vehicle is lowering a load and operator quickly closes the associated hydraulic valve. The inertia of the load and implement exerts forces on the lift arm assembly and hydraulic system when the associated hydraulic valve is quickly closed and the motion of the lift arms is abruptly stopped. Such stops cause increased wear on the vehicles and reduce operator comfort. In some situations, the rear of the machine can even be raised off of the ground.

The present invention is directed to overcoming one or more of the problems as set forth above.

DISCLOSURE OF THE INVENTION

In one aspect of the present invention, an apparatus for controllably moving a work implement is disclosed. The implement is connected to a work machine and is moveable in response to operation of a hydraulic cylinder. The apparatus includes an operator controlled joystick. A joystick position sensor senses the position of the joystick and responsively generates an operator command signal. A boom angle sensing means senses the angular position of the boom and generates a boom angle signal. A bucket angle sensing means senses the angular position of the bucket and generates a bucket angle signal. A microprocessor based controller receives the boom angle, bucket angle, and operator command signals, modifies the operator command signal, and produces an electrical valve signal in response to the modified operator command signal. An electrohydraulic valve receives the electrical valve signal, and controllably provides hydraulic fluid flow to the hydraulic cylinder in response to a magnitude of the electrical valve signal.

BRIEF DESCRIPTION OF THE DRAWINGS

For a better understanding of the present invention, reference may be made to the accompanying drawings in which:

FIG. 1 is a side view of a forward portion of a loader machine or wheel type loader;

FIG.2 is a block diagram of an electrohydraulic control system of the loader machine;

FIG. 3 shows a graph illustrating an operator command signal and an electrical valve signal over time.

FIG. 4 represents a software look-up table associated with a dumping function;

FIG. 5 represents a software look-up table associated with a racking function;

FIG. 6 represents a software look-up table associated with a lifting function;

FIG. 7 represents a software look-up table associated with a lowering function; and

FIG. 8 represents a software look-up table associated with a full rack angle control.

BEST MODE FOR CARRYING OUT THE INVENTION

In FIG. 1, an implement control system is generally represented by the element number 100. FIG. 1 shows a forward portion of a wheel type loader machine 104 having a payload carrier in the form of a bucket 108. Although the present invention is described in relation to a wheel type loader machine, the present invention is equally applicable to many earth working machines such as track type loaders, hydraulic excavators, and other machines having similar loading implements. The bucket 108 is connected to a lift arm assembly or boom 110, which is pivotally actuated by two hydraulic lift actuators or cylinders 106 (only one of which is shown) about a boom pivot pin 112 that is attached to the machine frame. A boom load bearing pivot pin 118 is attached to the boom 110 and the lift cylinders 106. The bucket 108 is tilted by a bucket tilt actuator or cylinder 114 about a tilt pivot pin 116.

With reference to FIG. 2, the implement control system 100 as applied to a wheel type loader is diagrammatically illustrated. The implement control system is adapted to sense a plurality of inputs and responsively produce output signals which are delivered to various actuators in the control system. Preferably, the implement control system includes a microprocessor based controlling means 208.

First, second, and third joysticks 206A,206B,206C provide operator control over the work implement 102. The joysticks include a control lever 219 that has movement along a single axis. However, in addition to movement along a first axis (horizontal), the control lever 219 may also move along a second axis which is perpendicular to the horizontal axis. The first joystick 206A controls the lifting operation of the boom 110. The second joystick 206B controls the tilting operation of the bucket 108. The third joystick 206C controls an auxiliary function, such as operation of a special work tool.

A joystick position sensing means 220 senses the position of the joystick control lever 219 and responsively generates an electrical operator command signal. The electrical signal is delivered to an input of the controlling means 208. The joystick position sensing means 220 preferably includes a rotary potentiometer which produces a pulse width modulated signal in response to the pivotal position of the control lever; however, any sensor that is capable of producing an electrical signal in response to the pivotal position of the control lever would be operable with the instant invention.

A boom angle sensing means 216 senses the angular position of the boom 110 and responsively produces a boom angle signal. A bucket angle sensing means 218 senses the angular position of the bucket 108 and responsively produces a bucket angle signal. In one embodiment, the boom 110 and bucket 108 position sensing means 216,218 include rotary potentiometers. The rotary potentiometers produce pulse width modulated signals in response to the angular position of the boom 110 with respect to the vehicle and the bucket 108 with respect to the boom 110.

A valve means 202 is responsive to electrical signals produced by the controlling means and provides hydraulic fluid flow to the hydraulic cylinders 106A,B,114.

In the preferred embodiment, the valve means 202 includes four main valves (two main valves for the lift cylinders and two main valves for the tilt cylinder) and eight ONE STAGE PILOT valves (two ONE STAGE PILOT valves for each main valve). The main valves direct pressured fluid to the cylinders 106A,B,114 and the ONE STAGE PILOT valves direct pilot fluid flow to the main valves. Each ONE STAGE PILOT valve is electrically connected to the controlling means 208. An exemplary ONE STAGE PILOT valve is disclosed in U.S. Pat. No. 5,366,202 issued on Nov. 22, 1994 to Stephen V. Lunzman, which is hereby incorporated by reference. Two main pumps 212,214 are used to supply hydraulic fluid to the main spools, while a pilot pump 222 is used to supply hydraulic fluid to the ONE STAGE PILOT valves. An on/off solenoid valve and pressure relief valve 224 are included to control pilot fluid flow to the ONE STAGE PILOT valves.

As stated above, a pair of main valves are included for each of the tilt cylinder and lift cylinder pair. It is therefore desirable to move each main valve spool of the pair sequentially, rather than simultaneously, in order to provide desirable velocity and pressure modulation characteristics.

The present invention is directed toward determining an electrical valve signal magnitude to accurately control the work implement movement. The controlling means 208 preferably includes RAM and ROM modules that store software programs to carry out certain features of the present invention. Further, the RAM and ROM modules store a plurality of look-up tables encoded in software. The look-up tables are used to determine the electrical valve signal magnitude. The controlling means 208 receives the boom angle, bucket angle, and operator command signals, modifies the operator command signal, and produces an electrical valve signal having a magnitude that is responsive to the modified operator command signal. The valve means 202 receives the electrical valve signal, and controllably provides hydraulic fluid flow to the respective hydraulic cylinder in response to a magnitude of the electrical valve signal.

The magnitude of the electrical valve signal is determined by multiplying a scaling factor by the magnitude of the operator command signal. For example, the scaling factor may have a value ranging from 0 to 100%. This aspect of scaling results in a reduction in the maximum rate (of the work implement movement) that the operator may command, and a reduction in the overall maximum velocity (of the work implement movement) that the operator may command. This is shown by the graph illustrated in FIG. 3. The operator command signal is shown in the dashed line, and the electrical valve signal is shown in the solid line.

The RAM and ROM modules store a plurality of look-up tables, each having a plurality of values that correspond to a plurality of boom and bucket angular positions. Each look-up table corresponds to a work function that is used to control the work implement. The work functions include a lift and lower function which extends and retracts the lift hydraulic cylinders 106A,B to control the bucket height, and a dump and rack function which extends and retracts the tilt cylinder 114 to control the bucket attitude. The work function look-up tables are shown with respect to FIGS. 4-7. The number of values stored in memory is dependent upon the desired precision of the system. Interpolation may be used to determine the actual value in the event that the measured and calculated values fall between the discrete values stored in memory. The table values are based from simulation and analysis of empirical data.

Accordingly, the controlling means 208 determines the instant work function and selects the appropriate look-up table. Then based on the corresponding boom and bucket angular positions, the controlling means 208 selects a value from the look-up table and modifies the operator command signal based on the selected value to control the work implement 102 at a desired rate and velocity.

Referring to FIG. 4, the dumping look-up table 400, which controls the pivoting of the bucket 108 to a desired maximum dumping angle, is shown. The dumping look-up table 400 stores a plurality of scaling values that correspond to the angular position of the boom 110 and bucket 108. The scaling values are chosen to limit the velocity or pivotal movement of the bucket 108, as the bucket approaches the desired maximum dumping angle. This is referred to as kinematic inversion. Thus, the scaling values provide for a velocity limiting effect when the angular position of the boom 110 or bucket 108 approach an extreme kinematic gain region near the desired maximum dump angle; thereby, reducing the "jerk" felt by the operator and reducing the forces within the cylinders. Although a scaling value is described, a limiting value can equally be used as would be apparent to one skilled in the art.

Note, a kinematic gain region is defined as the ratio of the rotational displacement of the boom 110 or bucket 108 over the corresponding linear displacement of the associated lift or tilt cylinders 106,114. An extreme kinematic gain region is associated with those gain values that produce undesirable velocities or accelerations.

Further, the dumping look-up table provides for an electronic stop, i.e., the scaling values are chosen to stop the pivotal movement of the bucket 108 prior to the bucket 108 reaching the physical maximum dump angle. Consequently, the bucket movement can stop prior to engaging the mechanical stops (which are associated with infinite kinematic gains) in order to provide for structural protection of the work implement.

Referring now to FIG. 5, the racking look-up table 500, which controls the pivoting of the bucket 108 to a maximum racking angle, is shown. The racking look-up table 500 stores a plurality of scaling values that correspond to the angular position of the boom 110 and the bucket 108. The scaling values are chosen to gradually increase the pivotal movement or velocity limit of the bucket 108 as the bucket 108 is moved from the maximum dump angle to the desired maximum rack angle. Thus, as the bucket moves from the desired maximum dump angle, the scaling values gradually increase to cause the bucket movement to proportionally increase in order to provide for greater controllability of the racking function.

Further, the scaling values are chosen to reduce the hydraulic forces associated with the work implement being in a "fold-up" position, i.e., where the bucket is positioned at a desired maximum rack angle and when the boom 110 is positioned at or near ground level. Thus, when the work implement is at the "fold-up" position, the scaling values are greatly reduced in order to reduce the electrical valve signal magnitude so that operator is prevented from further commanding a full rack command; thereby, preventing high linkage torques.

Referring to FIG. 6, the lifting look-up table 600, which controls the lifting of the boom 110 to a desired maximum height, is shown. The lifting look-up table 600 stores a plurality of scaling values that correspond to the angular position of the boom 110. The scaling values are chosen to limit the velocity or pivotal movement of the boom 110, as the boom 110 approaches an extreme kinematic gain region near the desired maximum height. This is additionally referred to as kinematic inversion. Thus, the scaling values provide for a velocity limiting effect when the angular position of the boom 110 approaches the desired maximum value; thereby; reducing the "jerk" felt by the operator and reducing the linkage torques.

The present invention additionally provides for a "smooth starting" function during gravity assisted operations, e.g., when the boom 110 is being lowered. Referring now to FIG. 7, the lowering look-up table 700, which controls the lowering of the boom 110, is shown. The lowering look-up table 700 stores a plurality of scaling values that correspond to the position of the lift cylinders 106A,B. The scaling values are chosen to gradually increase the velocity limit of the boom 110 as the boom 110 is lowered from its desired maximum height. Thus, as the boom 110 is lowered from its maximum height, the scaling values gradually increase, which causes the electrical valve signal magnitude to proportionally increase. This provides for greater controllability of the lowering function by preventing "jerky" operation. Although a scaling value is described, a limiting value can equally be used as would be apparent to one skilled in the art.

The present invention additionally provides for a full rack angle control. The purpose of the rack angle control is to slightly roll forward a racked bucket 108 as the boom 110 is raised. This automated motion is used to counteract the natural kinematic action of the boom 110, which increases the backward tilt of the bucket 108 as the boom 110 is lifted. The full rack angle control is embodied in a look-up table, similar to that shown in FIG. 8. The illustrated look-up table 800 stores a plurality of limiting values that correspond to the angular positions of the boom 110 and the bucket 108. The controlling means 208 selects a limiting value in response to the boom 110 and bucket 108 angular positions, and compares the limiting value to the operator command signal value. The controlling means 208 then produces the electrical valve signal with a value equal to the lower of the two compared values. As shown, the look-up table 800 is structured such that positive limiting values are associated with rack commands, and negative limiting values are associated with dump commands, while neutral commands are associated with null limiting values. Thus, the negative limiting values provide for the automated roll forward motion of the control. Note, it may be desirable for the controlling means to only modify the operator command signal while boom 108 is being raised.

Thus, while the present invention has been particularly shown and described with reference to the preferred embodiment above, it will be understood by those skilled in the art that various additional embodiments may be contemplated without departing from the spirit and scope of the present invention.

INDUSTRIAL APPLICABILITY

Earth working machines such as wheel type loaders include work implements capable of being moved through a number of positions during a work cycle. The typical work cycle associated with a bucket includes positioning the boom 110 and bucket 108 in a digging position for filling the bucket with material, a carrying position, a raised position, and a dumping position for removing material from the bucket.

The present invention provides a method and apparatus for progressively limiting the velocity of the implement during a work cycle rather than abruptly stopping or changing the velocity of the implement. Such a function is particularly worthwhile to limit the implement velocity as it approaches extreme kinematic gain regions.

It should be understood that while the function of the preferred embodiment is described in connection with the boom 110 and associated hydraulic circuits, the present invention is readily adaptable to control the position of implements for other types of earth working machines. For example, the present invention could be employed to control implements on hydraulic excavators, backhoes, and similar machines having hydraulically operated implements.

Other aspects, objects and advantages of the present invention can be obtained from a study of the drawings, the disclosure and the appended claims.

Claims

1. An apparatus for controllably moving a work implement of an earth moving machine, the work implement including a boom and a bucket being attached thereto, the work implement including a plurality of work functions that includes a lifting and lowering function where the boom is actuated by a hydraulic lift cylinder and dumping and racking function where the bucket is pivoted by a hydraulic tilt cylinder, comprising:

an operator controlled joystick;

joystick position sensing means for sensing the position of the joystick and responsively generating an operator command signal;

boom angle sensing means for sensing the angular position of the boom and responsively producing a boom angle signal;

bucket angle sensing means for sensing the angular position of the bucket and responsively producing a bucket angle signal;

memory means for storing a look-up table for each work function, the look-up tables including a plurality of values corresponding to a plurality of boom and bucket angular positions;

controlling means for receiving the boom angle, bucket angle, and operator command signals, determining the instant angular position of the boom and bucket and the corresponding work function, modifying the operator command signal based on the instant work function, and producing an electrical valve signal in response to the modified operator command signal; and

valve means for receiving the electrical valve signal, and controllably providing hydraulic fluid flow to the respective hydraulic cylinders in response to a magnitude of the electrical valve signal.

2. An apparatus, as set forth in claim 1, wherein the controlling means includes means for selecting a value from the respective look-up table in response to the respective angular position of the boom and the bucket, multiplying the value by the magnitude of the operator command signal, and responsively producing the electrical valve signal having a magnitude equal to the product.

3. An apparatus, as set forth in claim 2, wherein the memory means includes a dumping and racking look-up table to control the pivoting of the bucket, each table storing a plurality of scaling values corresponding to the angular position of the boom and the bucket.

4. An apparatus, as set forth in claim 3, wherein the dumping look-up table includes a plurality of scaling values that limit the pivotal movement of the bucket as the bucket approaches a desired maximum dump angle, and a plurality of scaling values that cause the pivotal movement of the bucket to stop when reaching the desired maximum dump angle.

5. An apparatus, as set forth in claim 4, wherein the racking look-up table includes a plurality of scaling values that gradually increase as the bucket is racked from the desired maximum dump angle, and a plurality of scaling values that prevent the operator from further commanding a fully racked bucket beyond the desired maximum rack angle.

6. An apparatus, as set forth in claim 5, wherein the memory means includes a lifting and lowering look-up table for controlling the actuation of the lifting assembly, each look-up table storing a plurality of scaling values corresponding to the angular position of the boom.

7. An apparatus, as set forth in claim 6, wherein the lifting look-up table includes a plurality of scaling values that limit the movement of the boom as the boom approaches a desired maximum angular displacement.

8. An apparatus, as set forth in claim 7, wherein the lowering look-up table includes a plurality of scaling values that gradually increase as the boom is lowered from a maximum angular displacement.

9. An apparatus, as set forth in claim 8, wherein the memory means includes a rack angle control table for storing a plurality of limiting values corresponding to the angular position of the boom and the bucket.

10. An apparatus, as set forth in claim 9, wherein the control means includes automatic dumping means for selecting the limiting value, comparing the limiting value to the operator command signal value, and producing the electrical valve signal with a value equal to the lower of the two compared values.

11. A method for controllably moving a work implement of an earth moving machine in response to the position of an operator controlled joystick, the work implement including a boom and a bucket being attached thereto, the work implement including a plurality of work functions that includes a lifting and lowering function where the boom is actuated by a hydraulic lift cylinder and dumping and racking function where the bucket is pivoted by a hydraulic tilt cylinder, comprising the steps of:

sensing the position of the joystick and responsively generating an operator command signal;

sensing the angular position of the boom and responsively generating a boom angle signal;

sensing the angular position of the bucket and responsively generating a bucket angle signal;

storing a look-up table for each work function, the look-up tables including a plurality of values corresponding to a plurality of boom and bucket angular positions;

receiving the boom angle, bucket angle, and operator command signals, determining the instant angular position of the boom and bucket and the corresponding work function, modifying the operator command signal based on the instant work function, and producing an electrical valve signal in response to the modified operator command signal; and

receiving the electrical valve signal, and controllably providing hydraulic fluid flow to the respective hydraulic cylinders in response to a magnitude of the electrical valve signal.