Not Applicable
1. Field of the Invention
This invention relates generally to a method and device for detecting ground contact of an electric motor-driven jack as the jack is being extended to adjust the attitude of a mobile platform.
2. Description of the Related Art Including Information Disclosed Under 37 CFR 1.97 and 1.98
Any mobile platform attitude adjustment system that relies on jacks to move a platform into a desired attitude must have a jack drive mechanism for extending the jacks to the ground, adjusting the attitude of the platform, and retracting the jacks when the platform is to be moved to a different location. It is desirable for the jacks to be firmly seated on the ground before allowing such a jack drive mechanism to lift or adjust the attitude of the platform since failure to properly seat the jacks on the ground can result in unstable and potentially dangerous platform positions or attitudes.
It is also desirable that a controller for controlling such a jack drive mechanism have a feedback mechanism that allows the controller to determine when jacks contact the ground. Such a controller determines when jacks are on the ground to ensure that the platform is firmly seated to prevent the jack drive mechanism from significantly elevating any portion of the platform until after all the jacks have been seated or grounded.
For example, U.S. Pat. No. 5,143,386 issued 1 Sep. 1992, to Uriarte, discloses a platform leveling device including a plurality of jacks powered by respective DC electric jack motors. To detect ground contact the Uriarte patent discloses a controller programmed to interpret electrical motor current draw values exceeding a fixed, predetermined current value, as indicating jack ground contact. However, the Uriarte device is unable to recognize and ignore current spikes that exceed the predetermined current value but are unrelated to jack ground contact. Current spikes unrelated to jack ground contact may be caused by such phenomena as motor in-rush, momentary contact with intervening obstructions, impurities in the jack drive mechanism, and clutching. Neither does Uriarte disclose compensation for variations in jack motor power draw.
Variations in jack power draw can occur for a number of different reasons: As a jack ages, wear on its mechanical parts increases, requiring the motor driving the jack to work progressively harder to lift the same load. Other factors include expansion and contraction due to temperature changes, contamination, loss of lubrication, corrosion, and the like. Jack power draw can also vary depending on which portion of a platform the jack is supporting and the location and starting attitude of the platform relative to the ground. The starting attitude relative to the ground can vary greatly between leveling locations and, when it does, it causes the jacks supporting the platform to contact the ground at different times and to divide the load differently. The jack or jacks bearing more load will work harder and draw more power than the others. Jack power draw can also be affected by changes in the amount of peak power available from a battery or batteries that power the motor driving the jack.
U.S. Pat. No. 4,084,830 issued 18 Apr. 1978, to Daniel, Jr. et al., discloses, for each electric jack in a platform leveling system, a ground contact detection switch mounted in a position to be mechanically closed by a pin that is supported in such a way as to move upward into contact with the switch when an associated jack extends into contact with the ground. A controller is connected in an electrical ground contact detection circuit with each ground contact detection switch and is programmed to interpret a closed ground contact detection circuit as indicating that a corresponding jack has contacted the ground. The controller is further programmed to interpret an open ground contact detection circuit as indicating that a corresponding jack is not contacting the ground.
What is needed is an electric jack ground contact detection method and device that can detect jack ground contact by sensing power draw increases rather than requiring mechanically-actuated switches, that can recognize and ignore current spikes that are unrelated to jack ground contact, and that can compensate for variations in jack motor power draw.
According to the invention, an electric jack ground contact detection device is provided for detecting ground contact of an electric motor-driven jack as the jack is being extended to adjust the attitude of a mobile platform. The device includes a controller configured to monitor the electrical power draw of an electric motor-driven jack while the jack is being extended for use in adjusting the attitude of a mobile platform. The controller is further configured to recognize jack ground contact when the monitored power draw value exceeds a ground contact power draw value consistent with jack ground contact. Still further, the controller is configured to calculate the ground contact power draw value as equaling the sum of a dynamically-adjusted threshold power draw value associated with jack extension before ground contact and a power draw increase value equaling an amount of additional power that the jack is known to draw as a result of jack ground contact. Dynamic adjustment of the threshold power draw value allows the device to compensate for variations in jack power draw that occur during each jack extension and also for variations in jack power draw that occur over time due to wear and that change between uses due to variations in environmental conditions.
According to another aspect of the invention, an electric jack ground contact detection device is provided that includes a controller configured to monitor the electrical power draw of an electric motor-driven jack while the jack is being extended for use in adjusting the attitude of a mobile platform. The controller is further configured to recognize jack ground contact only after the monitored power draw value has exceeded a ground contact power draw value consistent with jack ground contact for a predetermined period. This causes the controller to ignore power spikes unrelated to ground contact.
The invention also includes a method for detecting ground contact of an electric motor-driven jack. According to this method, ground contact of an electric motor-driven jack can be detected by predetermining and storing a ground contact power draw value known to be generally equal to the power draw of the jack once the jack has contacted the ground while extending to adjust the attitude of the platform, monitoring a present electrical power draw value of the jack while the jack is extending to adjust the attitude of the mobile platform, comparing the present jack power draw value to the stored ground contact power draw value while the jack is extending, and then recognizing ground contact of the jack as occurring when the present jack power draw value equals or exceeds the stored ground contact power draw value. According to this method the stored ground contact power draw value is calculated by predetermining a threshold power draw value of the electric jack motor known to result from extension of the jack without encountering an obstruction, predetermining a power draw increase value of the jack known to result from ground contact of the jack, then adding the power draw increase value to the threshold power draw value.
These and other features and advantages of the invention will become apparent to those skilled in the art in connection with the following detailed description and drawings, in which:
In this document the term “platform” refers to a body, such as the one shown at 10 in
A device for detecting ground contact of an electric motor-driven jack 12 as the jack is being extended to adjust the attitude of a mobile platform 10 is generally shown at 20 in
The device 20 includes a controller 23 that is also the controller for the platform attitude adjustment system 22. In other words, ground contact detection is a function of the platform attitude adjustment system 22 that allows the platform attitude adjustment system 22 to ground each of the jacks 12 before beginning to adjust platform attitude. Details relating to the construction and operation of a platform attitude adjustment device employing such a controller can be found in U.S. Pat. No. 6,584,385, which issued 24 Jun. 2003 to Ford et al., and U.S. patent application Ser. No. 10/318,820 (published as 20030135312), both of which are assigned to the assignee of the present invention, and are incorporated herein by reference.
As shown in
The controller 23 is capable of sending control signals 32 to the jacks 12 through a first I/O port 34, a relay control 36, and respective H-bridge relays 38. The controller 23 is also capable of sending control signals 40 to the dual-axis tilt sensor 18 through a second I/O port 42. The controller 23 includes a central processing unit 44, a software-implemented digital signal processor 46, and control algorithms 48. A battery 50 provides electrical power to the jacks 12 through the H-bridge relays 38 as well as to the controller 23.
The controller 23 is programmed to monitor the electrical power draw (P) of an electric motor-driven jack 12 while the jack 12 is being extended for use in adjusting the attitude of a mobile platform 10. The electrical power draw (P) of an electric motor-driven jack during unloaded operation is represented by the generally level line generally indicated at Puo in
The controller 23 is programmed to recognize jack ground contact as having occurred when the monitored power draw value (P) of one of the jacks 12 exceeds a ground contact power draw value (Pgc) known to be consistent with that particular type of jack having experienced ground contact. The ground contact power draw value of a jack 12, shown at Pgc in
The controller 23 calculates the ground contact power draw value (Pgc) of a jack 12 as equaling the sum of a dynamically-adjusted no-load threshold or “baseline” power draw value (Pthreshold) of the jack 12 and a power draw increase value or “delta” value (ΔPload) associated with the jack type, or, Pgc=Pthreshold+ΔPload. The no-load threshold power draw value (Pthreshold) is the maximum “unloaded” power draw (Puo) known to result from extension of an extendable foot portion 30 of the jack 12 without the foot portion 30 encountering the ground or any other obstruction. The power draw increase value or “delta” value (ΔPload) is an amount of additional power draw known to result from ground contact of the extendable foot portion 30 of the jack 12. The parameter is unique to each target application, and is measured over a suitably large sample of motors and jacks in a target application by measuring the power delta value (ΔPload) of each of the jacks 12 in the sample when its extendable foot portion 30 contacts the ground and platform 10 weight begins to transfer to each jack 12. Dynamic adjustment of the threshold power draw value (Pthreshold) allows the device 20 to compensate for variations (particularly reductions) in jack power draw that occur during each jack extension, that occur over time due to such factors as jack wear, and also for variations in jack power draw that occur between uses due to variations in environmental conditions.
For the power draw increase or “delta” value (ΔPload) the controller 23 is programmed to use a value representing the smallest amount of additional power that the type of jack to be used in a given application is known to draw as a result of ground contact of the extendable foot portion 30 of a jack 12. The value is determined by measuring the smallest amount of power draw increase experienced by a sample poll of jacks at ground contact. The parameter is set slightly smaller than this worst case measured value to insure that the controller 23 will be able to detect ground contact for jack motors 14 whose power draw increase may fall outside the range of values obtained in the sample poll.
The controller 23 is programmed to disregard monitored power draw (P) values in excess of the predetermined ground contact power draw value (Pgc) until after a predetermined motor current in-rush time (Tin-rush) has passed. For each application, this predetermined period of time (Tin-rush) is set to be long enough to encompass an in-rush of whatever jack motor 14 the controller 23 is to monitor by measuring the motor current in-rush times of a suitably large sample of motors of the type to be used in a target application. Motor current in-rush is an extremely large spike in current draw that occurs immediately after activating a DC electric motor while coils of the motor are energizing. The motor in-rush time (Tin-rush) is slightly longer than the known brief period of time that it takes for this phenomenon to pass. The motor current in-rush time to be used by the device 20 is set to be longer than the worst case (longest) in-rush time measured, to account for motors outside the sample pool that may have longer in-rush times. In this way, the controller 23 causes the device 20 to ignore power spikes unrelated to ground contact.
The controller 23 is also programmed to wait a period of time before recognizing monitored power draw (P) values in excess of the predetermined ground contact power draw value (Pgc) as representing ground contact. In other words, this period of time, known as the motor load confirmation debounce period (Tload), represents the amount of time that the motor 14 must continue to draw more than the ground contact power draw value (Pgc or Pthreshold+ΔPload) before the controller 23 will conclude that ground contact has occurred. The controller 23 uses the Tload parameter to prevent false ground contact detections that are caused by brief periods of motor load exceeding Pthreshoid+ΔPload. Such short term loads will pass unnoticed if they are shorter than the motor load confirmation debounce period (Tload). The Tload parameter is also used to ensure that a jack 12 is firmly seated on the ground and to ensure that platform 10 weight has shifted onto the jack 12. This is accomplished by continuing to drive the jack 12 for a brief period after ground contact has been established. The value of the Tload parameter is set taking into account the behavior of a target motor 14 over a wide variety of control voltages, platform loads, and ground conditions.
To arrive at the threshold power draw value Pthreshold, the controller 23 is programmed to start with a previously-measured no-load power draw value and then dynamically adjusts that value to compensate for changes in jack motor 14 power draw that occur over time as a result of such factors as drive component wear, expansion and contraction of jack 12 and motor components due to temperature changes, contamination of jack 12 and motor components, loss of lubrication, corrosion, and the like. The controller 23 also dynamically adjusts threshold power draw value (Pthreshold) to compensate for changes that occur between uses due to variations in environmental conditions.
In practice, the motor load confirmation debounce period (Tload), the motor current in-rush time (Tin-rush), and the minimum power draw increase (ΔPload) of the electric jack motors for the intended application are predetermined and stored in the device 20. It's preferable to store these parameters in non-volatile reprogrammable memory 31 such as EEPROM to allow the parameters to be updated to reflect more accurate or recent calculations, or changed to adapt to different applications or conditions. This allows the latest parameter values to be programmed into the product at the end of the production line and/or modified after the product is built. This method is typically implemented on new products where it's advisable to allow for parameter changes that may be implemented during early production. It's also useful to implement this method during the development phase of a product, when parameters are being determined and change daily. However, some or all of the parameters may alternatively be hard-coded into program ROM. This is a lower cost solution that may be implemented on mature products for which parameter values have not changed for a long period of time and are not expected to change in the near future.
The device 20 is then incorporated into a mobile platform attitude adjustment system 22. The attitude adjustment system 22 incorporating the device 20 is then mounted on the platform 10 and the device 20 is electrically connected to each of the motor-driven jacks 12 mounted around the platform 10. More specifically, the sensor leads 21 and the control leads are connected between the device 20 and each of the jacks 12 and the power lead is connected to the source of electrical power 26.
When an operator actuates the attitude adjustment system 22 to begin adjusting the attitude of the platform 10, as shown at decision point 52 in
As shown at decision point 58 and action point 60, the controller 23 ignores the present electric jack power draw values (P) that it monitors during a motor in-rush period defined as being the period of time between a motor actuation time and the motor current in-rush time (Tactuation<Tin-rush) and resets corresponding RMS measurements accordingly. During the in-rush period the controller 23 also sets the no-load threshold or baseline power draw values (Pthreshold) for the electric jack motors to maximum expressible value for those variables as shown at action point 54 and, until the in-rush period is over, aborts the ground contact detection process. Once the in-rush period is over, the baseline power draw values (Pthreshold), having been set to maximum expressible values, will necessarily be larger than any of the RMS jack power draw values (Prms) measured immediately following the in-rush period. As shown at decision point 70 and action point 72, this insures that the controller 23 will initially set the baseline power draw values to equal the respective initial RMS jack power draw values experienced following the in-rush period. The controller 23 then adds the no-load threshold power draw value (Pthreshold) of each electric jack motor 14 to the power draw increase or “delta” value (ΔPload) of the electric jack motors as shown at decision point 62 to arrive at initial stored ground contact power draw values (Pgc) for the respective electric jack motors.
While the jacks 12 continue to extend the extendable foot portions 30 of their respective associated jacks 12 following the motor in-rush period, and as the controller 23 continues to filter the present electric power draw values (P) of the electric jack motors, the controller 23 continuously compares the present electric jack motor RMS power draw values (Prms) of the electric jack motors to the stored ground contact power draw value (Pgc) as shown at decision point 62. If, during this time following the in-rush period, the controller 23 senses that the present RMS power draw value (Prms) of any jack 12 is less than the sum of the threshold power draw value and the power draw increase value (Prms<Pthreshold+ΔPload) the controller 23 resets the variable debounce confirmation timer value (Tdebounce) for that jack 12 to zero as shown at action point 64. If, on the other hand, the controller 23 senses that the present RMS power draw value (Prms) of a jack 12 is greater than the sum of the threshold power draw value and the power draw increase (Prms>Pthreshold+ΔPload), the debounce confirmation timer value (Tdebounce) for that jack 12 increments by an appropriate time unit as shown at action point 66. Whenever the present RMS power draw value (Prms) of one of the jacks 12 exceeds the sum of the threshold power draw value of that jack 12 and the predetermined power draw increase value (Prms>Pthreshold+ΔPload) long enough for that jack's debounce confirmation timer value (Tdebounce) to increment to a value exceeding the motor load confirmation debounce period (Tdebounce>Tload) as shown at decision point 68, the controller 23 will recognize that the extendable foot portion 30 of that jack 12 has contacted the ground. In response to ground contact recognition, the controller 23 produces a corresponding output signal to the attitude adjustment system 22 indicating that ground contact has occurred for that jack 12.
As each jack 12 is extending it's associated extendable foot portion 30 to adjust the attitude of the mobile platform 10, but before the foot portion 30 of each jack 12 contacts the ground, the controller 23 is dynamically updating the threshold power draw value (Pthreshold) for each jack motor 14 by continuously re-measuring the power draw of each jack motor 14 and comparing it to whatever the current threshold power draw value (Pthreshold) is as shown at decision block 70. The controller 23 dynamically adjusts the threshold power draw value (Pthreshold) for each jack motor 14 such that if the threshold power draw value is greater than the present jack power draw (Pthreshold>Prms) then the controller 23 resets the threshold power draw value (Pthreshold) by decreasing it to equal the present jack power draw value (Pthreshold=Prms) as shown at action point 72. The controller 23 then adds the dynamically updated threshold power draw value (Pthreshold) to the stored power draw increase (ΔPload) as shown at decision point 62 and as is described above. This insures that the Pthreshold value never becomes so large, due, e.g., to motor in-rush, as to prevent the controller 23 from sensing that the criteria have been met for establishing that ground contact has occurred. In other words, by decreasing the value of Pthreshold, the controller 23 is able to detect ground contact once the Prms value is Pload larger than the minimum Prms value measured before ground contact.
This description is intended to illustrate certain embodiments of the invention rather than to limit the invention. Therefore, it uses descriptive rather than limiting words. Obviously, it's possible to modify this invention from what the description teaches. Within the scope of the claims, one may practice the invention other than as described.
This application claims priority from Provisional Application No. 60/619,768, filed Oct. 18, 2004 and entitled “Positioning Device for Mobile Platforms Having DC Electric Jacks”.
Number | Date | Country | |
---|---|---|---|
60619768 | Oct 2004 | US |