1. Field of the Invention
This present invention relates in general to the field of programmable robotic manipulators, and assist devices that can interact with human operators.
2. Description of Related Art
Intelligent Assist Devices (“IADs”) are computer-controlled machines that aid a human worker in moving a payload. IADs may provide a human operator a variety of types of assistance, including supporting payload weight, helping to overcome friction or other resistive forces, helping to guide and direct the payload motion, or moving the payload without human guidance.
IAD characteristics have been fully described in the following commonly owned U.S. Patent Applications: U.S. patent application Ser. No. 09/781,801, titled “MODULES FOR USE IN AN INTEGRATED INTELLIGENT ASSIST SYSTEM”, filed Feb. 12, 2001, now U.S. Pat. No. 6,813,542, issued Nov. 2, 2004; U.S. patent application Ser. No. 09/781,683, titled “SYSTEM AND ARCHITECTURE FOR PROVIDING A MODULAR INTELLIGENT ASSIST SYSTEM,” filed Feb. 12, 2001, now U.S. Pat. No. 6,928,336, issued Aug. 9, 2005; U.S. patent application Ser. No. 10/147,141, titled “INTENT SENSOR FOR INTELLIGENT ASSIST DEVICES,” filed May 16, 2002, now U.S. Pat. No. 6,738,691, issued May 18, 2004; and U.S. Pat. No. 10/431,582, titled “METHODS AND APPARATUS FOR MANIPULATION OF HEAVY PAYLOADS WITH INTELLIGENT ASSIST DEVICES,” filed May 8, 2003, currently pending, the contents of which are all incorporated by reference herein in their entireties.
IADs typically use controllers that are closed loop systems. Any given controller is programmed to allow the IAD to operate efficiently and effectively. However, closed loop systems may make the IADs susceptible to instability, such as self-sustained or growing oscillations within the IAD. Whether or not instability will occur within a particular system depends on various system parameters and dynamic effects. Although instability in IADs is undesirable, current systems do not address instability. As a result, current IADs may not be capable of maintaining peak performance for a wide range of system parameters.
At least one embodiment of the present invention may provide an intelligent assist device (“IAD”) that is capable of maintaining peak performance for a wide range of system parameters.
Embodiments may be described herein as relating to an intelligent assist device that includes an overhead motorized moveable trolley, a support that extends downwardly from the trolley to a payload, and a sensor operatively coupled to the support to sense a characteristic of motion imparted by a human operator to the device. A controller is operatively coupled with the sensor and the trolley and controls movements of the trolley. The controller estimates an amount of oscillation in the support that does not correspond to the motion imparted by the human operator and adjusts movements of the trolley based thereon.
Embodiments may also include method for controlling movement of an overhead moveable trolley in an intelligent assist device. The method includes sensing a characteristic of motion imparted by a human operator to the device, estimating an amount of oscillation in the device that does not correspond to the motion imparted by the human operator, and adjusting movements of the trolley based upon the estimate.
Embodiments may further include a method for controlling movement of an overhead moveable trolley in an intelligent assist device. The method includes sensing tension in a cable that extends downwardly from the trolley to a payload, controlling the trolley based on the sensed tension, determining when changes in the sensed tension are below a threshold level, and adjusting movements of the trolley based upon the changes in the sensed tension that are below the threshold level.
Embodiments may also include an intelligent assist device that includes an overhead motorized moveable trolley, a support that extends downwardly from the trolley to a payload, and a sensor operatively coupled to the support to sense a characteristic of motion imparted by a human operator to the device. A controller is operatively coupled with the sensor and the trolley and controls movements of the trolley. The controller identifies oscillations in the support above a threshold level and adjusts movements of the trolley based thereon.
Embodiments may further include a method for controlling movement of an overhead moveable trolley in an intelligent assist device. The method includes sensing a characteristic of motion imparted by a human operator to the device, identifying oscillations in the device above a threshold level, and adjusting movements of the trolley based upon the identification.
These and other aspects of embodiments of the invention will become apparent when taken in conjunction with the following detailed description and drawings.
Features of the invention are shown in the drawings, which form part of this original disclosure. Embodiments of the invention will be described in conjunction with the following drawings, in which:
a is a top perspective view of at least one embodiment of an intelligent assist device (“IAD”) of the present invention;
b is a top perspective view of another embodiment of the IAD of the present invention;
a is a top schematic view of the IAD of
b is a schematic block diagram of the dynamics and control of at least one embodiment of the IAD of the present invention;
a is a schematic of the IAD of
b is a schematic of the IAD of
While much of what is presented below is described in the context of “cable-based” IADs, embodiments of the present invention are not limited to cable-based IADs, but may be applied to virtually any type of IAD.
a shows at least one embodiment of an IAD 100 of the present invention. The IAD 100 of
The IAD 100 also includes an overhead structure 110. The overhead structure 110 includes runways rails 106 which are fixed relative to a plant floor 112, and a bridge rail 107 which may move slidably along the runway rails 106. This motion may be powered by motorized trolley units 108. Trolleys as defined herein include any moveable overhead structure that allows a payload to be moved from a first position to a second position.
The top end of the cable 103, the hoist 104, and the cable angle sensor 105 may move as a unit slidably along the bridge rail 107. This motion may be powered by an additional motorized trolley unit 109. As shown in
As would be understood by one of ordinary skill in the art, the term cable-based IAD applies to any IAD in which the payload is suspended from an overhead moveable structure via a support that may swing freely about one or more horizontal axes. Such supports include but are not limited to cables and chains.
b illustrates another embodiment of an IAD 120 of the present invention. The IAD 120 of
Of course, there are many possible variations on this basic architecture that are encompassed by embodiments of the present invention. For example, instead of a powered bridge crane, a powered gantry crane, powered jib crane, powered monorail, or any other crane architecture known in the art may be substituted. Also, instead of a cable, a chain or any other member capable of swinging freely from the overhead moveable structure may be substituted. Further, instead of a cable angle sensor, a force sensor or any other sensor for detecting a characteristic of motion imparted by a human operator to the device that is known in the art may be substituted.
It should be understood that cable angle may be measured with a true angle sensor or it may be inferred from one or more measurements of the cable's horizontal displacement. In the context of this disclosure, the term “cable angle sensing” should be understood to encompass these methods as well as others methods that may be used to estimate the deflection of a cable or chain from the vertical axis.
A typical control structure for the IAD 100 of
As the payload 102 begins to move, it drags the bottom of the cable 103, represented by {xbottom,, ybottom}, along with it. Any difference between the location of the bottom and the location of the top of the cable 103, {xtop, ytop}, causes some cable angle that, for small angles, may be accurately estimated as:
Due to the tension in the cable 103, a non-vertical cable will exert horizontal forces on the payload 102. For small angles, these forces are approximately:
Fxcable=Wpayloadθx
Fycable=Wpayloadθy
If the payload 102 is not accelerating up or down, then the tension is approximately equal to the weight of the payload 102, Wpayload.
The IAD controller 114 attempts to minimize these forces by keeping the top of the cable 103 directly above the bottom of the cable 103. This is tantamount to keeping the cable angle at zero, where zero corresponds to vertical.
In at least one embodiment, the IAD controller 114 operates as illustrated in
The IAD controller 114 illustrated in
Also, as shown in
Moreover, if the cable tension decreases to zero or near-zero, which may occur if the payload 102 is set down on a support surface, the cable 103 may go slack, thereby causing the cable 103 to deform, i.e., take on some shape other than that of a straight line. Cable deformation may be erroneously identified as cable deflection, which will cause the motorized trolley 108, 109 to move. The closed loop system will cause the movement of the trolley 108, 109 to be highly erratic because the controller 114 will be unable to determine the proper location for the trolley 108, 109.
a and 3b illustrate two natural modes of vibration of a typical cable-based IAD 100. The two natural modes illustrated in
a illustrates the lowest frequency mode, in which the two swinging motions are in phase with one another. In other words, as the cable 103 swings in a clockwise direction, so does the payload 102.
As a general rule, the higher frequency natural mode, illustrated in
The measure or measures of instability λ are used as a basis for action. In at least one embodiment, actions may include adjusting the movements of the trolleys by modifying the gain G (shown in
In at least one embodiment of the present invention, the estimation/identification step 406 of
As illustrated in
Likewise, although an instability (self-sustained oscillation) may also excite a range of frequencies, most of the frequency content will be in a band close to the natural frequency of the mode illustrated in
The output signals from both filters 504, 506 are rectified by a rectifier 508 and passed through a low pass filter 510 having a cut-off frequency f4. The rectifier 508 and low pass filters 510 may be implemented digitally or in analog. The filter 510 may be of any of a variety of types known in the art. In at least one embodiment, the low pass filter 510 is a second-order Butterworth filter having a cut-off frequency of f4=0.5 Hz. The purpose of rectification and low pass filtering is to obtain a measure of signal strength. Any of a number of other measures of signal strength known in the art (e.g. root mean square) may be used as well.
Once both measures of signal strength are obtained, they are compared to obtain an overall measure of instability (λx). In at least one embodiment, the measure is obtained as:
λx=BPx−LPx
Of course, other types of comparisons, such as a ratio of the two signal strengths, might be used as well. In at least one embodiment, the more positive λx, the more unstable the IAD is judged to be.
In addition to the embodiment of the identification algorithm 502 illustrated in
If direct measurement of φ is not available, it may still be possible to estimate φ using an observer of known type including but not limited to a Kahlman filter. The same strategy based on phase relationships and signal strength could then be applied as if φ had been measured directly.
Also, in another embodiment, instead of using a band pass filter, as shown in
Still another embodiment may be based on the performance of the feedback controller that governs the speed of the motorized trolleys. Many IADs use velocity controllers to ensure that the trolleys can faithfully track velocity commands, such as those called out in
Once a measure of instability has been obtained, it is necessary to take some action to eliminate or minimize the instability. The simplest action is to alert the operator when the instability signal (λ) grows above some threshold. The operator can choose to shut down the system, change operating conditions (e.g., lengthen the cable), or manually change the feedback gains. It would be desirable, however, to take action without distracting the operator or requiring work stoppage.
If λ1≦λx<λ2, where λ2 is an upper threshold value, the behavior is growing unstable with the degree of instability related to the magnitude of λx. The gain factor can be adjusted according to the degree of instability as follows:
Of course, this formula is only representative. Many other relationships including those that are nonlinear, may be substituted. In at least one embodiment, the gain is adjusted to a more conservative value as the degree of instability increases. If λ2≦λx, the gain factor Gx is set to a minimum value, Gxmin.
While this embodiment addresses only IAD controllers with proportional feedback gains, {Gx,Gy}, the concept may be easily extended to more complex controllers with additional feedback gains (e.g., proportional, derivative and integral gains).
Another modification to the embodiment described above is the addition of memory. For example, if the gain factor is reduced due to unstable behavior, then it can be forced to remain low for a period of time after the resumption of stable behavior.
While the above discussion has focused on the identification and handling of instability in cable-based IADs, it should be evident that the methods discussed herein can be applied to other types of IADs, including those with rigid descenders, as shown in
Another aspect of the present invention is to provide a method to respond to a slack cable such that a cable-based IAD will not exhibit erratic behavior. This requires a way to detect cable slack, and a way to respond to a positive detection. Various ways of detecting cable slack are known in the art, and several have been described in U.S. Pat. No. 6,386,513 (Kazerooni).
Because such a measurement of tension is typically noisy, in terms of the signal, and because cable tension may drop to near zero for brief periods during normal IAD operation (e.g., when accelerating the load downward at near to 1 G), it is generally necessary to filter the cable tension signal at a fairly low frequency. In at least one embodiment, the cable tension signal is filtered with a second order Butterworth filter having a cutoff frequency of 1 Hz. Once this signal drops below a given threshold, the cable is determined to have gone slack.
It is of course possible to reduce the gains Gx and Gy smoothly in accordance to the cable tension signal (such a controller would be analogous to the one described above for responding to instability). The main concern with cable slack, however, is that a slack cable may deform, and a deformed shape will lead to erroneous cable angle signals. The transition from a straight, undeformed cable to a deformed cable generally occurs quite abruptly as tension is reduced. For this reason, at least one embodiment responds to cable slack by simply disabling the powered trolleys (equivalently, reducing the gains Gx and Gy to zero).
While many embodiments of the present invention have been shown and described, it is evident that variations and modifications are possible that are within the scope of the present invention described herein.
This application claims the benefit of priority to U.S. Provisional Application No. 60/414,851, titled “IDENTIFICATION AND CONTROL MEANS FOR ELIMINATING INSTABILITY IN INTELLIGENT ASSIST DEVICES,” filed Sep. 30, 2002, which is incorporated by reference herein in its entirety.
Number | Name | Date | Kind |
---|---|---|---|
3940110 | Motoda | Feb 1976 | A |
4284978 | Yucius | Aug 1981 | A |
5443566 | Rushmer et al. | Aug 1995 | A |
6135301 | Monzen et al. | Oct 2000 | A |
6204619 | Gu et al. | Mar 2001 | B1 |
6313595 | Swanson et al. | Nov 2001 | B1 |
6386513 | Kazerooni | May 2002 | B1 |
6394731 | Konosu et al. | May 2002 | B1 |
6460711 | Kato et al. | Oct 2002 | B1 |
6554252 | Kazerooni et al. | Apr 2003 | B1 |
6575317 | Taylor | Jun 2003 | B1 |
6612449 | Otani et al. | Sep 2003 | B1 |
6668668 | Peshkin | Dec 2003 | B1 |
6738691 | Colgate et al. | May 2004 | B1 |
6796447 | Laundry et al. | Sep 2004 | B1 |
20020111712 | Peshkin et al. | Aug 2002 | A1 |
20020112016 | Peshkin et al. | Aug 2002 | A1 |
20040026349 | Colgate et al. | Feb 2004 | A1 |
Number | Date | Country |
---|---|---|
0 733 579 | Sep 1996 | EP |
WO 0232804 | Apr 2002 | WO |
WO 02070389 | Sep 2002 | WO |
Number | Date | Country | |
---|---|---|---|
20040143364 A1 | Jul 2004 | US |
Number | Date | Country | |
---|---|---|---|
60414851 | Sep 2002 | US |