The invention relates to an apparatus, particularly for (e.g. guidedly) unloading a user's body weight during a physical activity of said user, particularly for gait training of said user (e.g. patient). Of course, also animals, robots or any other object may be unloaded by the apparatus according to the invention. Thus, the term “user” may specifically refer to a human person, but may also mean any other object that is to unload.
Typically, in known devices of this kind, a user is statically suspended from a lift line while walking on a treadmill. Thus, the sort of physical activities (trainings) that can be performed by the user are rather limited.
Based on the above, the problem underlying the present invention therefore is to provide for an apparatus that allows for a variety of different physical activities or movements while safely supporting the user (object) at the same time in a defined manner.
This problem is solved by a device having the features of claim 1 as well as by a method having the features of claim 15.
Preferred embodiments are stated in the respective sub claims and are described below.
Further features and advantages of the invention shall be described by means of a detailed description of embodiments with reference to the Figures, wherein
According thereto, the apparatus according to the invention comprises a plurality of ropes, wherein each rope is coupled to an associated drive unit being particularly connected to a suitable rigid support structure (for example a support frame or a ceiling) and extends from the respective drive unit to a (uniquely associated) deflection device for deflecting the respective rope and then to a first free end of the respective rope, and a node being coupled to said first free ends and being designed to be coupled to said user, wherein the drive units are designed to retract and release (e.g. wind and unwind) the respective rope so as to generate a current rope force along the respective rope, which current rope forces add to a current resulting force exerted on said user via said node in order to continuously unload the user upon said physical activity. Particularly, the node can also be an extended body, e.g. a frame for instance. Particularly, the ropes must not necessarily meet in one point.
Preferably, the deflection devices are passively displaceable (i.e. can change their position in space, particularly in a guided manner), which particularly means that they do not themselves comprise a movement generating means for moving the respective deflection device actively, but can be displaced by forces induced into the deflection devices via the ropes. Particularly, the deflection devices may be connected to each other (for instance pairwise such that the respective two deflection devices can be displaced together while maintaining a constant distance between the deflections devices along the direction of displacement), and they may be guided by a guide rail or a plurality of guide rails or may be suspended from a support structure (e.g. support frame or ceiling of a room), particularly by means of a wire or another (elongated) supporting element such that their centers of mass can (passively) change position in space. Likewise, said guide rail(s) may be connected to a support structure (e.g. support frame or ceiling). A connection between two (or even more) deflection elements can be provided by means of an (e.g. separate) connecting means (element), which may be interchangeable. However, deflection devices may also be integrally connected to each other (i.e. form a single piece).
The rope forces may be controlled such that the resulting rope force is a purely vertically acting force, but may also have components in the horizontal plane so as to direct the user in a certain direction upon said physical activity (e.g. gait training). Further, not only forces can be controlled, also the position of the node. This can be used for transportation of loads (alternative application), or just to position the device above a user.
Preferably, the apparatus according to the invention is configured such that a user (or object) coupled to the node as intended can in principle perform a movement in a three dimensional space, i.e., is able to move horizontally, namely forwards backwards and also sideways, as well as vertically (e.g. climbing a staircase or some other object such as an inclined surface provided in the horizontally extending space accessible to the user being coupled to the node), and can rotate about the vertical axis, allowing walking curves or turning. Of course, the apparatus according to the invention can also be combined with known devices such as a treadmill etc.
However, in an embodiment of the invention, the deflection devices may be fixed such that they are not moving in space or along the guide rails. Particularly, the deflection devices are designed to be fixed in a releasable manner to the guide rails so that the deflection units are temporarily lockable regarding their movement along the guide rails,
According to a further embodiment of the invention, the support frame comprises an upper frame part extending along a horizontal extension plane, wherein the support frame may comprise a plurality of vertically extending leg members via which the upper frame part can be supported on a floor.
According to a further aspect of the invention, the apparatus according to the invention comprises force sensors designed to directly or indirectly measure forces in the ropes or directly on the user. Particularly, each of the ropes interacts with an associated rope force sensor for determining the currently acting rope forces and thereby the current resulting force on the user. Alternatively, the current rope forces may be detected by means of electrical current sensors interacting with the drive units (for instance such sensors may be integrated into the actuators of the winches).
Preferably, these rope force sensors provide (e,g, analog or digital) output signals corresponding to the currently acting rope forces (current rope forces).
In an embodiment of the invention, said output signals are transmitted via a processing means which digitizes said output signals to a controlling unit (also denoted as control unit) that is able to determine the currently acting rope forces by means of said output signals provided by the rope force sensors.
According to an aspect of the invention, the controlling unit is designed to control said current resulting force (on the node/user) or the position of the node either directly via said drive units or indirectly by controlling said rope forces (i.e., the individual rope forces acting on the node) in an (inner) control loop in order to adjust said current resulting force for unloading (and eventually also pulling) the user in a pre-defined manner, wherein the controlling unit is preferably designed to calculate a currently desired (reference) rope force for each of the ropes and to control the drive units accordingly such that the current rope forces as determined with help of the respective rope force sensor (or another sensor) match (approach) the respectively desired rope force at least asymptotically after a certain period of time. Of course controlling is preferably conducted continuously, wherein particularly the desired rope forces (or desired resulting force) and current rope forces (or current resulting force) may be repeatedly calculated/sensed (e.g. at a constant rate). In both cases (e.g. indirect or direct control of the resulting rope force vector), the controlling unit may be designed to control not only the resulting rope force, but also to influence the movement of the passively displaceable deflection units in a desired way at the same time. For example, in the case of four winches, the mapping from a three-dimensional resultant rope force correction to four individual winch force corrections is not unique. It represents an underdetermined system of equations. This results in freedom to influence the dynamics of the displaceable deflection units as well. For example, it can be desirable to enforce certain relative dynamics of the deflection units. In the case of two deflection units, enforcing a certain desired (for example asymptotically stable) relative displacement of the two deflection units (also denoted as trolleys) with respect to each other delivers the missing additional constraint in the equation system.
Alternatively (or in addition), the controlling unit may be designed to control the drive units such that the current (spatial) position of the node (e.g. with respect to a space-fixed coordinate system or with respect to said apparatus) approaches a (currently) desired position of the node.
In an embodiment of the invention, the apparatus comprises at least two ropes, preferably four ropes, namely a first, a second, a third and a fourth rope (preferably, but not necessarily, there is an even number of ropes). Preferably, the first rope extends from its associated drive unit towards a first deflection device, is deflected by the first deflection device and then connects to the node. Likewise, the second rope preferably extends from its associated drive unit towards a second deflection device, is deflected by the second deflection device and then connects to the node. Further, also the third rope (if present) preferably extends from its associated drive unit towards a third deflection device, is deflected by the third deflection device and then connects to the node. Finally, also the fourth rope (if present) extends from its associated drive unit towards a fourth deflection device, is deflected by the fourth deflection device and then connects to the node. Preferably, two or more deflection devices are connected to each other to form a deflection unit, so that their combined movement is governed by (multiple) rope forces acting on them.
In an aspect of the invention, each rope may be connected to the node via a spring element.
Particularly, the rope force sensors may be formed with help of such spring elements (being inserted into the respective rope) in combination with a means to measure the length of the respective spring element, e.g. a linear encoder or a wire sensor, which may be a cable-extension transducer comprising a measuring cable wound on a cylinder (spool) coupled to a shaft of a rotational sensor (e.g. a potentiometer), wherein the respective rotational sensor is connected to an end of the respective spring element and wherein the respective measuring cable is connected to another end of the respective spring element. In case the transducer's measuring cable is now unreeled or reeled from the cylinder when the respective spring element is elongated or contracted, the cylinder and shaft rotate accordingly, thus creating an (electrical) output signal of the rotational sensor proportional to the measuring cable's linear extension. Knowing the spring constant of the respective spring element, the rope force can thus be determined via the spring force of the respective spring element. In this regard, it is to be noted that any other force sensor may also be employed in order to measure the individual rope forces acting on the ropes and/or directly the resultant rope force acting on the user. It is also possible to employ sensors that measure the angles of the ropes in space, and thereby the direction of forces (e.g. by angle sensors or by inertial measurement units), or sensors that measure the forces acting between connected deflection devices of at a deflection unit, and thereby indirectly the rope forces or components thereof.
Preferably, the force sensor is located close to the node, but it can also be located closer to the respective drive unit or winch, or even be based on measurement of the electrical current of the respective drive unit (e.g. actuator driving the respective winch).
According to an aspect of the invention, the apparatus comprises at least a first guide rail (for instance in case of two ropes and two deflection devices), preferably also a second guide rail, each running along a longitudinal axis. These longitudinal axes preferably extend horizontally with respect to an operating position of the apparatus, in which the apparatus can be operated (e.g. by the user) as intended. Preferably, the guide rail(s) can be connected to said support structure (e.g. support frame or ceiling of a room, in which the apparatus is arranged). In case of a support frame, the guide rail(s) may be connected to said upper frame part. Preferably, the guide rails are arranged such that they run parallel with respect to each other. Particularly, in case of two guide rails, each guide rail may be tilted about its longitudinal axis, particularly by an angle of 45°.
Preferably, the first and the second deflection device are slidably connected to the first guide rail, so that they can slide along the first guide rail along the longitudinal axis of the first guide rail. In case of four ropes, the third and the fourth deflection device are preferably slidably connected to the second guide rail, so that they can slide along the second guide rail along the longitudinal axis of the second guide rail.
In detail, the individual deflection devices may comprise a base (e.g. in the form of a cart) via which the respective deflection device can be slidably connected to the associated guide rail, and wherein each deflection device particularly comprises an arm hinged to the base of the respective deflection device so that the respective arm can be pivoted with respect to the respective base about a pivoting axis running parallel to the longitudinal axis of the respective guide rail. Further, the deflection devices may each comprise a deflection element connected to the respective arm, around which deflection element the respective rope is laid for deflecting said rope, and wherein the respective deflection element may be formed by a roller that is rotatably supported on the respective arm, so that particularly the respective roller can be rotated about a rotation axis that runs across the longitudinal axis of the respective guide rail. Further, an arresting means may be provided for each deflection device for arresting the respective deflection device with respect to the associated guide rail, for instance when using the apparatus with a treadmill.
According to a further aspect of the invention, the first and second deflection device are connected by a connecting element (or by an integral connection), which is preferably elastic (particularly such that the restoring force is proportional to the elongation of the elastic connecting element) or non-elastic, so as to form a first deflection unit (also denoted as first trolley). Likewise, in case of four ropes, the third and the fourth deflection device are preferably connected by a further connecting element (or by an integral connection), which may also be elastic or non-elastic (see above), so as to form a second deflection unit (also denoted as second trolley), wherein particularly said connecting elements comprise the same length along the longitudinal axis of the respective guide rail. Further, the connecting elements may be designed to releasably connect the associated deflection devices, in order to be able to substitute a connecting element with a connecting element having a different length along the respective longitudinal axis. Further, the respective connecting element may be a flexible rope member or a rigid rod (particularly produced out of a carbon fibre composite).
Preferably, the drive unit of the first rope and the drive unit of the second rope face each other along the longitudinal axis of the first guide rail, wherein the first deflection unit is arranged between said drive units along the longitudinal axis of the first guide rail. In a similar manner, in case of four ropes, additionally also the drive unit of the third rope and the drive unit of the fourth rope face each other along the longitudinal axis of the second guide rail, wherein the second deflection unit is arranged between said drive units along the longitudinal axis of the second guide rail. Preferably, the drive units are arranged on the corners of a rectangle.
According to a further aspect of the invention, the drive units each comprise an actuator (particularly a servo motor) being connected to a winch, around which the respective rope is wound, particularly via a flexible coupling, wherein the respective actuator is designed to exert a torque on the respective winch via a drive axis of the respective winch so as to retract or release the respective rope, i.e. to adjust the length of the respective rope that is unwound from the winch. Optionally, the respective drive unit may comprise a brake for arresting the respective winch. Further, in order to prevent the respective rope from jumping off the associated winch or over a thread, the respective drive unit preferably comprises at least one pressing member, particularly in the form of a pressure roller that presses the respective rope being wound around the associated winch with a pre-definable pressure against the winch.
According to a further aspect of the invention, the drive units may be coupled to an actuator unloading system that is designed to compensate for the weight that is to be unloaded so that the actuators do not have to permanently exert the full torque on the winches, but are merely needed to support changes in movement or a portion thereof.
According to yet another aspect of the invention, the apparatus comprises a sensor means for determining a current state of the apparatus as well as the position of the user (node) with respect to the apparatus or a space-fixed coordinate system. Particularly, said current state is given by the lengths of the ropes being unwound from the respective winch and the positions of the deflection units along the respective guide rail.
In detail, the lengths unwound from the winches (i.e. the length of the portion of the respective rope that is unwound from the respective winch) is preferably detected by multi turn encoders being coupled to the drive axes of the winches, respectively. Other sensors (e.g. cable-extension transducers may also be employed for determining said lengths).
Further, from output signals provided by said multi turn encoders, the position of the node can also be determined by means of the controlling unit. Furthermore, the positions of the deflection units along the respective guide rails may be each captured by means of distance sensors, for example linear encoders, magnetic transducers, or optical laser distance sensors, which distance sensors—in the case of laser sensors—may be arranged at a free end of each guide rail, and whose output signals may also be digitized by a signal processing unit and further transmitted to the controlling unit.
In case of elastic connecting elements between the deflection devices, the current rope forces can be calculated with help of the positions of the deflection devices (e.g. the apparatus is designed to calculate the current rope forces or directly force components on the node with help of the positions of the deflection devices). In this case force sensors at the node may be omitted.
Further, for determining the acceleration of the node, an acceleration sensor may be provided on the node, being capable of sensing the acceleration of the node along three orthogonal axes. The node may comprise an upper and a lower node member being rotatably connected to each other, wherein the ropes are connected to the upper node member and wherein a bail (see below) may be connected to the lower node member, such that the bail can be rotated about the vertical axis. For determining an angular velocity of the node (i.e. of the upper node member), a gyroscope may be provided on the node. For sensing orientation of the node (e.g. of the upper node member), a magnetometer may be provided on the node. Furthermore, for sensing a rotation angle of said bail about the vertical axis a potentiometer may be provided on the node that measures the angle between the upper and the lower member (part) of the node. The acceleration sensor, the gyroscope, the magnetometer, and the potentiometer may provide analog or digital output signals representing the respective quantity to be sensed, wherein particularly these sensors are preferably connected to a signal processing unit that is configured to digitize the respective output signals and/or to transmit them to the controlling unit, wherein said signal processing unit is preferably connected to the node by means of a flexible data line or a wireless connection. Further, the signal processing unit may also be arranged on the node. Preferably, the acceleration sensor, the gyroscope, and the magnetometer are integrated into an inertial measuring unit (IMU) arranged at the node, which IMU preferably provides digital output signals which are particularly forwarded by the signal processing unit. In the examples above the controlling unit may be designed to further process and/or analyze said (digitized) output signals provided by the individual sensors so as to determine the respective quantity, like the lengths of the ropes being unwound from the winches, the positions of the deflection units, or the position of the node (user).
Especially, the acceleration sensor, the gyroscope, the magnetometer and the potentiometer may be used to enhance measurement of the orientation of the resultant force as well as position detection of the user and the node.
According to a further preferred aspect of the invention, the controlling unit is designed to control the drive units, particularly the torque exerted by the respective actuator onto the respective winch, particularly depending on a current state of the apparatus and/or the spatial position of the user determined with help of the afore-described sensor means, such that the current resulting force on the user approaches (matches) the desired resulting force on the user or that the current position of the user (node) approaches (matches) a currently desired position (reference) of the user (node). In particular, the controlling unit can control this current resulting force either directly, i.e. by sending control signals to the drive units as a function of the error (e.g. difference) between a (currently) desired resulting force and the current resulting force, or indirectly, by controlling the current rope forces or winch positions (e.g. the lengths of the rope portions unwound from the winches) by means of a control loop denoted as inner control loop or inner loop.
To control the current resulting force directly, without such an inner loop, the controlling unit may be configured to apply a pre-defined torque to a plurality of the drive units at the same time as a function of said error in the current resulting force, in order to provide for a fast reaction in highly dynamical situations, for instance.
Thus, in one embodiment of the present invention, in case the walking direction of the user is pointing along the longitudinal axes of the guide rails for example, the controlling unit may be designed to perform a lateral correction on the user by commanding the respective drive units to pull the ropes of the first or the second deflection unit at the same time by the same amount. Likewise, the controlling unit may be designed to perform a forward or backward correction on the user by commanding the respective drive units to pull those two corresponding ropes at the same time by the same amount that oppose each other across the longitudinal axes of the guide rails.
In an alternative embodiment, said function can be defined like this: The winch forces FW or the corresponding torques u=iFw (with i denoting the geometric relation between winch force and winch torque, e.g. the winch radius, or the winch radius multiplied by a possible additional transmission ratio) exerted onto the winches are required to fulfill the equation:
JF
W
=F
des+(KP+KI/s)(Fdes−F),
(this equation holds for the torques up to the constant factor i), where the matrix J is the 3×4 Jacobian, which only depends on the current geometry (node position, deflection unit positions), F is the current force vector on the user, and FW is the vector of winch forces FW. KP and KI are matrices containing proportional and integral gains, respectively, and s is the Laplace operator. As this is an underdetermined system of equations, there is still freedom of choice in the winch forces FW. This can be solved by adding another equation that enforces desired movement of the deflection units, for example to achieve asymptotic attenuation of the relative displacement between the two deflection units. As the relative displacement is also a function of rope forces, the system of equations can be solved.
In case of said indirect controlling said inner loop (provided by the controlling unit) is particularly used to calculate the desired rope forces or winch positions being a reference for said inner loop by requiring a desired static equilibrium, where
Particularly, the controlling unit (inner loop) is designed to control the drive units (e.g. the corresponding torques on the winches), such that the current winch positions or rope forces (which may be determined with help of the rope force sensors or positions of the deflection devices) each approach (match) the respective (currently) desired rope force or winch positions, respectively.
Further, in an embodiment of the invention, the controlling unit is configured to control the torques applied to the individual winches according to the following control law used by the controlling unit
u=i(FR,des+Kr(FR,des−FR))+uff,
with FR,desεn×1 being the calculated reference rope forces (for example calculated according to said indirect control), iε being the transmission ratio of the respective winch, Krεn×n being a positive definite rope force feedback matrix containing feedback gains, nε being the number of ropes (e.g. four), and uffεn×1 being an optional additional term going to zero in static conditions of the apparatus by means of which a pre-defined torque can be applied to a plurality of the winches at the same time (for example calculated according to said direct control).
According to a further aspect of the invention, the controlling unit may also be configured to control said torques such that a current position of the node approaches a respective desired position of the node.
Further, the afore-mentioned bail particularly comprises two opposing free ends, wherein particularly each of the two free ends comprises a receptacle (for instance in the form of a hook formed by the bail) for receiving a connection element for connecting a harness to the bail, which harness is to be put on by the user for connecting the latter to the node (via the connection elements and the bail). In a variant of the invention the connection elements are designed to be length adjustable for adapting the apparatus to the height of a user, for instance.
The signal processing unit that may connect to the acceleration sensor, the gyroscope, the magnetometer and the potentiometer (see above) may also be connected to the rope force sensors provided on the node, preferably through a (flexible) data line (cable). The signal processing unit thereby transmits output signals provided from the rope force sensors to the controlling unit, where they can be further processed.
For enabling the signal processing unit to follow the node upon movement of the node, the signal processing unit is preferably slidably connected to one of the guide rails or directly to the node. The signal processing unit may be driven by a further drive unit, wherein particularly the controlling unit is designed to also control the position of the signal processing unit along the guide rail depending on the position of the deflection units (or the node) and the signal processing unit along the guide rail, so as to maintain a constant distance between the deflection units or node and the moveable signal processing unit along the respective guide rail. The respective position of the movable signal processing unit may be sensed with a suitable sensor and compared to the current position of the node by the controlling unit.
The problem according to the invention is further solved by a method for controlling an apparatus for unloading, particularly the body weight of a user during a physical activity, as claimed in claim 15, wherein the method particularly uses an apparatus according to the invention.
The method according to the invention may comprise the steps of:
Preferably, the deflection devices are grouped in pairs (or may comprise even more deflection devices), wherein the deflection devices of each pair are designed to be displaced together (i.e. maintaining a constant distance with respect to each other while being passively displaced), which pairs are denoted as deflection units. Particularly at least two ropes are provided that are deflected by a first deflection unit that may be displaceable as a function of the rope forces in the deflected ropes along a first direction (x-direction). Preferably, four ropes are provided, wherein the first and the second rope are deflected by the first deflection unit and the third and fourth rope are deflected by a second deflection unit being passively displaceable along the first direction (parallel to the first deflection unit).
Particularly, said current state is defined by the lengths of the ropes being unwound from the respective winch and the position(s) of the deflection unit(s) along the first direction.
Furthermore, the current torques for the winches are preferably calculated either directly based on the current error (e.g. difference) between a desired resulting force on the user and the current resulting force on the user, or indirectly, by controlling the individual rope forces or winch positions (e.g. lengths of the portions of the ropes being unwound from the respective winch) in a control loop denoted as inner control loop or inner loop (see also the corresponding description above). In the latter case, the desired rope force for each of the ropes is preferably determined from a desired static equilibrium, where
Here, the controlling unit is preferably designed to control the drive units (command torques to the drive units) such that the current rope forces approach the calculated desired rope forces.
In case of direct control of the force on the user, the method according to the invention may provide for applying a pre-defined torque to a plurality of the winches at the same time, particularly in order to let the current resulting force F on the user approach the desired resulting force Fdes on the user faster.
Particularly, in an embodiment of the present invention, the torques u (applied to the individual winches) may be determined according to
u=iF
R,des
+K
r(FR,des−FR)+uff
as already discussed above, where FR,des are the desired rope forces (references), FR are the current rope forces, Kr is a matrix containing feedback gains and uff is an optional additional term (being zero in static conditions of the apparatus) by means of which a pre-defined torque can be applied to a plurality of the winches at the same time, so as to achieve the control goal as fast as possible in dynamic situations (e.g. fast movements of the node/user).
According to a further embodiment, based on e.g. the current operation mode and e.g. current sensor information, the controlling unit may generally be designed to determine a desired force Fdes that should act on the user, or a desired position of the node. For example, the desired force could be a constant unloading force in vertical direction that is rendered as long as the user does not fall. When a fall is detected (based on current sensor information), the desired force is calculated such that it compliantly catches the user and stops the fall. In another example, the force could be a guiding force that helps the user follow a particular movement pattern (like a force that pulls the user forward in walking direction), or it could be a perturbing or resisting force that makes a motor task more difficult for the user. The desired force or position of the node can also be commanded by a human operator of the apparatus, e.g. by means of a software interface or a remote control unit.
In yet another embodiment, said torques are preferably calculated in function of an error between the desired force Fdes and the current force F on the user and/or in function of an error between said desired and current movements of the deflection units (35, 36), particularly via a proportional-integral controller, wherein particularly said function is defined by the equations:
JF
W
=F
des+(KP+KI/s)(Fdes−F),
r′
T
F
W
=k
T(ΔxT,des−ΔxT)
where the matrix J is the 3×4 Jacobian that describes the current geometric relation between rope forces and node force vector, F is current force on the user, and FW is the vector of winch forces FW being proportional to said torques u. KP and KI are matrices containing proportional and integral gains, respectively, s is the Laplace operator, r′ is a vector that describes the geometric relation between rope forces and forces that produce displacement of the deflection units, ΔxT is the relative displacement of the deflection units with respect to each other, ΔxT,des is the desired relative displacement of trolleys, and kT is a scalar proportional control gain. Regarding controlling it is also referred to the corresponding descriptions above.
It is to be noted that the use of the apparatus as described herein is not limited to medical uses, but may also be employed in any other field of transportation and unloading of objects, particularly in the field of construction.
The apparatus 1 comprises a suitable support structure (e.g. support frame) 10 having an upper frame part 100 being supported by a plurality of vertically extending leg members 101, such that the leg members 101 confine (together with the upper frame part 100) a three-dimensional working space 3, in which the user 4 can move along the horizontal x-y-plane (as well as vertically in case corresponding objects, e.g. inclined surfaces, staircases etc., are provided in the working space 3). Alternatively, a ceiling of a room can be used as a support structure. Said working space 3 then extends below said ceiling.
The upper frame part 100 is formed by two parallel longitudinal members 102 extending along the x-direction and five parallel cross members 103 extending along the y-direction and connecting the two longitudinal members 102. The longitudinal and cross members 102, 103 span the horizontally extending upper frame part 100.
A first and a second guiding rail 21, 22 are attached to the support structure 10 (e.g. to the upper frame part 100), wherein the two guide rails 21, 22 each extend along a respective longitudinal axis L, L′. The first guide rail 21 is designed to slidably support a first and a second deflection device 31, 32 as shown in
As indicated in
Each deflection unit 35, 36 is configured to deflect two ropes 41, 42, 43, 44 as shown in
The mounting positions D of the individual drive units 510, 520, 530, 540 are indicated in
In
In detail, as shown in
The drive units 510, 520, 530, 540 interact with a sensor means (that may consist of several individual sensors, see above) that is adapted to provide output signals that represent (or can be transformed into) the length sw of (a portion of) the respective rope 41, 42, 43, 44 that is currently unwound from the respective winch 511, 521, 531, 541, the position sT of the deflection units 35, 36 along the x-direction (i.e. along the respective guide rail 21, 22), as well as the position n of the node 60 (user 4).
As shown in
Further, the node 60 comprises—with respect to an operating state of the apparatus 1—an upper node member 61, which is connected to the cable-extension transducers 710, 720, 730, 740, and a lower node member 62 being rotatably supported on the upper node member 61, so that a horizontally extending bail 80 being coupled to the lower node member 62 can be rotated about a vertical axis z.
The node 60 may comprise an acceleration sensor 90 as well as a gyroscope 91 and a potentiometer 92 for sensing the acceleration of the node 60 along three orthogonal axes (for instance x, y and z), for sensing the angular velocity of the node 60 and for sensing a rotation angle of the bail 80 about said vertical axis z with respect to the upper node member 61. Further, the node may comprise a magnetometer 190 for sensing orientation of about the three axes. The acceleration sensor 90, the gyroscope 91, and the magnetometer 190 may be integrated into an integrated measuring unit (IMU) 290 providing digital output signals of the respective sensor.
Corresponding output signals representing these quantities (or quantities that can be used to determine the desired quantities) are transmitted—together with the output signals from the rope force sensors 710, 720, 730, 740—via a flexible data line (cable) 93 extending from the node 60 to a movable signal processing unit 94 as shown in
The signal processing unit 94 can be driven by a further drive unit, wherein preferably the movement of the signal processing unit (also called signal box) 94 is controlled by a controlling unit (not shown), to which the signal processing unit 94 is connected so that the controlling unit is able to use the output signals transmitted by the signal processing unit 94 for controlling of the apparatus 1. Particularly, the controlling unit is configured to control the movement of the signal processing unit 94 such that the distance between the deflection units 35, 36 or node 60 and the signal processing unit 94 along the x-direction is constant. Particularly, the movement of the signal processing unit 94 along the respective guide rail 21, 22 (x-direction) is controlled such by the controlling unit that the signal processing unit is always arranged behind the node 60 (user 4) with respect to the current walking direction of the user 4.
As shown in
Concerning control of the current resulting force F that is exerted onto the node 60, there are many ways in classical control theory how to approach tracking problems for nonlinear systems as the present one. For example, the system could be linearized and an optimal controller could be derived. In the following, controlling is described without loss of generality for four ropes, but may also be conducted analogously for two ropes or any larger number of ropes.
One idea is to control said output force vector F indirectly, by controlling individual rope forces subsumed in the vector FRε4 in an inner loop. These rope forces FR are functions of both the device states s, i.e., the lengths sW of the unwound (portions of the) ropes 41, 42, 43, 44 (note, that the individual sW of the ropes 41, 42, 43, 44 shown in
F
R
=h(s,w)
The three-dimensional force vector F acting on the subject 4 is given by the sum of the four individual rope force vectors FR. Therefore, there would potentially be an infinite number of solutions for rope force vectors that give the same resulting force.
However, as stated above, the winch forces (torques) do not only affect rope forces, they also affect trolley (deflection unit) movement.
This can be used to formulate two additional control goals, which are a) to find a solution that is also valid in static conditions (Then, the sum of forces acting on the trolleys 35, 36 will be in equilibrium, and the position can be held), and b) to have the trolleys 35, 36 move in a similar way, so that they are always at the same position x (c.f.
The first goal can be formulated mathematically by requiring that in static conditions, where all speeds and accelerations are zero,
ds
W
/dt=0,d2sW/dt2=0,dxT/dt=0,d2xT/dt2=0,dw/dt=0,d2w/dt2=0,
the correct force is applied on the user (object) 4, i.e. the current resulting force (output force) F of the controlling unit (controller) matches the desired resulting force Fdes meaning equation F=Fdes is fulfilled. The requirement is found by force equilibrium on the two trolleys 35, 36.
In summary, this yields 3 equations from force equilibrium on the node 60, further 2 equations from force equilibrium on the two trolleys 35, 36 in x-direction, and one equation commanding the two trolleys 35, 36 to be at the same position xT in x-direction. These 6 equations can be used to find the four desired rope forces FR,des and the two trolley positions.
Appropriate measures (for example saturations) can be taken to make sure the ropes 41, 42, 43, 44 always remain in tension.
The desired rope forces FR can then be used as a reference for the individual feedback loops for each winch 511, 521, 531, 541.
For example, the control law could be
u=i(FR,des+Kr(FR,des−FR))+uff,
with FR,des being the calculated desired (reference) rope forces, i the transmission ratio of the actuator-winch unit (drive unit) 510, 520, 530, 540, Krε4×4 being a positive definite rope force feedback matrix containing feedback gains, and uff denoting potential additional terms that go to zero in static conditions. The first two terms will ensure that the system asymptotically approaches the desired forces on the person 4, at least when the person 4 stands still.
In order to make the system react fast in dynamic conditions, the terms uff can be used. One possibility is to use a type of “synergy control”, where actuators 512, 522532, 542 work in groups. For example, using a diagonal feedback matrix KCε3×3, a virtual input vector u* in Cartesian space can be generated:
u*=K
C(Fdes−F)ε3
This three-dimensional vector u* then needs to be mapped to the four winch torques u by a function ρ:
u=ρ(u*).
Similar to human muscles, this function could encode synergies, which lump actuators 512, 522, 532, 542 into functional groups.
For example, if the force component acting on the user 4 in vertical direction z is too low compared to the reference, so u*z>0, all four winches 511, 521, 532, 541 could be pulling equally, which means that the vertical component u*z would simply be commanded to all winches 511, 521, 532, 541 equally. The component in x-direction, which is parallel to the guide rails 21, 22, could be distributed such that the winches on one side (depending on the sign, these could be 511 and 531, cf.
According to another embodiment illustrated in
A state vector is assembled that describes the current positions and velocities of the device components. Given the current position vector w of the human, the configuration is fully described by be the length of ropes that have been released from each winch 511, 521, 531, 541 subsumed in the vector sWε4:
s
W=(sasbscsd)T, (1)
and by the positions of the deflection units 35, 36, subsumed in the vector xTε2:
x
T=(xT,abxT,cd)T. (2)
The state vector sε12 contains these variables and their derivatives:
s=(sWTxTT{dot over (s)}WT{dot over (x)}TT)T (3)
We now assume that the force vector Fn on the user (“n” stand for the node; the force vector is also denoted shortly F) acting on the user 4 is to be controlled while the user moves. Node position is n=(nx,ny,nz)T. Cable (i.e. rope) forces are subsumed in the vector Frε+ (note, that the rope forces are also denoted as FR) with
F
r=(FaFbFcFd)T (4)
and the Cartesian force vector Fnε3 on the user 4 is
F
n=(FnxFnyFnz)T (5)
Force equilibrium on the node 60 maps cable forces to forces Fn acting on the user 4:
F
n
=J(xT,n)Fr. (6)
The mapping J can be computed in an efficient way by first summing the rope forces within the two planes spanned by the ropes, via the matrix R, to obtain the x component and the force components Fab and Fcd, and then converting these to Cartesian space via the matrix S:
Current deflection unit 35, 36 positions xT and the node position n define the angles in these matrices.
The movement of the deflection units 35, 36 is governed by the equations of motion:
m
T
{umlaut over (x)}
T
=TF
r (10)
with
The equations of motion for the winches 511, 521, 531, 541 are given by:
m
W
{umlaut over (s)}
W
=F
r
−F
W, (12)
with the winch actuator forces FW (e.g. the torques multiplied by a transmission ratio i). The rope forces are a linear function of the spring deflections of the springs 71, 72, 73, 74 (cf.
F
r
=c
F(−sW+GxT−l) (13)
with the matrix
and the vector l containing the distances from the four deflection devices 31, 32, 33, 34 to the node 60 (vector n). To avoid offsets in these equations, the rope lengths sW are defined appropriately.
Even without force sensors, it is still possible to implicitly measure the force in x direction, by means of deflection device 31, 32, 33, 34 positions. Assuming that the mass of the deflection devices 31, 32, 33, 34 is negligible, their positions are determined by the components of the cable forces acting in x direction: Static equilibrium on the deflection device 31, 32, 33, 34 is given by setting (10) to zero. Combined with (6), the force in x direction is then given by:
These angles are calculated based on geometry only (rope lengths, deflection device positions). To keep the estimation robust, Fab and Fcd are taken preferably as the desired, not the actual values, even if force sensors are available.
Now, an ideal controller would command actuator torques u, so that the outputs match the desired force vector Fn,des that acts on the subject (also denoted as user) 4:
regardless of the movement of the subject 4. Preferably, a force controller (provided by the controlling unit) is used in Cartesian space, which commands a Cartesian force vector CFfc that is to be realized by the winches. This force is calculated by PI (proportional-intergral) control and feedforward of the reference:
with s being the Laplace operator, KP being a positive definite matrix of proportional gains, and KI being a positive definite matrix of integral gains.
Cartesian forces need to be mapped to winch forces Fw, which is the inverse problem of (6). Given that there are four winch forces and only three node force components, there are multiple solutions to (6) with a given node force. If the deflection devices 31, 32, 33, 34 were not movable, quadratic programming could be used to find the minimal cable forces that fulfill the constraints. However, in the current system, the rope forces do not only influence the output force vector, but they also influence the movement of the deflection devices 31, 32, 33, 34, according to (10). In turn, the position of the deflection devices 31, 32, 33, 34 defines the polygon of applicable forces.
Therefore, instead of minimizing rope forces, one may take deflection device dynamics into account to solve the rank deficiency in the inverse mapping of (6). The idea is that rope forces are applied in such a way that the deflection devices 31, 32, 32, 34 stay together, leading to a polygon with rectangular base. This behavior is enforced by the law:
with the positive constant kT.
With (10), this yields
Using this additional constraint on the forces, the control law maps desired forces in Cartesian space to winch forces, such that they work in synergy:
with the desired reference force in Cartesian space Fn,des and the modified mapping matrix
With
r′
T=(1−cos φa cos φb−1 cos φc−1 1−cos φd). (22)
In the above, one may calculate the force in x direction as a linear combination (for example the mean value) of spring-based measurement and deflection device-based measurement.
Number | Date | Country | Kind |
---|---|---|---|
12154778.0 | Feb 2012 | EP | regional |
This is a continuation of U.S. patent application Ser. No. 14/377,507, filed Aug. 8, 2014, which is the US National Stage of International Application No. PCT/EP2013/052623, filed Feb. 9, 2013, which in turn claims the benefit of European Patent Application No. 12154778.0, filed Feb. 9, 2012. The content of the foregoing patent applications is incorporated by reference herein in its entirety.
Number | Date | Country | |
---|---|---|---|
Parent | 14377507 | Aug 2014 | US |
Child | 15796814 | US |