This disclosure relates generally to a system for estimating a displacement of a pump and, more particularly, to a system for determining an estimation of a displacement of a variable displacement hydraulic pump.
Many different types of machines utilize hydraulic systems to operate work implements and hydrostatic drives. Examples of these machines include excavators, backhoes, loaders, haul trucks, and various other machines. The machines typically include a plurality of sensors and use closed-loop feedback systems to monitor the operation of the various systems within the machine.
Due to the complexity and size of the machines and to prevent undesired or uncontrolled operation, the systems are often configured to shut down or substantially reduce the performance of the machine upon the failure of a pressure or displacement sensor. In such case, productivity is lost while waiting for replacement of the inoperative sensor. In addition, additional sensors add to the cost and complexity of a machine.
U.S. Pat. No. 8,548,661 discloses a hybrid hydraulic excavator having an engine with both a variable displacement hydraulic pump and a motor generator connected to the engine. A controller is operative to determine a calculation value of the hydraulic pump based upon a pump current supplied to the pump and a discharge pressure of the pump using an algorithm, and corrects a hydraulic pump characteristic parameter used in the algorithm based upon an assumed pressure error. The controller further calculates an assumed hydraulic pressure correction output using the corrected hydraulic pump characteristic parameter, and controls the operation of the motor generator based upon the assumed hydraulic pressure correction output.
The foregoing background discussion is intended solely to aid the reader. It is not intended to limit the innovations described herein, nor to limit or expand the prior art discussed. Thus, the foregoing discussion should not be taken to indicate that any particular element of a prior system is unsuitable for use with the innovations described herein, nor is it intended to indicate that any element is essential in implementing the innovations described herein. The implementations and application of the innovations described herein are defined by the appended claims.
In one aspect, a system for determining an estimated displacement of a variable displacement hydraulic pump includes a variable displacement hydraulic pump having a swash plate pivotably mounted to define an angle of inclination of the swash plate. A control cylinder is associated with the swash plate to control the angle of inclination of the swash plate, a valve controls flow of hydraulic fluid to the control cylinder with the valve having a position defining an effective area of an opening of the valve. A prime mover is operatively connected to drive the variable displacement hydraulic pump and a pressure sensor generates pressure signals indicative of an output pressure from the variable displacement hydraulic pump. A controller is configured to receive pressure signals from the pressure sensor and determine an estimated displacement of the variable displacement hydraulic pump based upon the pressure signals from the pressure sensor and the position of the valve.
In another aspect, a controller-implemented method of determining an estimated displacement of a variable displacement hydraulic pump includes providing a variable displacement hydraulic pump including a swash plate pivotably mounted to define an angle of inclination of the swash plate, providing a control cylinder associated with the swash plate to control the angle of inclination of the swash plate, and providing a valve for controlling flow of hydraulic fluid to the control cylinder, the valve having a position defining an effective area of an opening of the valve. The method further includes receiving pressure signals from a pressure sensor indicative of an output pressure from the variable displacement hydraulic pump, determining a position of the valve, and determining an estimated displacement of the variable displacement hydraulic pump based upon the pressure signals from the pressure sensor and the position of the valve.
In still another aspect, a machine includes a variable displacement hydraulic pump having a swash plate pivotably mounted to define an angle of inclination of the swash plate, a prime mover operatively connected to drive the variable displacement hydraulic pump, and a control cylinder associated with the swash plate to control the angle of inclination of the swash plate. A valve controls flow of hydraulic fluid to the control cylinder and has a position defining an effective area of an opening of the valve and a pressure sensor generates pressure signals indicative of an output pressure from the variable displacement hydraulic pump. A controller is configured to receive pressure signals from the pressure sensor and determine an estimated displacement of the variable displacement hydraulic pump based upon the pressure signals from the pressure sensor and the position of the valve.
Platform 11 may be rotatably disposed on undercarriage 12 and includes an operator station 16 from which an operator may control the operation of machine 10. Rotation of platform 11 relative to undercarriage 12 may be effected by a swing motor 17 (
Undercarriage 12 may be a structural support for one or more ground-engaging traction devices. The ground engaging fraction devices may include one or more tracks 18 configured to allow translational motion of machine 10 across a work surface. Alternatively, the ground engaging fraction devices may include wheels, belts, or other traction devices known in the art.
A prime mover 13 may provide power for the operation of machine 10. Prime mover 13 may embody a combustion engine, such as a diesel engine, a gasoline engine, a gaseous fuel powered engine (e.g., a natural gas engine), or any other type of combustion engine known in the art. Prime mover 13 may alternatively embody a non-combustion source of power, such as a fuel cell or a power storage device such as a battery coupled to a motor. Further, if desired, both a combustion engine and a non-combustion source of power may be provided as a hybrid source of power that operates to increase the efficiency of the machine operation. Prime mover 13 may provide a rotational output to tracks 18, thereby propelling machine 10. Prime mover 13 may also provide power to other systems and components of machine 10.
Implement system 14 may include one or more linkage members configured to move a load. In one example, the implement system may include a boom member 19, a stick member 20, and a work implement or tool 15 such as a bucket. A first end (not shown) of boom member 19 may be pivotally connected to platform 11 to permit the boom member to pivot or rotate relative to the platform. A second end 22 of boom member 19 may be pivotally connected to a first end 23 of stick member 20 to permit the stick member to pivot or relative to the boom member. A first end 26 of the work implement or tool 15 may be pivotally connected to a second end 25 of stick member 20 to permit the tool to pivot or rotate relative to the stick member. The linkage members may translate or rotate in a plane that is generally orthogonal to the platform 11.
The linkage members may be operatively connected to an actuator system 30 that includes one or more actuators such as hydraulic cylinders. Boom member 19 may be propelled or moved along a path by a pair of boom hydraulic cylinders 31 (only one being shown in
Rotation of the tool 15 relative to the stick member 20 may be effected by actuation of the tool hydraulic cylinder 33.
Each of the boom hydraulic cylinders 31, the stick hydraulic cylinder 32, and the tool hydraulic cylinder 33 may embody a linear actuator as depicted in
Swing motor 17 may also be driven by differential fluid pressure. Specifically, swing motor 17 may be a rotary actuator including first and second chambers (not shown) located on opposite sides of an impeller (not shown). Upon filling the first chamber with pressurized fluid and draining the second chamber of fluid, the impeller is urged to rotate in a first direction. Conversely, when the first chamber is drained of fluid and the second chamber is filled with pressurized fluid, the impeller is urged to rotate in an opposite direction. The flow rate of fluid into and out of the first and second chambers affects the rotational speed of swing motor 17, while a pressure differential across the impeller affects the output torque thereof.
Machine 10 may be equipped with a plurality of sensors that provide data, directly or indirectly, of the performance or conditions of various aspects of the machine. The term “sensor” is meant to be used in its broadest sense to include one or more sensors and related components that may be associated with the machine 10 and that may cooperate to sense various functions, operations, and operating characteristics of the machine. For example, fuel usage sensor 76 (
Referring to
The controller 36 may be an electronic controller that operates in a logical fashion to perform operations, execute control algorithms, store and retrieve data and other desired operations. The controller 36 may include or access memory, secondary storage devices, processors, and any other components for running an application. The memory and secondary storage devices may be in the form of read-only memory (ROM) or random access memory (RAM) or integrated circuitry that is accessible by the controller. Various other circuits may be associated with the controller such as power supply circuitry, signal conditioning circuitry, driver circuitry, and other types of circuitry.
The controller 36 may be a single controller or may include more than one controller disposed to control various functions and/or features of the machine 10. The term “controller” is meant to be used in its broadest sense to include one or more controllers and/or microprocessors that may be associated with the machine 10 and that may cooperate in controlling various functions and operations of the machine. The functionality of the controller 36 may be implemented in hardware and/or software without regard to the functionality. The controller 36 may rely on one or more data maps relating to the operating conditions of the machine 10 that may be stored in the memory of controller. Each of these maps may include a collection of data in the form of tables, graphs, and/or equations. The controller 36 may use the data maps to maximize the performance and efficiency of the machine 10.
The boom hydraulic cylinders 31, the stick hydraulic cylinder 32, the tool hydraulic cylinder 33, and the swing motor 17 may function together with other cooperating fluid components to move tool 15 in response to input received from the operator input device 37. In particular, control system 35 may include one or more fluid circuits (not shown) configured to produce and distribute streams of pressurized fluid. One or more boom control valves 40, one or more stick control valves 41, one or more tool control valves 42, and one or more swing control valves 43 may be configured or positioned to receive the streams of pressurized fluid and selectively meter the fluid to and from the boom hydraulic cylinders 31, the stick hydraulic cylinder 32, the tool hydraulic cylinder 33, and the swing motor 17, respectively, to regulate the motions thereof.
Controller 36 may be configured to receive input from the operator input device 37 and to command operation of the boom control valves 40, the stick control valves 41, the tool control valves 42, and the swing control valves 43 in response to the input and based on the data maps described above. More specifically, controller 36 may receive an input device position signal indicative of a desired speed and/or type of movement in a particular direction and refer to the data maps stored in the memory of controller 36 to determine flow rate values and/or associated positions for each of the supply and drain elements within the boom control valves 40, the stick control valves 41, the tool control valves 42, and the swing control valves 43. The flow rates or positions may then be commanded of the appropriate supply and drain elements to cause filling and/or draining of the chambers of the actuators at rates that result in the desired movement of tool 15.
Each of the variable displacement hydraulic pumps may be configured to discharge high pressure hydraulic fluid with the first variable displacement hydraulic pump 46 being connected to a first output line 50 and the second variable displacement hydraulic pump 47 being connected to a second output line 51. High pressure hydraulic fluid from the first output line 50 and the second output line 51 may be used for any desired purpose such as operating the hydraulic cylinders of the actuator system 30 and the swing motor 17 to move the work implement as well as operating a hydraulic propulsion system to move the machine 10 about the dig site 100.
A first pressure sensor 55 may be operatively associated with the first variable displacement hydraulic pump 46 to monitor the output pressure of the hydraulic fluid exiting from the first hydraulic pump. A first displacement sensor 56 may be operatively associated with the first variable displacement hydraulic pump 46 to monitor the displacement of the first hydraulic pump. A second pressure sensor 57 may be operatively associated with the second variable displacement hydraulic pump 47 to monitor the output pressure of the hydraulic fluid exiting from the second hydraulic pump. A second displacement sensor 58 may be operatively associated with the second variable displacement hydraulic pump 47 to monitor the displacement of the second hydraulic pump. Each of the first pressure sensor 55, the first displacement sensor 56, the second pressure sensor 57, and the second displacement sensor 58 may also include a status sensor 59 associated therewith that functions to determine whether the pressure and displacement sensors are operating properly.
The status sensors 59 may operate by monitoring the operating status of each of the pressure sensors and the displacement sensors. The status sensors 59 may take any form and thus may be implemented in hardware and/or software. For example, each of the pressure and displacement sensors may include discrete status sensors or the status sensors may be integrally formed as part of the pressure and displacement sensors as depicted in
If the status sensors 59 are discrete elements, they may generate status signals that are transmitted to and received by controller 36. For example, a first pressure status sensor associated with the first pressure sensor 55 may be configured to generate first pressure sensor status signals indicative of the status of the first pressure sensor. A first displacement status sensor associated with the first displacement sensor 56 may be configured to generate first displacement sensor status signals indicative of the status of the first displacement sensor. A second pressure status sensor associated with the second pressure sensor 57 may be configured to generate second pressure sensor status signals indicative of the status of the second pressure sensor. A second displacement status sensor associated with the second displacement sensor 58 may be configured to generate second displacement sensor status signals indicative of the status of the second displacement sensor.
If the status sensors 59 are not discrete elements, the controller 36 may not receive specific signals but may generate within the controller 36 signals indicative of the status of the sensors. The systems described herein are equally applicable regardless of the manner in which the status signals are generated and/or received by the controller 36.
Fan pump 48 may be a variable displacement pump configured to discharge pressurized hydraulic fluid to a fixed displacement fan pump that is operatively connected to a fan 52. A fan pump pressure sensor 130 may be operatively associated with the fan pump 48 to monitor the output pressure of the hydraulic fluid exiting from the fan pump.
Charge pump 49 may be a fixed displacement pump configured to discharge relatively low pressure hydraulic fluid to a charge pump line 53. The relatively low pressure hydraulic fluid passing through the charge pump line 53 may be used for any desired purpose such as operating control valves (e.g., boom control valves 40, stick control valves 41, tool control valves 42, and swing control valves 43) used to control the position of the actuator system 30.
Hydraulic power system 39 may include speed sensors to monitor the speed and angular acceleration of certain components. For example, a prime mover speed sensor 131 (or engine speed sensor) may be operatively associated or connected to the prime mover 13 and operative to determine an output speed and an angular acceleration of the prime mover. A fan speed sensor 132 may be operatively associated or connected to the fan 52 and operative to determine an output or angular speed and an angular acceleration of the fan motor.
Control system 35 and hydraulic power system 39 may be configured as a closed-loop system in which feedback and proper operation of all of the sensors may be required for full operation of all systems associated with machine 10. Absent all of the necessary inputs, the control system 35 may “de-stroke” or reduce the displacement of the pump associated with the failed sensor and the hydraulic power system 39 will operate in a limited or minimum flow condition. In such case, the machine 10 may be substantially inoperative.
In case of a failure of one of the output sensors associated with the first variable displacement hydraulic pump 46 or the second variable displacement hydraulic pump 47 (i.e., first pressure sensor 55, first displacement sensor 56, second pressure sensor 57, or second displacement sensor 58), the control system 35 may include a sensor output estimation system 60 to estimate the output from the variable displacement hydraulic pump associated with the failure. The sensor output estimation system 60 may operate generally by determining an input into the pumps, determining the known outputs from the pumps, and estimating the missing output based upon the input into the pumps and the known outputs.
As depicted in
The combination of the fuel usage sensor 76 and the prime mover speed sensor 131 may act as an equivalent of a torque sensor for generating torque signals indicative of an output torque from the prime mover 13. Other manners of determining the output torque from the prime mover 13 are contemplated. For example, other sensors may be used when using a non-combustion power source.
At node 63, the controller 36 may receive pressure signals or data from the first pressure sensor 55 indicative of the pressure of the hydraulic fluid exiting from the first variable displacement hydraulic pump 46 through first output line 50. At node 64, the controller 36 may receive displacement signals or data from the first displacement sensor 56 indicative of the displacement of the first variable displacement hydraulic pump 46.
At node 65, the controller 36 may receive pressure signals or data from the second pressure sensor 57 indicative of the pressure of the hydraulic fluid exiting from the second variable displacement hydraulic pump 47 through second output line 51. At node 66, the controller 36 may receive displacement signals or data from the second displacement sensor 58 indicative of the displacement of the second variable displacement hydraulic pump 47.
At node 67, controller 36 may receive status signals from the status sensor 59 associated with the first pressure sensor 55 indicative of whether the first pressure sensor is operating properly. At node 68, controller 36 may receive status signals from the status sensor 59 associated with the first displacement sensor 56 indicative of whether the first displacement sensor is operating properly. At node 69, controller 36 may receive status signals from the status sensor 59 associated with the second pressure sensor 57 indicative of whether the second pressure sensor is operating properly. At node 70, controller 36 may receive status signals from the status sensor 59 associated with the second displacement sensor 58 indicative of whether the second displacement sensors operating properly.
Controller 36 may generate an estimate of the output from the sensor that is inoperative. Accordingly, at node 71, in case of a failure of the first pressure sensor 55, the controller 36 may generate signals that are an estimate of the pressure of the hydraulic fluid exiting from the first variable displacement hydraulic pump 46 through first output line 50. At node 72, in case of a failure of the first displacement sensor 56, the controller 36 may generate signals that are an estimate of the displacement of the first variable displacement hydraulic pump 46. At node 73, in case of a failure of the second pressure sensor 57, the controller 36 may generate signals that are an estimate of the pressure of the hydraulic fluid exiting from the second variable displacement hydraulic pump 47 through second output line 51. At node 74, in case of a failure of the second displacement sensor 58, the controller 36 may generate signals that are an estimate of the displacement of the second variable displacement hydraulic pump 47.
Although
Referring to
If the first displacement sensor 56 were inoperative rather than the first pressure sensor 55, the input at node 64 would be omitted and the output at nodes 71 and 73-74 would be omitted. Similarly, an inoperative second pressure sensor 57 would result in an omitted input at node 65 and omitted output at nodes 71-72 and 74 while an inoperative second displacement sensor 58 would result in an omitted input at node 66 and omitted output at nodes 71-73.
A flowchart of the operation of the sensor output estimation system 60 is depicted in
At stage 81, the controller 36 may receive data or signals from the various sensors of the machine 10. At decision stage 82, the controller 36 may determine whether the pump sensors are operating properly. To do so, the controller 36 may analyze the signals from the pressure and displacement sensors or from the status sensor 59 associated with each of first pressure sensor 55, first displacement sensor 56, second pressure sensor 57, and second displacement sensor 58. If all of the pump sensors are operating properly at decision stage 82, the controller 36 may continue to receive sensor data at stage 81.
If any of the pump sensors are not operating properly at decision stage 82, the controller 36 may determine at decision stage 83 whether more than one pump sensor has failed. If more than one pump sensor has failed, the controller 36 may generate an alert command at stage 84. The alert command may be operative to notify the machine operator, management personnel, and/or any other desired person or system of the pump sensor failures.
If only one pump sensor has failed, the controller 36 may determine the prime mover output torque at stage 85. In one example, the controller may determine the prime mover output torque based upon the fuel usage and engine speed of the prime mover. In other instances, other manners of determining the prime mover output torque may be utilized. When using a non-combustion source of power, other sensors may be used to determine the prime mover output torque. The controller 36 may determine at stage 86 an estimate of the input torque or input pump torque based upon the prime mover output torque and estimates of fan pump loss and charge pump loss as set at stage 80. In doing so, the controller 36 may subtract estimates of the fan pump loss and charge pump loss from the prime mover output torque.
At stage 87, the controller 36 may determine the output at each of the operating sensors. More specifically, the controller 36 may determine the output pressures from the first variable displacement hydraulic pump 46 and the second variable displacement hydraulic pump 47 based upon data from the first pressure sensor 55 and the second pressure sensor 57, respectively, to the extent that they are operative. Further, the controller 36 may determine the displacements of the first variable displacement hydraulic pump 46 and the second variable displacement hydraulic pump 47 based upon data from the first displacement sensor 56 and the second displacement sensor 58, respectively, to the extent that they are operative.
The controller 36 may determine at stage 88 the output torque of the pump in which both the pressure sensor and the displacement sensor are operative. For example, if one of the second sensors (i.e., second pressure sensor 57 or second displacement sensor 58) is inoperative, the controller 36 may determine at stage 88 the output torque of the first variable displacement hydraulic pump 46. If one of the first sensors (i.e., first pressure sensor 55 or first displacement sensor 56) is inoperative, the controller 36 may determine at stage 88 the output torque of the second variable displacement hydraulic pump 47. To determine the output torque of one of the pumps, the controller 36 may multiply the pressure of the output as determined by the operative pressure sensor by the displacement as determined by the operative displacement sensor.
At stage 89, the controller 36 may determine an estimate of the output torque of the pump having the non-operating sensor. To do so, the controller 36 may subtract the output torque of the pump having the operating sensors calculated at stage 88 from the estimate of the input pump torque determined at stage 86. The remaining torque is approximately equal to the output torque of the pump having the non-operating or inoperative sensor.
At stage 90, the controller 36 may determine an estimate of the output at the non-operating sensor. To do so, the controller 36 may divide the output torque of the pump having the non-operating sensor (as determined at stage 89) by the output of the operating sensor associated with that same pump. In other words, if the pressure sensor of a pump is inoperative, the controller 36 may divide the output torque of that pump by the displacement as determined by the displacement sensor associated with that pump to determine an estimate of the output pressure from the pump. Similarly, if the displacement sensor of a pump is inoperative, the controller 36 may divide the output torque of that pump by the pressure as determined by the pressure sensor associated with that pump to determine an estimate of the displacement of the pump.
If desired, the estimate of the pressure or displacement as determined at stage 90 may be multiplied at stage 91 by the pump efficiency factor set at stage 80. The estimated output from the inoperative sensor may then be used by the controller 36 as input to the control system 35 and hydraulic power system 39 so that the systems and machine 10 remain operative.
If desired, the pump efficiency factor set at stage 80 may be adjusted during operation of the machine 10 prior to a pump sensor failure. To do so, upon determining that the pump sensors are operating properly at decision stage 82, the controller 36 may calculate estimated outputs from each of the pressure sensors and displacement sensors and compare them to the actual outputs from the sensors. To the extent that the estimated outputs are different, the pump efficiency factor may be adjusted so that the estimated outputs more closely match the actual outputs.
Additional or dynamic factors or losses that impact that hydraulic power system 39 may be analyzed, if desired, when generating a model for estimating the output from an inoperative sensor. For example, referring to
Tin−Tpump 1−Tpump 2−Tgear,ch−Tgear,msh−Trotate−Tcharge−Tfan−Tinertia=0 (1)
where Tin is the input torque into the hydraulic power system 39 from the prime mover 13;
where Tpump 1 is the output torque of the first variable displacement hydraulic pump 46;
where Tpump 2 is the output torque of the second variable displacement hydraulic pump 47;
where Tgear,ch is the gear churning torque loss;
where Tgear,msh is the gear mesh torque loss;
where Trotate is the rotational torque loss due to rotational drag of rotating elements or components within the system;
where Tcharge is the output torque of the charge pump 49;
where Tfan is the fan torque loss due to operation of the fan 52; and
where Tinertia is the inertia torque loss due to changes in inertia of rotating elements or components within the system.
When operating with a system having only a combustion engine as a prime mover 13, the input torque (Tin) may be expressed as:
k4Teng (2)
where Teng is the output torque of the engine and k4 is an unknown coefficient or constant. As described above, the input torque from an engine may be determined based upon fuel usage from the fuel usage sensor 76 and the engine speed from the prime mover speed sensor 131.
The torque (Tpump 1) from the first variable displacement hydraulic pump 46 may be expressed as:
where P1 is the discharge pressure from the first variable displacement hydraulic pump 46, D1 is the displacement of the first variable displacement hydraulic pump, and η1 is the pump efficiency factor of the first variable displacement hydraulic pump. The torque (Tpump 2) from the second variable displacement hydraulic pump 47 may be expressed in an identical manner by applying the discharge pressure, the displacement, and the pump efficiency factor of the second variable displacement hydraulic pump.
The gear churning torque loss (Tgear,ch) is the torque loss due to the resistance caused by the viscosity of fluids within the system as components of the system are moved through the fluids and may be estimated based upon the designs of the pumps, test data, as well as the pump efficiency factors. The gear churning torque loss (Tgear,ch) may be set or stored within controller 36 by an operator, management personnel, a technician, or any other personnel.
The gear mesh torque loss (Tgear,msh) is the torque loss due to the mechanical losses caused by the interengagement of gears of the system as they rotate and may be estimated based upon the designs of the pumps, test data, as well as the pump efficiency factors. The gear mesh torque loss (Tgear,msh) may be set or stored within controller 36 by an operator, management personnel, a technician, or any other personnel.
The rotational torque loss (Trotate) due to rotational drag of rotating elements or components within the system may be expressed as:
k1ωe2ng (4)
where ωeng is the speed of the engine and k1 is an unknown coefficient.
The output torque (Tcharge) of the charge pump 49 may be expressed as:
where Pcharge is the discharge pressure from the charge pump 49, Dcharge is the displacement of the charge pump, and ηcharge is the pump efficiency factor of the charge pump.
The fan torque loss (Tfan) due to operation of the fan 52 may be expressed as:
k2Pfanωfan (6)
where Pfan is the pressure to the fan 52, ωfan is the speed of the fan, and k2 is an unknown coefficient.
The inertia torque loss (Tinertia) due to changes in inertia of rotating elements or components within the system may be expressed as:
k3{dot over (ω)}eng (7)
where {dot over (ω)}eng is the angular acceleration of the engine and k3 is an unknown coefficient.
Equations (1)-(7) may be combined and expressed as:
Solving Equation (8) for the displacement (D1) of the first variable displacement hydraulic pump 46 results in:
while solving Equation (8) for the discharge pressure (P1) from the first variable displacement hydraulic pump results in:
Similarly, solving Equation (8) for the displacement (D2) of the second variable displacement hydraulic pump 47 results in:
while solving Equation (8) for the discharge pressure (P2) from the second variable displacement hydraulic pump results in:
The actual values of the torque balance coefficients (k1, k2, k3, k4) are dependent on a plurality of system uncertainties including fluid properties, friction, manufacturing and assembly tolerances. Accordingly, the coefficients of Equations (8)-(12) may be expressed as estimations by including a “{circumflex over (k)}” so as to appear as ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4). Equation (8) may thus be re-written as:
In addition, Equation (9) may be re-written as:
and Equation (10) may be re-written as:
Equation (11) may be re-written as:
and Equation (12) may be re-written as:
In order to estimate the values of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4), the controller 36 may utilize a learning process while the first pressure sensor 55, first displacement sensor 56, second pressure sensor 57, and second displacement sensor 58 are all operating properly. More specifically, upon determining that the pump sensors are operating properly at decision stage 82 of
Referring to
For each term from Equation (13) that has been selected for use as part of the coefficient estimation process, Equation (13) may be re-written to solve for that term. For example, if the first discharge pressure (P1) from the first variable displacement hydraulic pump 46 and the second discharge pressure (P2) from the second variable displacement hydraulic pump 47 are set as the terms to be measured, Equations (13) may be re-written as set forth in Equations (14) and (16), respectively.
At stage 122, the controller 36 may receive data or signals from the various sensors of the machine 10. At stage 123, the controller 36 may determine the output from each of the sensors. The output from the sensors may include the terms in Equation (13) that have been selected for use in generating the estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4).
At decision stage 124, the controller 36 may determine whether each of the pump sensors is operating properly. If the pump sensors are not operating properly, the controller 36 may stop the coefficient estimation process at stage 125. If the pump sensors are operating properly, the controller 36 may generate at stage 126 initial estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4). Based upon the initial estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4), the controller 36 may solve at stage 127 the re-written forms of Equation (13) (such as Equations (14) and (16)) to generate estimated values for the selected terms.
At stage 128, the controller 36 may compare the actual value of the selected terms to the value of those terms calculated based upon the estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4). If the difference between the actual values and the estimated values is less than a predetermined threshold, the controller 36 may at stage 129 set the final estimated values of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4) as those set at stage 125. If the difference between the actual values and the estimated values is less than a predetermined threshold, the controller 36 may repeat the process beginning at stage 122 including generating new estimated values of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4).
Any desired process may be used to generate estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4). In one example, the controller 36 may utilize an adaptive learning process or rule such as a negative gradient method to determine or generate estimates of the coefficients. In doing so, the process will permit the controller 36 to select subsequent estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4) to reduce the difference between the actual value of the selected terms and the calculated value of those terms. In another example, the controller 36 may utilize an intensive computational method as an adaptive learning process to generate estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4). Additional methods of determining estimates of the coefficients are contemplated.
Once the final estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4) have been set at stage 129, any of Equations (14)-(17) may be used to determine the output in case of a failure of one of the first pressure sensor 55, the first displacement sensor 56, the second pressure sensor 57, and the second displacement sensor 58. Since the input torque (Tin) into the hydraulic power system, the rotational torque loss (Trotate), the fan torque loss (Tfan), and the inertia torque loss (Tinertia) each include one of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4), the controller 36 may use an adaptive learning process to determine in part the value of each of the relevant terms.
As stated above, the estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4) may be determined by comparing an actual output to an estimated output of one or more terms. In some instances, it may be undesirable to determine the estimates of the coefficients ({circumflex over (k)}1, {circumflex over (k)}2, {circumflex over (k)}3, {circumflex over (k)}4) based upon more than one term. For example, the hydraulic power system 39 of
It should be noted that although the torque balance equation set forth as Equation (1) includes a plurality factors for calculating or estimating torque loss, all of the factors may not be necessary to generate a sufficiently accurate estimation of a sensor output for a particular system.
In another aspect, the first displacement sensor 56 and the second displacement sensor 58 may be omitted from the hydraulic power system 39 of
Each piston 221 is connected to a slipper 226 such as through a ball and socket joint 227. Each slipper 226 is maintained in contact with swash plate 228, which is mounted to the variable displacement hydraulic pump 220 and is movable or pivotable about pivot point 229 to define an adjustable angle of inclination α.
Referring to
During operation of the variable displacement hydraulic pump 220, the cylinder block 222 rotates so that each piston 221 periodically passes over each of the intake port 230 and outlet port 231 of the valve plate 224. The angle of inclination α of swash plate 228 causes the pistons 221 to undergo an oscillatory displacement in and out of the cylinder block 222, thus drawing hydraulic fluid into intake port 230 and out outlet port 231. The volume and amount of fluid pressure output from variable displacement hydraulic pump 220 is related to the magnitude of the angle of inclination α. For small values of the angle of inclination α, the stroke of pistons 221 is relatively small and thus the pressure and discharge volume are relatively low. As the angle of inclination α increases, the piston stroke increases which causes an increase in both pressure and discharge volume.
The angle of inclination α of swash plate 228 is controlled through operation of servo valve 240, biasing servo 250, and control servo 255. Hydraulic fluid may be supplied from outlet port 231 through a first conduit 261 to biasing servo 250. Hydraulic fluid may also be supplied from outlet port 231 sequentially through second conduit 262, servo valve 240, and third conduit 263 to control servo 255. As used herein, the third conduit 263 is the volume of the swash plate control actuator and includes the volume between the servo valve 240 and the control cylinder 256 together with the open portion 257 of the receptacle 258 that receives control cylinder 256. The third conduit 263 is identified with a dashed line in
The pressure exerted by the hydraulic fluid through the third conduit 263 acts to displace an actuator such as control cylinder 256 to decrease the angle of inclination α of swash plate 228. Movement of the swash plate 228 due to displacement of control cylinder 256 is counteracted or resisted by pressure from the hydraulic fluid passing through first conduit 261 and spring 251 that both exert forces on biasing cylinder 252 of biasing servo 250.
Servo valve 240 may include a spool 241 that is slidable within body 242 to control the flow of hydraulic fluid through orifice 243. A biasing spring 244 biases the spool 241 in a first direction and an electrical solenoid 245 controls movement of the spool 241 in a second direction, opposite the first direction. Operation of the servo valve 240 results in movement of land 246 that controls flow through the orifice 243. For example, as the spool 241 moves to the left in
Similarly, as spool 241 moves to the right in
Spool 241 may be coupled to solenoid 245 that extends and retracts in a known manner in response to the supply of a solenoid current such as one generated by controller 36. The servo valve 240 may be configured so that the amount of current provided to the solenoid 245 from controller 36 accurately establishes the position of the spool 241 and thus the effective area of the opening at orifice 243. Through the application of an appropriate solenoid current, spool 241 is moved to a desired position, and thus the effective area of the opening at orifice 243 may be changed or adjusted to regulate fluid flow to control servo 255. Control cylinder 256 may thus be extended or retracted as desired to adjust the angle of inclination α, which causes swash plate 228 to pivot about pivot point 229 to yield a desired output pressure and volume from variable displacement hydraulic pump 220.
Pump displacement estimation system 200 operates by indirectly determining the position of the swash plate 228 or the angle of inclination α based upon various inputs from the control system 35 and other known relationships and dimensions related to the machine 10 and the variable displacement hydraulic pump 220 without the use of a sensor.
As hydraulic fluid enters the third conduit 263, lumped parameter dynamics provide that the change in pressure as a function of time
within the third conduit may be generally represented by the equation:
where β is the fluid bulk modulus;
Vc is the volume of the third conduit 263 as depicted at 290;
Qin is the flow of hydraulic fluid into the third conduit 263 through the orifice 243 as depicted at 291;
Qout is the leakage out of the third conduit 263 such as past the control cylinder 256 as depicted at 292; and
is the change in volume of the third conduit 263 as a function of time.
The change in volume of the third conduit 263 as a function of time
may be re-written as:
where {dot over (α)} is the rate of change as a function of time or the speed of the angle of inclination α, Ac is the area of the surface of the control cylinder 256 that defines in part the third conduit 263, and Lc is the straight line distance from the pivot point 229 of swash plate 228 to the centerline of control cylinder 256 as depicted at 295.
Substituting Equation (19) into Equation (18) results in:
Since the hydraulic fluid is relatively incompressible, the fluid bulk modulus (β) is extremely large. Further, since the volume (Vc) of the third conduit 263 is relatively small, the ratio of the fluid bulk modulus (β) to the volume (Vc) of the third conduit is extremely large and may be approximated as being infinite as follows:
In order for Equation (20) to remain valid since the pressure within the third conduit 263 cannot change instantaneously, the flow (Qin) of hydraulic fluid into the third conduit minus the leakage (Qout) of hydraulic fluid out of the third conduit plus the volume change ({dot over (α)}AcLc) of the third conduit 261 must be approximately zero, which may be expressed as:
Qin−Qout+{dot over (α)}AcLc≈0 (22)
The flow (Qin) of hydraulic fluid into the third conduit 263 may be re-written as:
where Avm is the effective area of the opening at the orifice 243 which is a function of the position of the land 246 relative to the orifice;
Cd is the valve flow discharge coefficient or constant;
ρ is the fluid density of the hydraulic fluid;
P is the discharge pressure exiting from the outlet port 231; and
Pc is the pressure within the third conduit 263.
The effective area (Avm) of the opening at the orifice 243 is dependent upon the position of the land 246 relative to the orifice 243. Accordingly, a mechanism for determining the position of the spool 241, and thus the land 243, may be provided. In one example, a map may be generated and stored within controller 36 establishing a relationship between the position of the land 243 and the current provided to the solenoid 245. Other manners of determining the position of the spool 241 are contemplated. For example, a sensor may be utilized to directly or indirectly measure the position of the spool 241. By determining the position of the spool 241 and thus the land 243, the effective area of the opening at the orifice 243 may be determined.
In the example in which the position of the land 243 is determined based upon the current provided to the solenoid that drives the spool, the valve opening area (Avm) at the orifice 243 may be expressed as:
Avm=ĩsolKAm
where ĩsol is the current to the solenoid from controller 36 and KiA
The leakage (Qout) of hydraulic fluid out of the third conduit 263 may be re-written as:
Qout=ClPc (26)
where Cl is the actuator leakage coefficient and Pc is the pressure within the first conduit 261.
Equation (25) and Equation (26) may be substituted into Equation (22) and rewritten as:
Since the actuator leakage (ClPc) is relatively small, it may be neglected or set equal to zero which allows Equation (27) to be solved for the rate of change ({dot over (α)}) of the angle of inclination α, which results in:
The rate of change ({dot over (α)}) of the angle of inclination (α) may be approximated as:
where {circumflex over (α)}n is an approximation of the current position of the angle of inclination, {circumflex over (α)}n-1 is an approximation of the position of the angle of inclination at the previous time of sampling, and Δt is the sampling rate or time between measurements and calculations by controller 36.
In addition, the difference between the discharge pressure (P) and the pressure (Pc) within the third conduit 263 may be combined together during steady state operation as a function of the discharge pressure (Pn-1) during the previous measurement cycle and a coefficient (kp,pc) that maps the previous discharge of the discharge pressure. This may be expressed as:
P−Pc=kp,pc(Pn-1) (30)
Substituting Equation (29) and Equation (30) into Equation (28) results in:
Solving Equation (31) for the approximation of the current position of the angle of inclination ({circumflex over (α)}) results in:
By combining the coefficients and constants of Equation (32) solenoid current mapping coefficient (KiA
{circumflex over (α)}n={circumflex over (α)}n-1+Δtĩsol,n-1Kα√{square root over (Pn-1)} (33)
From the forgoing, it may be understood that an approximation of the current position of the angle of inclination ({circumflex over (α)}n) may be determined based upon the approximation of the position of the angle of inclination ({circumflex over (α)}n-1) during the previous measurement cycle, the sampling time (Δt), the solenoid current (ĩsol,n-1) during the previous measurement cycle, the angle of inclination coefficient (Kα), and the discharge pressure (√{square root over (Pn-1)}) during the previous measurement cycle.
From the approximation of the current position of the angle of inclination ({circumflex over (α)}n), an estimation of the displacement ({circumflex over (D)}) of the variable displacement hydraulic pump 220 may be generated based upon a pump design coefficient (Gk) that is a function of the design of the variable displacement hydraulic pump as follows:
{circumflex over (D)}=Gk{circumflex over (α)}n (34)
It should be noted that the pump design coefficient (Gk) as well as other coefficients described herein may not be constant or linear. For example, the value of the coefficient may depend upon inputs to the system and may be constant or may vary in a linear or non-linear manner. The coefficients may be mapped to the inputs and the map stored in the controller 36. In one example, the pump design coefficient (Gk) may vary depending upon the angle of inclination α, may be a constant, or may vary in a linear or non-linear manner.
The accuracy of the estimate of the displacement ({circumflex over (D)}) of the variable displacement hydraulic pump 220 is dependent upon the accuracy of the value of the angle of inclination coefficient (Kα). To improve the accuracy of the angle of inclination coefficient (Kα), and thus the accuracy of the estimate of the displacement ({circumflex over (D)}), the controller 36 may utilize a learning process while the machine 10 is in operation. To do so, the controller 36 may compare the measured engine torque (Teng) from the prime mover 13 to an estimate of the engine torque ({circumflex over (T)}eng) as determined based upon Equation (8).
The output torque from the engine may be expressed from Equation (2) based upon the input torque (Tin) to the hydraulic power system 39 as follows:
Tin=k4Teng (35)
where Teng is the measured engine torque and k4 is an unknown coefficient. As described above, the input torque from an engine may be determined based upon fuel usage from the fuel usage sensor 76 and the engine speed from the prime mover speed sensor 131.
To determine the estimate of the output torque ({circumflex over (T)}eng) from the engine, the estimate of the first displacement ({circumflex over (D)}1) from the first variable displacement hydraulic pump 46 and the estimate of the second displacement ({circumflex over (D)}2) from the second variable displacement hydraulic pump 47, from Equation (35), are substituted into Equation (8) as follows:
Solving Equation (35) for the estimated engine torque ({circumflex over (T)}eng) results in:
An error (ε) may be determined based upon the absolute value of the difference between the measured engine torque (Teng) from the prime mover 13 and the estimate of the engine torque ({circumflex over (T)}eng) as follows:
ε=∥Teng−{circumflex over (T)}eng∥ (38)
If the error (ε) is less than a predetermined error threshold (εT), the value of the inclination coefficients (Kα,1,Kα,2) for the first variable displacement hydraulic pump 46 and the second variable displacement hydraulic pump 47 are sufficiently accurate and the estimates of the displacement from the variable displacement hydraulic pumps may be utilized. If the error (ε) is greater than the predetermined error threshold (εT), the angle of inclination coefficients (Kα,1,Kα,2) are not sufficiently accurate and the estimates of the displacement from the variable displacement hydraulic pumps may not be utilized. In such case, the angle of inclination coefficients (Kα,1,Kα,2) may be changed and the difference between the measured engine torque (Teng) and the estimate of the engine torque ({circumflex over (T)}eng) re-calculated.
It should be noted that the torque balance coefficients (k1, k2, k3, k4) as utilized above with respect to Equation (37) are unknown and in the embodiment described above with respect to
Referring to
Operational estimates such as gear churning torque loss (Tgear,ch) and the gear mesh torque loss (Tgear,msh) may be set or stored within controller 36 at stage 271. At stage 272, the controller 36 may receive data or signals from the various sensors of the machine 10. At stage 273, the controller 36 may determine the output from each of the sensors. The output from the sensors may include the terms that are used to determine the measured engine torque (Teng) such as fuel usage and engine speed, the terms in Equation (33) that are used to determine the estimated angle of inclination ({circumflex over (α)}n), and the terms in Equation (37) that are used to determine the estimate of the engine torque ({circumflex over (T)}eng).
At stage 274, the controller 36 may determine the estimated angles of inclination ({circumflex over (α)}n) of the swash plates 228 of the first variable displacement hydraulic pump 46 and the second variable displacement hydraulic pump 47. The estimated angles of inclination ({circumflex over (α)}n) may be used at stage 275 to determine an estimation of the displacements ({circumflex over (D)}) of the first variable displacement hydraulic pump 46 and the second variable displacement hydraulic pump 47.
In order to improve the accuracy of the displacement estimates ({circumflex over (D)}) pump displacement estimation system 200 may compare the measured engine torque (Teng) of the engine to an estimated or calculated engine torque ({circumflex over (T)}eng) based upon the estimation of the pump displacements ({circumflex over (D)}). To do so, at stage 276, the controller 36 may determine a measured engine torque (Teng) of an engine such as that based upon the fuel consumption and the engine speed.
An estimate of the engine torque ({circumflex over (T)}eng) of the engine may be determined at stage 277 based upon the estimates of the displacements of the first variable displacement hydraulic pump 46 and the second variable displacement hydraulic pump 47. At decision stage 278, controller 36 may determine whether the absolute value of the difference (ε) between the measured engine torque (Teng) and the estimate of the engine torque ({circumflex over (T)}eng) is less than or equal to the error threshold (εT). If the difference is less than the error threshold (εT), the pump displacement estimation system 200 may at stage 279 report the estimate of the displacement ({circumflex over (D)}1) of the first variable displacement hydraulic pump 46 and the estimate of the displacement ({circumflex over (D)}2) of the second variable displacement hydraulic pump 47. The control system 35 may utilize the estimates of the displacements to operate various aspects of machine 10.
If the absolute value of the difference (ε) between the measured engine torque (Teng) and the estimate of the engine torque ({circumflex over (T)}eng) is greater than the error threshold (εT), the controller 36 may determine at decision stage 280 whether the number of iterations of modifying the angle of inclination coefficients (Kα,1,Kα,2), determining the estimated engine torque ({circumflex over (T)}eng), and comparing it to the measured engine torque (Teng) has exceeded a threshold. If the number of iterations has exceeded the threshold, the pump displacement estimation system 200 may at stage 279 report the most recently generated estimate of the displacement ({circumflex over (D)}1) of the first variable displacement hydraulic pump 46 and the estimate of the displacement ({circumflex over (D)}2) of the second variable displacement hydraulic pump 47.
If the number of iterations has not exceeded the threshold, the pump displacement estimation system 200 may modify the angle of inclination coefficients (Kα,1,Kα,2) at stage 281 to reduce the absolute value of the difference (ε) between the measured engine torque (Teng) and the estimate of the engine torque ({circumflex over (T)}eng). Any process may be used to generate estimates of the angle of inclination coefficients (Kα,1,Kα,2). In one example, the controller 36 may utilize an adaptive learning process or rule such as a negative gradient method to determine or modify estimates of the coefficients. The process may then continue with stages 277-281 repeated.
The industrial applicability of the pump displacement estimation system 200 described herein will be readily appreciated from the foregoing discussion. The present disclosure is applicable to machines 10 having one or more variable displacement hydraulic pumps. One exemplary machine for which the pump displacement estimation system 200 is suited is an excavator or hydraulic shovel. However, the pump displacement estimation system 200 may be applicable to other machines in which an approximation of an estimated displacement of a variable displacement hydraulic pump is desirable.
The disclosed pump displacement estimation system 200 provides many advantages while operating a machine. In one example, a hydraulic power system 39 may be utilized without the additional cost of displacement sensors associated with each variable displacement hydraulic pump. More specifically, the hydraulic power system 39 may be configured so that neither the first variable displacement hydraulic pump 46 nor the second variable displacement hydraulic pump 47 have a displacement sensor associated therewith. In another example, in case of a failure of the displacement sensors associated with more than one variable displacement hydraulic pump, the controller 36 may be configured to determine an approximate value of the output associated with each inoperative sensor and thus permit the control system 35 and the hydraulic power system 39 to remain fully or close to fully operational. This permits an operator to continue to operate machine 10 in a productive manner even while waiting for replacement of the inoperative sensor. Accordingly, it should be understood that the pump displacement estimation system 200 is useful any time there is a variable displacement hydraulic pump that does not have an operative displacement sensor associated therewith.
It will be appreciated that the foregoing description provides examples of the disclosed system and technique. However, it is contemplated that other implementations of the disclosure may differ in detail from the foregoing examples. All references to the disclosure or examples thereof are intended to reference the particular example being discussed at that point and are not intended to imply any limitation as to the scope of the disclosure more generally. All language of distinction and disparagement with respect to certain features is intended to indicate a lack of preference for those features, but not to exclude such from the scope of the disclosure entirely unless otherwise indicated.
Recitation of ranges of values herein are merely intended to serve as a shorthand method of referring individually to each separate value falling within the range, unless otherwise indicated herein, and each separate value is incorporated into the specification as if it were individually recited herein. All methods described herein can be performed in any suitable order unless otherwise indicated herein or otherwise clearly contradicted by context.
Accordingly, this disclosure includes all modifications and equivalents of the subject matter recited in the claims appended hereto as permitted by applicable law. Moreover, any combination of the above-described elements in all possible variations thereof is encompassed by the disclosure unless otherwise indicated herein or otherwise clearly contradicted by context.
Number | Name | Date | Kind |
---|---|---|---|
4904161 | Kamide | Feb 1990 | A |
5267441 | Devier et al. | Dec 1993 | A |
5944492 | Konishi et al. | Aug 1999 | A |
5947695 | Nagaoka | Sep 1999 | A |
7048515 | Shimomura et al. | May 2006 | B2 |
8162618 | Nakamura et al. | Apr 2012 | B2 |
8202058 | Lindholdt et al. | Jun 2012 | B2 |
8511080 | Krajnik et al. | Aug 2013 | B2 |
8548661 | Wu | Oct 2013 | B2 |
8838314 | Bissontz | Sep 2014 | B2 |
20090196767 | Peters | Aug 2009 | A1 |
20120263604 | Jung | Oct 2012 | A1 |
20120291622 | Ikeda | Nov 2012 | A1 |
20120301325 | Nelson et al. | Nov 2012 | A1 |
20130160439 | Lee | Jun 2013 | A1 |
20130230413 | Yamaji | Sep 2013 | A1 |
20140023523 | Berg | Jan 2014 | A1 |
20140371915 | Ishihara et al. | Dec 2014 | A1 |
20150211501 | Yamada | Jul 2015 | A1 |
20160025113 | Hiraku | Jan 2016 | A1 |
20160208831 | Ancha | Jul 2016 | A1 |
20160208832 | Du | Jul 2016 | A1 |
Number | Date | Country | |
---|---|---|---|
20160341193 A1 | Nov 2016 | US |