The present invention relates to material handling devices that lift and lower loads as a function of operator-applied force.
The device described here is different from manual material handling devices currently used by auto-assembly and warehouse workers. Initial research generally shows three types of material handling devices are currently available on the market.
A class of material handling devices called balancers consists of a motorized take-up pulley, a line that wraps around the pulley as the pulley turns, and an end-effector that is attached to the end of the line. The end-effector has components that connect to the load being lifted. The pulley's rotation winds or unwinds the line and causes the end-effector to lift or lower the load connected to it. In this class of material handling systems, an actuator generates an upward line force that exactly equals the gravity force of the object being lifted so that the tension in the line balances the object's weight. Therefore, the only force the operator must impose to maneuver the object is the object's acceleration force. This force can be substantial if the object's mass is large. Therefore, a heavy object's acceleration and deceleration is limited by the operator's strength.
There are two ways of creating a force in the line so that it exactly equals the object weight. First, if the system is pneumatically powered, the air pressure is adjusted so that the lift force equals the load weight. Second, if the system is electrically powered, the right amount of voltage is provided to the amplifier to generate a lift force that equals the load weight. The fixed preset forces of balancers are not easily changed in real time, and therefore these types of systems are not suited for maneuvering of objects of various weights. This is true because each object requires a different bias force to cancel its weight force. This annoying adjustment must be done either manually by the operator or electronically by measuring the object's weight. For example, the pneumatic balancers made by Zimmerman International Corporation or Knight Industries are based on the above principle. The air pressure is set and controlled by a valve to maintain a constant load balance. The operator has to manually reach the actuator and set the system to a particular pressure to generate a constant tensile force on the line. The LIFTRONIC System machines made by Scaglia also belong in the family of balancers, but they are electrically powered. As soon as the system grips the load, the LIFTRONIC machine creates an upward force in the line which is equal and opposite to the weight of the object being held. These machines may be considered superior to the Zimmerman pneumatic balancers because they have an electronic circuit that balances the load during the initial moments when the load is grabbed by the system. As a result, the operator does not have to reach the actuator on top and adjust the initial force in the line. In this system, the load weight is measured first by a force sensor in the system. While this measurement is being performed, the operator should not touch the load, but instead should allow the system to find the object's weight. If the operator does touch the object, the force reading will be incorrect. As a result, the LIFTRONIC machine then creates an upward line force that is not equal and opposite to the weight of the object being held. Unlike the assist device of this application, balancers do not give the operator a physical sense of the force required to lift the load. Also, unlike the device of this application, balancers can only cancel the object's weight with the line's tension and are not versatile enough to be used in situations in which load weights vary.
The second class of material handling device is similar to the balancers described above, but the operator uses an intermediary device such as a valve, push-button, keyboard, switch, or teach pendent to adjust the lifting and lowering speed of the object being maneuvered. For example, the more the operator opens the valve, the greater will be the speed generated to lift the object. With an intermediary device, the operator is not in physical contact with the load being lifted, but is busy operating a valve or a switch. The operator does not have any sense of how much she/he is lifting because his/her hand is not in contact with the object. Although suitable for lifting objects of various weights, this type of system is not comfortable for the operator because the operator has to focus on an intermediary device (i.e., valve, push-button, keyboard, or switch). Thus, the operator pays more attention to operating the intermediary device than to the speed of the object, making the lifting operation rather unnatural.
The third class of material handling device use end-effectors equipped with force sensors or motion sensors. These devices measure the human force or motion and based on this measurement vary the speed of the actuator. An example of such a device is U.S. Pat. No. 4,917,360 to Yasuhiro Kojima. With this and with similar devices, if the human pushes upward on the end-effector the pulley turns and lifts the load; and if the human pushes downward on the end-effector, the pulley turns and lowers the load. A problem occurs when the operator presses downward on the end-effector to engage the load with the suction cups, the controller and actuator interpret this motion as an attempt to lower the load. As a result, the actuator causes the pulley to release more line than necessary, creating “slack” in the cable. Hereinafter the term “slack” should be interpreted as meaning an excessive length of line but should not be construed as including instances where the line is simply not completely taut. A slack line may wrap around the operator's neck or hand. After the slack is produced in the line by this or other circumstances, when the operator pushes upwardly on the handle, the slack line can become tight around the operator's neck or hand creating deadly injuries. Because slack can occur even when suction cups are not used as the load gripping means, for safe operation it is important to prevent slack at all times. During fast maneuvers workers can accidentally hit the loads they intend to lift or their surrounding environment (e.g. conveyor belts) with the bottom of the end-effector. In palletizing tasks, the workers quite often use the bottom of the end-effector to fine tune the locations of a box that is not well placed. These occurrences will cause slack in the line since the operator pushes downwardly on the end-effector handle to situate a box, while the end-effector is constrained from moving downwardly. In general, slack in the line can be dangerous for the operator and others the same work environment. The manual material handling device of my invention never creates slack in the line.
The force sensor devices of this class also fail to give an operator a realistic sense of the weight of the load being lifted. This can lead to unnatural and possibly dangerous load maneuvers.
The assist device of this application solves the above problems associated with the three classes of material handling devices. The hoist of this invention includes an end-effector to be held by a human operator; an actuator such as an electric motor; a computer or other type of controller for controlling the actuator; and a line, cable, chain, rope, wire or other type of line for transmitting a tensile lifting force between the actuator and the end-effector. Hereinafter the term “lifting” should be interpreted as including both upward and downward movements of a load. The end-effector provides an interface between the human operator and an object that is to be lifted. A force transfer mechanism such as a pulley, drum or winch is used to apply the force generated by the actuator to the line that transmits the lifting force to the end-effector.
A signal representing the vertical force imposed on the end-effector by the human operator, as measured by a sensor, is transmitted to the controller that is associated with the actuator. In operation, the controller causes the actuator to rotate the pulley and move the end-effector appropriately so that the human operator only lifts a pre-programmed small proportion of the load force while the remaining force is provided by the actuator. Therefore, the actuator assists the operator during lifting movements in response to the operator's hand force. Moreover, the tensile force in the line is detected or estimated, for example, by detecting the energy or current that is drawn by an actuator. In addition, because load force is a dominating factor in establishing the magnitude of tensile force, load force can be used to roughly approximate tensile force and vice versa. Hereinafter, it should be understood that tensile force can be estimated using load force and load force can be estimated using tensile force. A signal representing the load force or tensile force on the line is sent to the controller, and the controller uses the load force or tensile force signal to drive the actuator effectively in response to the human input. This, for example, can prevent the actuator from releasing line when the load force or tensile force is zero so that although the line may become loose (i.e. not taut), slack (as defined above) will never be created in the line.
With this load sharing concept, the operator has the sense that he or she is lifting the load, but with far less force than would ordinarily be required. The force applied by the actuator takes into account both the gravitational and inertial forces that are necessary to move the load. Since the force applied by the actuator is automatically determined by line force and the force applied to the end-effector by the operator, there is no need to set or adjust the human power amplifier for loads having different weights. There is no switch, valve, keyboard, teach pendent or push-button in the human power amplifier to control the lifting speed of the load. Rather, the contact force between the human hand and the end-effector handle combined with line force are used to determine the lifting speed of the load. The human hand force is measured and used by the controller in combination with line force to assign the required angular speed of the pulley to either raise or lower the line and thus create sufficient mechanical strength to assist the operator in the lifting task. In this way, the device follows the human arm motions in a “natural” way. When the human uses this device to manipulate a load, a well-defined small portion of the total load force (gravity plus acceleration) is lifted by the human operator. This force gives the operator a sense of how much weight he/she is lifting. Conversely, when the operator does not apply any vertical force (upward or downward) to the end-effector handle, the actuator does not rotate the pulley at all, and the load hangs motionless from the pulley.
Although the existing devices described in earlier paragraphs do lift loads, they:
do not give the operator a physical sense of the lifting maneuver,
do not compensate for inertia forces,
do not compensate for varying loads,
do not address any key ergonomic concerns, and
do not prevent slack in the line.
The device of this application does have the above-identified advantages.
In the preferred embodiment, actuator 12 is an electric motor with a transmission, but alternatively it can be an electrically-powered motor without a transmission. Furthermore, actuator 12 can also be powered using other types of energy including pneumatic, hydraulic, and other alternative forms of energy. As used herein, transmissions are mechanical devices such as gears, pulleys and lines that increase or decrease the tensile force in the line. Pulley 11 can be replaced by a drum or a winch or any mechanism that can convert the motion provided by actuator 12 to vertical motion that lifts and lowers line 13. Although in this embodiment actuator 12 directly powers the take-up pulley 11, one can mount actuator 12 at another location and transfer power to take-up pulley 11 via another transmission system such as an assembly of chains and sprockets. Actuator 12 is driven by an electronic controller 20 that receives signals from end-effector 14 over a signal cable 21. Because there are several ways to transmit electrical signals, signal cable 21 can be replaced by other alternative signal transmitting means (e.g. RF, optical, etc.). In a preferred embodiment controller 20 essentially contains three major components:
1. An analog circuit, a digital circuit, or a computer with input output capability and standard peripherals. The responsibility of this portion of the controller is to process the information that is received from various sensors and switches and to generate command signals for the actuator.
2. A power amplifier that sends power to the actuator based on a command from the computer discussed above. In general, the power amplifier receives electric power from a power supply and delivers the proper amount of power to the actuator. The amount of electric power supplied by the power amplifier to actuator 12 is determined by the command signal computed within the computer.
3. A logic circuit composed of electromechanical or solid state relays, to start and stop the system depending on a sequence of possible events. For example, the relays are used to start and stop the entire system operation using two push buttons installed either on the controller or on the end-effector. The relays also engage the friction brake in the presence of power failure or when the operator leaves the system. In general, depending on the application, one can design many architectures for logic circuit.
Human interface subsystem 15 is designed to be gripped by a human hand and measures the human force, i.e., the force applied by the human operator against human interface subsystem 15. Load interface subsystem 17 is designed to interface with a load and contains various holding devices. The design of the load interface subsystem depends on the geometry of the load and other factors related to the lifting operation. In addition to the suction cup 18 shown in
The human interface subsystem 15 of end-effector 14 contains a sensor (described below) that measures the magnitude of the vertical force exerted by the human operator. If the operator's hand pushes upward on the handle 16, the take-up pulley 11 moves the end-effector 14 upward. If the operator's hand pushes downward on the handle 16, the take-up pulley moves the end-effector 14 downward. The measurements of the forces from the operator's hand are transmitted to the controller 20 over signal cable 21 (or alternative signal transmission means). Furthermore, while the preferred embodiment of my system includes a sensor positioned in proximity to the end-effector 14, other operator-applied force estimating elements can be used to estimate operator-input that are not in proximity to the end-effector 14.
Using these measurements, the controller 20 assigns the necessary pulley speed to either raise or lower the line 13 to create enough mechanical strength to assist the operator in the lifting task as required. Controller 20 then powers actuator 12, via power cable 23, to cause pulley 11 to rotate. All of this happens so quickly that the operator's lifting efforts and the device's lifting efforts are for all purposes synchronized perfectly. The operator's physical movements are thus translated into a physical assist from the machine, and the machine's strength is directly and simultaneously controlled by the human operator. In summary, the load moves vertically because of the vertical movements of both the operator and the pulley. One of the most important properties of the device of this invention is that the actuator and pulley turn causing the end-effector to follow the operator's hand motion upwardly and downwardly yet the line does not become slack if the end-effector is physically constrained from moving downwardly and the end-effector is pushed downwardly by the operator.
A dead-man switch with a lever 26 on handle 16 (described below) sends a signal to controller 20 via a signal cable 22 (or other alternative signal transmission means). When the operator holds onto handle 16, the dead-man switch sends a logic signal to the controller 20 causing the end-effector to follow the operator's hand. When the operator releases handle 16, the dead-man switch sends a different logic signal to the controller 20 causing the end-effector to remain stationary. In a preferred embodiment of this invention, a friction brake 24 has been installed on the actuator 12. The friction brake engages whenever the operator releases the dead-man switch or at any time there is a power failure. One can use an end-effector with two handles, only one of which needs to be instrumented with a sensor to measure operator-applied force. For lifting heavy objects, one can use two human power amplifiers similar to the human power amplifier 10 shown in
I first describe, in detail, the architecture of two classes of end-effectors that allow for measurement of the operator force. I will then explain the control algorithm that allows for the operation of the system and prevention of the slack in the line. A flow chart is also given to explain the implementation of the control algorithm.
Two families of the end-effectors are described here.
The force sensor used in embodiments of this invention can be selected from a variety of force sensors that are available in the market, including piezoelectric based force sensors, metallic strain gage force sensors, semiconductor strain gage force sensors, Wheatstone bridge-deposited strain gage force sensors, and force sensing resistors. Regardless of the particular type of force sensor chosen and its installation procedure, the design should be such that the force sensor 31 measures only the operator force against the end-effector 30. Bracket 33 is connected to cylinder 35 rigidly and it includes hook 36 to interface the load and eyelet 37 to be connected to the line 13.
In a second group of embodiments, the force imposed by the operator against the end-effector is measured by the displacement of the handle rather than a force sensor of the kind described above. The lower cost and ease of use of displacement measurement systems can make this type of end-effector more attractive in some situations. A partially cross-sectioned view of one embodiment of an end-effector of the second group is shown in FIG. 3.
A handle 16 is held by the operator and connected rigidly to the ball-nut portion 49 of the ball spline shaft mechanism securely. Balls 50 located in grooves of spline shaft 51 allow for linear motion of ball-nut 49 and handle 16 freely along a spline shaft 51, with no rotation relative to spline shaft 51. The spline shaft 51 is secured to bracket 47, which is connected to line 13 via an eyelet 46.
In this embodiment, the spline shaft 51 is press fitted into bracket 47. Member 44 holding a hook 45 is connected to bracket 47 via bolts 52. Member 44 has hole patterns that allow for connection of a suction cup mechanism, a hook, or any device to hold the object. A coil spring 53 is positioned around spline shaft 51 between the ball-nut portion 49 of the ball-spline shaft mechanism and a stop 54 and urges handle 16 upward. Note that stop 54 can be a clamp ring that is secured to spline shaft 51 rigidly.
In this embodiment, a linear encoder measures the motion of the handle 16 relative to bracket 47. The encoder system has a sensor 48 that produces an electric signal on signal cable 21. The encoder also has a reflective strip 55 mounted on handle 16 by adhesive. The reflective strip has dark horizontal stripes. As the handle moves linearly relative to bracket 47, the sensor 48 detects the light and dark regions of the strip 55 and sends appropriate pulses via signal cable 21 as it observes the light (or dark) regions of the strip 55. The leading and trailing edges of pulse signals will then be counted in the controller 20.
Alternatively, the ball spline shaft mechanism shown in
A dead-man switch 56 is installed on handle 16 sends a signal to controller 20 via signal cable 22 (or by alternative signal transmission means). A lever 26, pivoting around hinge 58, is installed on the handle 16 and pushes against the switch 56 when the operator holds onto handle 16. In a preferred embodiment of this invention, a friction brake 24 has been installed on the actuator 12. This friction brake engages when the operator releases the dead-man switch and any time there is a power failure. In addition, as an optional feature, the assist device controller can be designed so that when the operator leaves the handle 16, the controller transfers the actuator to position control mode. In position control mode, the controller tries to keep the actuator (and consequently the end-effector) at the position where the operator left the device. As soon as the operator returns and grasps the handle 16, the actuator moves out of position control mode. In a preferred embodiment, the position control mode includes a standard feedback system that uses the encoder on the actuator as a feedback signal and maintains the position of the actuator where the operator left the device. Although this optional feature holds the actuator and the end-effector stationary when the operator leaves the handle, I do not recommend that practitioners substitute this feature for the friction brake discussed above. The position control feature will not work if there is a sensor, computer or power failure.
The sole purpose of the spring installed in the end-effector is to bring the handle back to an equilibrium position when no force is imposed on the handle by the operator.
As explained above, other types of operator-input estimating elements can be used in place of the specific embodiments described above. Examples of alternative operator-input estimating elements may include sensors that evaluate energy consumed by the actuator during lifting or sensors that are not in proximity to the end-effector that can estimate load force or tensile force to estimate operator-applied force.
The block diagram of
v=Ge (1)
where (G) is the actuator transfer function. A positive value for (v) means downward speed of the end-effector. In addition to the input command (e) from the controller, the line tensile force, (fR) will also affect the end-effector velocity. The input command (e) and the line tensile force, (fR), contribute to the end-effector velocity such that:
v=Ge+SfR (2)
where (S) is the actuator sensitivity transfer function which relates the line tensile force (fR) to the end-effector velocity (v). If a closed loop velocity controller is designed for the actuator such that (S) is small, the actuator has only a small response to the line tensile force. A high-gain controller in the closed-loop velocity system results in a small (S) and consequently a small change in velocity, (v), in response to the line tensile force. Also note that non-back-driveable speed reducers (usually high transmission ratios) produce a small (S) for the system.
The line tensile force, (fR), can be represented by equation 3:
fR=f+p (3)
where (f) is the operator-applied force on the end-effector and force (p) is imposed by the load and the end-effector, referred to herein as the “load force” on the line. Positive values for (f) and (p) represent downward forces. Note that (p) is force imposed on the line and is equal to the weight and inertia force of the load and end-effector taken together:
where W is the weight of the end-effector and load taken together as a whole and
is the end-effector acceleration. If the end-effector and load do not have any acceleration or deceleration, then (p) is exactly equal to the weight of the end-effector and load, (W). Also note that inspection of FIG. 5 and equation 4 reveals that variable (E) in the block diagram of
in equation 4, therefore p=W−Ev.
The human force, (f), is measured and passed to the controller 20 that delivers the output signal (e). A positive number (fup), in the computer, is subtracted from the measurement of the human force, (f). The role of (fup) will be explained below. If the transfer function of the controller is represented by (K), then the output of the controller (e) is:
e=K(f−fup) (5)
Substituting for (fR) and (e) from equations (3) and (5) into equation (2) results in the following equation for the end-effector velocity (v):
v=GK(f−fup)+S(f+p) (6)
Measuring an upward human force on the end-effector is only possible when the line is under tension caused by the weight of the end-effector. If the end-effector is light, then the full range of human upward forces may not be measured by the sensor in the end-effector. To overcome this problem, a positive number, (fup), is introduced in equation (5). As equation (6) shows, in the absence of (f) and (p), (fup) will cause the end-effector to move upwardly. Suppose the maximum downward force imposed by the operator is fmax. Then (fup) is preferably set approximately at the half of fmax. Substituting for (fup), equation (7) represents the load velocity:
If the operator pushes downwardly such that f=fmax, then the maximum downward velocity of the end-effector is:
If the operator does not push at all, then the maximum upward velocity of the end-effector is:
Therefore, by the introduction of (fup) in equation (5), one does not have to worry about the measurement of the upward human force. If S=0, the upward and downward maximum speeds are identical in magnitude. However in the presence of non-zero S, for a given load and under equal conditions, the magnitude of the maximum upward speed is smaller than the magnitude of the maximum downward speed. This is very natural and intuitive for the operator.
Going back to equation (6), it can be observed that the more force an operator imposes on the end-effector, the larger the velocity of the load will be. Using the measurement of the operator force, the controller assigns the pulley speed properly to create enough mechanical strength to assist the operator in the lifting task. In this way, the end-effector follows the human arm motions in a “natural” way. In other words the pulley, the line, and the end-effector mimic the lifting/lowering movements of the human operator, and the operator is able to manipulate heavy objects more easily without the use of any intermediary device.
I now describe some important characteristics of this device via three experiments. Substituting for p in equation 6 and rearranging its terms results in equation 10:
(1+SE)v=(GK+S)f−GK(fup)+S(W) (10)
Equation (11) shows that any change in the load weight, (ΔW), and any change in the force imposed by the operator on the end-effector, (Δf), will result in a variation of the end-effector speed, (Δv), such that:
(1+SE)Δv=(GK+S)(Δf)+S(ΔW) (11)
Experiment 1
If Δv=0 for two different objects being maneuvered (i.e. the operator maintains similar operational speeds), then:
0=(GK+S)(Δf)+S(ΔW) (12)
Rearranging the terms of equation (12) results in equation (13):
Equation (13) indicates that an increase or a decrease in the load weight (ΔW) will lead to an increase or a decrease in the upward human force, if operational speed is expected to remain unchanged. In other words, if the load weight is increased, the operator needs to increase his/her upward hand force or decrease his/her downward force to maintain the same operational speed. The term (GK/S+1) in equation (13) is the force amplification factor. The larger (K) is chosen to be, the greater the force amplification in the system will be. Consequently, if the force amplification is large, the operator “feels” only a small percentage of the change of the load weight. Essentially, the operator still retains a sensation of the dynamic characteristics of the free mass, yet the load essentially “feels” lighter. This method of load sharing gives the operator a sense of how much he/she is lifting. Inspection of equation (13) shows that, variations in load weight, (ΔW), results in a small variation in the operator force, (Δf), if (S) is a small quantity. In other words, the operator will have little feeling of the variation in the load weight if (S) is a small quantity. I will explain later how to cure this problem and give a more pronounced feeling of the load variation to the operator when (S) is a small quantity. Also, note that at very low frequencies (rather slow and smooth maneuvers), the left side of equation 13 approaches a large number. This indicates that an increase or decrease in the load weight (ΔW) will lead to a very small increase or a decrease in the upward human force (almost unnoticeable), if operational speed is expected to remain unchanged. However, at higher frequencies (rather fast and harsh maneuvers), the operator will have a more pronounced feeling of the load weight variation. In other words, if the operator is performing a relatively slow lifting movement, the additional force necessary to maintain operational speed of a heavier load versus a lighter load may be unnoticeable. But if the operator is performing a rapid lifting movement, the additional force necessary to maintain operational speed of a heavier load versus a lighter load may be more noticeable.
Experiment 2
If Δf=0, (i.e. operator decides to maintain similar forces on the end-effector for two different load weights), then equation (11) reduces to:
(1+SE)Δv=S(ΔW) (14)
This means that an increase in load weight, (ΔW), will lead to an increase of downward speed, if the operator maintains a constant hand force. Moreover an increase or decrease in the weight of the load, (ΔW), will cause a decrease or increase, respectively, in the upward end-effector speed for a given operator force on the end-effector. Essentially, the load falls faster and goes up slower if there is an increase in the load weight for a given operator force. From equations (13) and (14), it can be deduced that for an increase of load weight, the operator needs either to increase his/her upward force to maintain similar operational speed or to decrease his/her upward operational speed to maintain similar force on his/her hand. This dynamic behavior is very comforting and natural for the workers.
Experiment 3
Finally, if ΔW=0, (i.e. the load weight is constant), then:
(1+SE)Δv=(GK+S)Δf (15)
This means that an increase or a decrease in the operator downward force (Δf) will lead to an increase or a decrease, respectively, in the downward operational speed, if the load weight is unchanged. One can also interpret equation (15) differently: for a given load weight, an increase in operational speed requires more operator force. In general, the larger (K) is chosen to be, the less the operator force will be.
As
The choice of (K) also depends on the available computational power; elaborate control algorithms to stabilize the closed system of
One can arrive at the theoretical values of (G) and (S) using standard modeling techniques. There are many experimental frequency domain and time domain methods for measuring (S) and (G), which yield superior results. I recommend the use of a frequency domain technique in identifying (G) and (S). For example the book titled “Feedback Control of Dynamic Systems,” by G. Franklin, D. Powell, and A. Emami-Naeini, Addison Wesley, 1991, describes in detail the frequency-domain and time-domain methods for identifying various transfer functions.
Note that linear system theory was used here to model the dynamic behavior of the elements of the system. This allows me to disclose the system properties in their simplest and most commonly used form. Since most practitioners are familiar with linear system theory, they will be able to understand the underlying principles of this invention using mathematical tools of linear system theory (i.e. transfer functions). However, one can also use nonlinear models and follow the mathematical procedure described above to describe the system dynamic behavior.
A special problem can occur in the device when the operator pushes downward on the end-effector but the end-effector is prevented from moving downward. This situation can be explained with the help of the following example using suction cups as the load gripping means. As shown by the end-effector 14 in
The slack in the line can have far more serious consequences than slowing down the workers at their jobs; the slack line may wrap around the operator's neck or hand. As stated earlier, after the slack is produced in the line, when the operator pushes upwardly on the handle, the slack line may become tight around the operator's neck or hand creating serious or even deadly injuries. It is therefore important to ensure that the line 13 will never become slack.
In accordance with another aspect of this invention, when the operator pushes the end-effector handle 16 downward to ensure tight engagement between the suction cups 18 and the box 25, the actuator does not unwind the line 13. In other words, the device described here has the “intelligence” to recognize that the operator is simply pushing downwardly to engage the box with the suction cups 18 and he does not intend to move his hand further downward. On the other hand, if the operator pushes against the end-effector handle 16 downwardly when there is no box to resist the motion of the end-effector, the actuator of this invention will unwind the line 13 to ensure that the downward operator motion is not impeded. The assist device described here is able to differentiate between these two cases; in the first case the actuator does not unwind the line 13, while in the second case the actuator does unwind the line 13.
In order to prevent the slack in the line 13, one needs to detect the line tensile force (fR). Then, with the knowledge of the line tensile force, one needs to adjust the pulley speed so rope is not unwound unnecessarily, and therefore slack is prevented in the line. In its simplest form, to prevent slack in the line, when (fR) becomes zero the actuator and pulley must be stopped. In a more sophisticated form, to prevent slack in the line, smoothly, as the tensile force in the line, (fR), approaches zero, the pulley rotational speed must be forced to approach zero and in the limit when a zero tensile force is registered in the controller for the line, the pulley rotational speed must be forced to zero. In other words the slack in the line is prevented by appropriately reducing the pulley speed to zero when tensile force is zero.
Previously, I stated that the pulley speed depends on the signal representing the operator force only. However for the device that will not create slack in the line, the pulley speed depends on the signal representing the line tensile force in addition to the signal representing the operator force on the end-effector handle. Two methods are preferred for detecting the rope tensile force. The first method involves the direct detection of the rope tensile force while the second method estimates the rope tensile force based on measurement of the power consumed by the actuator or the electric current used in actuator. Knowledge of line tensile force can then be used to force the actuator and pulley to have zero speed so slack is prevented in the line.
In direct detection of the line tensile force, a force sensor can be used to directly measure the line tensile force.
Alternatively, a force sensor can be installed on the end-effector to measure the force associated with the load only as shown in FIG. 7B. Force sensor 61 is connected to part 44 via screw 62. A set of screws 63 is used to connect bracket 64 to force sensor 61. Suction cups 18 are connected to bracket 64 and provide an interface to box 25. In this case force sensor 61 always measures a force that is equal to the weight and inertia force due to acceleration of the load only. Signal cable 65 carries a signal representing this force to the controller 20 and therefore the force representing the weight and inertia force of the load (labeled as pL) will be identified in the controller. Measurement of pL and f in conjunction with calculation (or direct measurement) of end-effector acceleration leads to calculation of the line tensile force, (fR), according to equation (16):
where WE is the weight of the end-effector itself and is known in advance. For maneuvers with low acceleration, the force measured by the sensor is always a tensile force (e.g. a positive value) as long as the line is not slack. The moment the load and the end-effector encounter an obstruction blocking downward movement, the sensor shows a compressive force (e.g. a negative value). This change of sign during the measurement of pL flags the existence of zero line tensile force. Also note that since the load force (pL) is typically greater than operator-applied force (f), one can roughly estimate tensile force (fR) by ignoring f in equation 16. Finally for maneuvers with low acceleration, the line tensile force is approximately equal to the sum of the weight of the end-effector and the weight of the load. Here I recommend that practitioners make sure equation 16 is truly satisfied in using any signal in flagging the zero line tensile force.
A force sensor suitable for use in this invention can be selected from a variety of force sensors that are available in the market, including piezoelectric based force sensors, metallic strain gage force sensors, semiconductor strain gage force sensors, Wheatstone bridge-deposited strain gage force sensors, and force sensing resistors. Regardless of the particular type of force sensor chosen and its installation procedure, the design should be such that the force sensor allows an estimation of load force or line tensile force with reasonable accuracy.
Alternatively, one can install a force sensor directly between the actuator 12 and the rail or trolley as shown in the human power amplifier 70 of FIG. 8. Force sensor 71 measures the entire force being imposed on the rail 72 by the lifting device. A signal representing the measured force is sent to the controller 20 via a signal cable 73. When the line tensile force is zero, then the force sensor output signal represents the weight of the actuator, pulley, brake and all the components connected to the rail 72. This value can be measured and saved in the controller memory in advance. When the line tensile force is not zero, the force sensor output signal increases to include the line tensile force. Therefore, by subtracting a constant value (saved value in the memory) from the force sensor output signal, one can detect the line tensile force.
Rather than generating a signal representing the line tensile force magnitude, one might be interested in a detection device that generates a binary signal; one signal when the line tensile force is zero and another signal when the line tensile force is not zero. These devices have lower cost since they give limited information about the rope tensile force. FIG. 10A and
Alternatively, one might be interested in employing the rope tensile force at another location on the rope to detect the presence of line tensile force. This is shown in FIG. 11A and
Another preferred method of detecting the status of the line tensile force involves instrumentation of the end-effector 79 with a switch as shown in FIG. 12A and FIG. 12B. Switch 74 is preferably installed on a horizontal section of bracket 44. Bracket 75 holding two suction cups 18 is free to slide in the vertical direction relative to part 44. Slots 76 are provided in part 44 as bearing surfaces for sliding motion of part 75 relative to part 44.
A second preferred method estimates the line tensile force based on the current or energy consumed by the actuator to support the end-effector and any load connected to it on the line. The energy consumed by the system to support the end-effector and a load connected to it can include many different types of energy including electric, pneumatic, hydraulic, and other alternative types of energy. If pneumatic or hydraulic actuators are used in the system, then the load pressure in the actuator can be used to estimate line tensile force. In a specific preferred embodiment line tensile force can be determined by measuring the current in the electric actuator, since the current in the electric actuator is related to the tensile force in the line. Moreover, measuring the current used in the electric actuator is a cost-effective approach in estimating the line tensile force since measurement of electric current is usually available in many of the electronic amplifiers that drive the electric actuators. Even if the current measurement is unavailable in the electronic amplifier for the motor, one can use a clamp-on current sensor to measure the current that is used by the motor. The clamp-on current sensor can be installed on any part of the cable that powers the electric actuator 12. The clamp-on current sensor is essentially a Hall effect sensor that detects the magnetic field strength around a wire, which is proportional to the electric current flow. In a preferred embodiment of this invention, the amplifier that powers the electric motor has a built-in sensor to measure the current drawn by the electric motor of the actuator 12 and thereby estimates line tensile force.
Once the tensile force in the line is measured or estimated via the methods described above, the actuator speed must be modified according to the measured or estimated line tensile force. If the line tensile force is zero, then the input to the actuator should be modified to generate zero speed in the actuator so no extra line is unwounded. This can be done by introducing variable KM into the control block diagram, as shown in FIG. 14. If the transfer function of the controller is represented by (K), then the output of the controller (e) is:
e=KMK(f−fup) (17)
Inspection of
v=GKMK(f−fup)+S(fR) (18)
where KM is a variable such that KM=1 when the line tensile force, (fR) is non-zero. Substituting KM=1 in equation (18) results in equation 19 when the line tensile force is non-zero:
v=GK(f−fup)+S(fR) (19)
Equation 19 is similar to equation 6, and therefore it states that the behavior described previously by three experiments are still valid. When the rope tensile force (fR), is detected to be zero via any of the methods described above, (KM) must be changed to a zero value. Substituting zero for (fR) and (KM) in equation (18) results in a zero value for line speed (v). This means that no line will be unwound and slack in the line will be prevented when (fR) is detected to be zero. For instance, when an operator is moving the end-effector downwardly, either with or without a load connected to it, tensile force on the line will be a non-zero value. If the operator brings the end-effector into contact with an obstruction that results in the weight of the end-effector (and any load connected to it) being supported by that load or obstruction, tensile force on the line will go to zero. While operator-applied force may be detected and may cause line to be paid out momentarily, the instant the line is no longer taut (i.e. tensile force is zero), the operator-applied force (f) no longer contributes to line motion and slack is prevented.
Although I prefer to program the system to prevent slack by evaluating tensile force, there are other ways to prevent slack in the line. An alternative method in detecting the slack in the line during quasi static operation (low accelerations and decelerations maneuvers) involves simultaneous evaluation of operator-applied force (f) and tensile force (fR) to detect whether or not the end-effector is supported by the line. The first step is to calibrate the system before operation to evaluate the tensile force on the line derived solely from the weight of the end-effector (WE). During operation, the value of operator-applied force (f) on the end-effector and the tensile force (fR) on the line are simultaneously evaluated. Then, by subtracting the value of the operator-applied force (f) from tensile force (fR), the controller can isolate load force (p) using equation (3). Finally, by comparing the value of (p) to the stored value (WE) the controller can determine whether or not the end-effector is being supported by the line. As long as the load force (p) is approximately equivalent to the weight of the end-effector (WE), the system will know that the end-effector is neither engaged with a load nor supported by an obstruction and that it is safe to pay out line. If at any moment the load force (p) is not at least equal to the weight of the end-effector (WE), the system will know that the end-effector is supported by some obstruction and will adjust actuator speed to zero to prevent slack in the line.
The variation of (KM) as a function of (fR) is shown graphically in
To cure this problem, we use the plot of
If a force detection device gives a complete measurement of the line tensile force (e.g.
where C1 is a non-zero value, but smaller than unity, when the signal representing the operator force on the end-effector indicates an upward motion. Equation (20) results in the plot of
Slack prevention upon detection of zero line tension can be used to prevent only pay out or unreeling of line without effecting reeling in of line. Then an upward force signal from an operator can be acted on by winding line upward even though line force is zero when the upward signal occurs.
Here, I now explain how the measurement of current drawn by the actuator can be used to estimate the line tensile force if an electric actuator is used in the system. The magnitude of the torque generated by actuator 12 to turn the pulley 11 and lift the load is proportional to the current that is used in the actuator 12. This is presented by equation (21):
TT=KTI (21)
where (TT) is the total torque generated by actuator 12, (I) is the current used in actuator 12, and (KT) is a proportionality constant. The value of (KT) is usually supplied by the actuator manufacturer. (KT) Can also be measured experimentally by measuring current drawn by the actuator for some known loads on the actuator. Although equation (21) is widely reported as the true relationship between the torque generated by the actuator and electric current drawn by the actuator, depending on the quality of the power amplifier that powers the actuator, there might be some residual current measurement when no torque is generated. The power amplifier must be calibrated to take into account this residual biased current measurement. The amount of torque available to lift the load and end-effector, TL, is equal to the difference between the total torque generated by actuator 12 and the torque required to rotate pulley 11 and all rotating components of the actuator. This is presented in equation (22):
TL=TT−TP (22)
where TP is the torque required to turn pulley 11 and all rotating components of actuator 12. The torque TP is calculated in equation (23):
TP=IPα+BPω+To (23)
where:
IP=moment of inertia of all rotating components of the actuator (motor and transmission) and pulley as reflected on the motor shaft
BP=coefficient of friction of the same components above
α=angular acceleration of the electric motor shaft
ω=angular velocity of the electric motor shaft
To=constant torque due to coulomb friction in the system
Both (α) and (ω) (the angular acceleration and angular velocity of the motor shaft) can be estimated by measuring the motor shaft angle using many standard estimation techniques.
(IP) and (BP) are two parameters associated with the actuator and can be measured experimentally. (BP) represents the proportionality of the torque with the motor speed during steady state behavior (i.e. constant actuator speed). Practitioners must measure the required torque to turn the motor shaft at constant speeds. (BP) is a proportionality constant between the motor steady state speed and the required torque. (IP) represents the proportionality of the torque with the motor acceleration during high acceleration maneuvers. There are many ways of measuring (IP) and (BP) using standard parameter estimation techniques. For example, the Extended Kalman Filter is a well-known approach in parameter estimation and can be found in the control science literature. “Adaptive Control,” by Shankar Sastry and Marc Bodson, Prentice Hall, 1989, and “Time Series Analysis,” by George Box and Gwilym Jenkins, Hgolden-Day, 1976, are two good references in model estimation. Two simple experiments can measure BP and IP.
One can measure (IP) by driving the actuator with a high frequency sinusoidal input torque. At high frequencies, the torque to overcome the frictional torque is rather small in comparison with the inertial torque due to acceleration, and (IP) is proportionally constant between the motor acceleration and the motor torque. By measuring the motor shaft acceleration and torque, one can arrive at a value for (IP). To measure (BP), one can drive the actuator with constant speed. At constant speeds the torque associated with the inertial torque due to acceleration is zero and (BP) is proportionally constant between the motor speed and the motor torque. By measuring the motor shaft speed and torque, one can arrive at a value for (BP).
(To) is a small constant torque due to dry friction in the actuator (in particular in the transmission part of the electric actuator.) For high performance and well-lubricated electric actuators with little friction, (To) is a small quantity and can be neglected, otherwise it can be measured experimentally.
Substituting for (TP) from equation (23) and (TT) from equation (21) into equation (22) yields an equation for the torque required to lift the load:
TL=KTI−(IPα+BPω+To) (24)
By measuring the current in actuator 12 and the velocity and acceleration of the actuator shaft, one can calculate (TL) from equation (24). The tensile force in the wire line, (fR), is:
fR=[KTI−(IPα+BPω+To)]/R (25)
where R is the radius of pulley 11. For actuators that have gear heads with very large transmission ratios (non-back-driveable systems), the motor torque that supports the line tensile force is usually small in comparison with the motor torque that accelerates (or decelerates) the rotating parts of the actuator. In other words the current used to provide torque to maintain the line tensile force only constitutes a small portion of the current drawn by the electric motor if high transmission ratios are used. Moreover, actuators having low transmission ratios will yield a larger range for the current reading due to tensile force variation than of the actuators with high transmission ratios.
Note that equation (23) shows the basic and linear form of the dynamics of the actuator. If the actuator is designed properly and is well lubricated, equation (23) governs the dynamics of the system well. In instances requiring more precision, one might use equation (26) below, which is similar to equation (25) with the friction force modeled by a non-linear relation, g(ω):
fR=[KTI−(IPα+g(ω)+To)]/R (26)
The structure of g(ω) can be estimated experimentally using standard system identification techniques. Again, the Extended Kalman Filter is a well-known approach in parameter estimation and can be found in the control science literature.
The slack control methods described here were motivated based on an application of the device using the suction cups. Even if the human power amplifier device is not employed for use with the suction cups, the slack control described above is preferably implemented in the device. There are many situations when the operator can inadvertently push the load interface subsection onto various surrounding objects including the objects to be maneuvered. The downward residual force of the operator will cause slack in the line if the end-effector is prevented from moving downward. Therefore, it is important to prevent slack in the line at all times.
Inspection of equation (13) shows that variations in load weight, (ΔW), results in a small variation in the operator force, (Δf), if (S) is a small quantity. In other words, the operator will have little feeling about the variation in the load weight if (S) is a small quantity. If the line tensile force, (fR), is measured or estimated for slack prevention as discussed above, then using (fR), one can further improve the system performance by creating more pronounced feeling for the operator if the load weight changes. Here I explain how this improvement can be accomplished. Once the line tensile force (fR) is known, one can calculate the load force (p) from equation (3). The load force (p) can then be used as a feedback signal:
e=KMK(f−fup)+Qp (27)
where (Q) is a controller transfer function operating on the load force (p). Throughout this application (Q) might also be referred to as a force feedback transfer function since it feeds the load force back to the controller. A comparison of equation 17 with equation 27 indicates how both operator force and load forces are used as feedback signals in equation 27, but only operator force is used in equation 17.
v=GK(f−fup)+GQp+(S)(f+p) (28)
Equation (29) shows that any change in load weight (ΔW) and any change in the force imposed by the operator on the end-effector (Δf) will result in a variation of the end-effector speed (Δv) such that:
(1+SE+GQE)Δv=(GK+S)Δf+(S+GQ)(ΔW) (29)
The load force feedback transfer function, (Q), effectively increases the system overall sensitivity to load from (S) to (S+GQ). If we define the apparent sensitivity to load, S′, as:
S′=S+GQ (30)
then equation (29) can be re-written as:
(1+SE+GQE)Δv=(GK+S)Δf+(S′)ΔW (31)
Equation (31) is similar to equation (11), but the system sensitivity to load force is increased from (5) to (S′). Moreover all characteristics previously described in the three experiments are still valid. For example, the effect of this optional load feedback in Experiment 1. Equation (13), when the load feedback transfer function (Q) is used can be rewritten as equation (32):
Comparing equations (13) and (32) demonstrates that, since (S′) is larger than (S), if the operational speed is expected to remain unchanged, any increase in the load weight will lead to a greater increase in the required upward human force if the load force feedback (Q) is used. In other words, for a given increase in load weight, the operator feels more force when the load force feedback is used. The choice of load force feedback is optional. If (S) is sufficiently large to give a reasonable sensation for the variation of the load force to the operator, then one does not need to implement the load force feedback; if (S) is small, then implementation of load force feedback will improve system performance in a sense that the operator will have a more pronounced sensation of the variation of the load force.
Here I explain two simple variations of equation 27. Since operator force (f) is usually small in comparison with load force (p), then (p) in equation (27) can be replaced by (fR):
e=KMK(f−fup)+QfR (33)
Also, rather than using load force as feedback, one can use pL (the force due to the weight and inertia of the load only) if (pL) is readily available as shown in the example of FIG. 7B:
e=KMK(f−fup)+QpL (34)
The software then checks to see if the dead-man switch is pressed or not. If the dead-man switch is pressed, then the software sends the modified value of (e) to the actuator. If the dead-man switch is not pressed the software keeps the actuator in its current position using a position controller and engages the friction brake. This friction brake engages and prevents the actuator from rotating when the dead-man switch is released. This friction brake adds more rigidity to the system when the operator is not attending the device. As an additional safety feature, I prefer to have the friction brake engage any time there is a power failure.
There are many hoists that use an intermediary device such as a valve, push-button, keyboard, switch, or teach pendent to adjust the lifting and lowering speed of the object being maneuvered. For example, in a valve-controlled hoist, the more the operator opens the valve, the greater the lifting speed of the object becomes. With an intermediary device, the operator does not have any sense of how much she/he is lifting because her/his hand is not in contact with the object but is busy operating a valve or a switch. However, it is possible for the operator to activate the intermediary device (e.g. DOWN push-button) to bring a load down while the load is constrained from moving downwardly. The method of preventing slack described above can be used with these hoists without lack of generality. In other words, the switches and sensors described here (e.g.
Although particular embodiments of the invention are illustrated in the accompanying drawings and described in the foregoing detailed description, it is understood that the invention is not limited to the embodiments disclosed, but is intended to embrace any alternatives, equivalents, modifications and/or arrangements of elements falling within the scope of the invention as defined by the following claims. For example, while many of the embodiments described above use operator-applied force as the input to the system, the advantages that my system provides, particularly load weight sensitivity and slack prevention, can also benefit hoists that use valves or up-down switches to lift loads. Moreover, although specific equations have been set forth to describe system operation there are alternative ways to program the system to achieve specific performance objectives. The following claims are intended to cover all such modifications and alternatives.
This application is a Division of parent application Ser. No. 10/071,311, filed Feb. 8, 2002 by Homayoon Kazerooni, entitled Human Power Amplifier For Lifting Load With Slack Prevention Apparatus, now U.S. Pat. No. 6,622,990 which is a Division of parent application Ser. No. 09/443,278, filed Nov. 18, 1999, now U.S. Pat. No. 6,386,513, entitled Human Power Amplifier For Lifting Load Including Apparatus For Preventing Slack In Lifting Cable which parent application claims the benefit of U.S. Provisional Application Nos. 60/134,002, filed on May 13, 1999, No. 60/146,538, filed on Jul. 30, 1999, and No. 60/146,541, filed on Jul. 30, 1999. Both the parent and provisional applications are hereby incorporated by reference.
Number | Name | Date | Kind |
---|---|---|---|
2940608 | Underwood et al. | Jun 1960 | A |
3384350 | Powell | May 1968 | A |
3921959 | Ulting | Nov 1975 | A |
3940110 | Motoda | Feb 1976 | A |
4478390 | Knight et al. | Oct 1984 | A |
4557659 | Scaglia | Dec 1985 | A |
4844421 | Kojima | Jul 1989 | A |
4917360 | Kojima | Apr 1990 | A |
5270621 | Kiiski | Dec 1993 | A |
5358219 | Shenk et al. | Oct 1994 | A |
5480125 | Bitsch et al. | Jan 1996 | A |
5489032 | Mayhall, Jr. et al. | Feb 1996 | A |
5551308 | Arai et al. | Sep 1996 | A |
5850928 | Kahlman et al. | Dec 1998 | A |
5865426 | Kazerooni | Feb 1999 | A |
5915673 | Kazerooni | Jun 1999 | A |
6241462 | Wannasuphoprasit et al. | Jun 2001 | B1 |
6299139 | Kazerooni | Oct 2001 | B1 |
6386513 | Kazerooni | May 2002 | B1 |
Number | Date | Country |
---|---|---|
0428742 | May 1991 | EP |
9843910 | Oct 1998 | WO |
Number | Date | Country | |
---|---|---|---|
20030189197 A1 | Oct 2003 | US |
Number | Date | Country | |
---|---|---|---|
60134002 | May 1999 | US | |
60146538 | Jul 1999 | US | |
60146541 | Jul 1999 | US |
Number | Date | Country | |
---|---|---|---|
Parent | 10071311 | Feb 2002 | US |
Child | 10414897 | US | |
Parent | 09443278 | Nov 1999 | US |
Child | 10071311 | US |