GRAVITY BALANCING DEVICE FOR REHABILITATION ROBOT ARM

Abstract

The present invention discloses a gravity balancing device for a rehabilitation robot arm, and belongs to the field of rehabilitation robots. The gravity balancing device includes a shoulder joint connecting member, an upper arm connecting member and a gravity balancing assembly; the shoulder joint connecting member and the upper arm connecting member are pivotally connected according to the human body bionic structure to simulate the rotational movement of the upper arm of the human body around the shoulder joint; the gravity balancing assembly includes a plurality of springs, wire ropes and guide pulleys, the wire ropes connect the springs to the shoulder joint connecting member and the upper arm connecting member, the spring tension is used to balance the gravity of the arm, and the guide pulleys are used to change the force directions of the wire ropes, thereby saving space and making the device structure more compact. Further, by locking different guide pulleys, the arm gravity can be still balanced by the spring tension after switching of the rehabilitation robot between the left and right hand training modes, thereby ensuring that the robot can still work normally after the training mode is switched.

Claims

1. A gravity balancing device for a rehabilitation robot arm, characterized by comprising: a shoulder joint connecting member, an upper arm connecting member and a gravity balancing assembly; the shoulder joint connecting member and the upper arm connecting member are pivotally connected according to the human body bionic structure to simulate the rotational movement of the upper arm of the human body around the shoulder joint; the gravity balancing assembly includes a first tension unit, a second tension and a locking mechanism; the first tension unit includes a guide pulley A as well as a wire rope A, a spring A, a wire rope B, a guide pulley X, a wire rope C, a spring B, a wire rope D, a spring C and a wire rope E that are fixedly connected in sequence; the wire rope B and the wire rope C are respectively connected to two ends of the guide pulley X in the radial direction; the second tension unit includes a guide pulley A as well as a wire rope A, a spring A a wire rope B, a guide pulley X, a wire rope C, a spring B, a wire rope D, a spring C and a wire rope E that are fixedly connected in sequence, the respective members of the second tension unit and the respective members of the first tension unit are arranged in one-to-one correspondence, have the same specification and are symmetrically distributed; the wire rope B and the wire rope C are respectively connected to two ends of the guide pulley X in the radial direction; head ends of the wire rope A and the wire rope A are fixed on the shoulder joint connecting member; tail ends of the wire rope E and the wire rope E are fixed on the upper arm connecting member and symmetrically distributed on two sides of the rotation axis of the upper arm connecting member; the guide pulley A and the guide pulley A are fixed pulleys, and the wire rope D is connected to the spring B and the spring C after passing by the guide pulley A; the wire rope D is connected to the spring B and the spring C after passing by the guide pulley A; the guide pulleys A, A, X, X are all disposed on the shoulder joint connecting member; the locking mechanism is used to independently lock one of the guide pulley X and the guide pulley X when the robot arm is switched between the right hand training mode and the left hand training mode.

2. The gravity balancing device for a rehabilitation robot arm of claim 1, characterized in that the first tension unit further includes a guide pulley B, and the second tension unit further includes a guide pulley B; the guide pulley B and the guide pulley B are both fixed on the upper arm connecting member, the tail end of the wire rope E and the tail end of the wire rope E are fixedly connected to the guide pulley B and the guide pulley B, respectively.

3. The gravity balancing device for a rehabilitation robot arm of claim 1, characterized in that the guide pulley X includes a guide pulley C and a guide pulley D that are symmetrically and coaxially distributed on front and back sides of the shoulder joint connecting member to rotate synchronously; the wire rope A, the spring A and the wire rope B are located on the same side of the guide pulley D, and the wire rope C, the spring B, the wire rope D, the spring C and the wire rope E are located on the same side of the guide pulley C; the wire rope B is connected to the guide pulley D, and the wire rope C is connected to the guide pulley C (15); the guide pulley X includes a guide pulley C and a guide pulley D that are symmetrically and coaxially distributed on front and back sides of the shoulder joint connecting member to rotate synchronously; the wire rope A (32), the spring A and the wire rope B are located on the same side of the guide pulley C, and the wire rope C, the spring B, the wire rope D, the spring C and the wire rope E are located on the same side of the guide pulley D; the wire rope B is connected to the guide pulley C, and the wire rope C is connected to the guide pulley D.

4. The gravity balancing device for a rehabilitation robot arm of claim 1, characterized in that the first tension unit further includes a guide pulley E, a guide pulley F and a guide pulley G; the guide pulley F and the guide pulley G are located in the same plane and cooperate to clamp the wire rope E, the axis of the guide pulley E is perpendicular to the wire rope E and the axis of the guide pulley G; the wire rope E is connected to the upper arm connecting member after being guided by the guide pulley E, the guide pulley F and the guide pulley G; the second tension unit further includes a guide pulley E, a guide pulley F and a guide pulley G that are arranged in one-to-one correspondence with the guide pulley E, the guide pulley F and the guide pulley G of the first tension unit in the same manner; the guide pulleys E, F, G, E, F and G are all fixed pulleys.

5. The gravity balancing device for a rehabilitation robot arm of claim 1, characterized in that the springs A and A have the same stiffness, which is set to K1, and the springs B, C, C and B have the same stiffness, which is set to K2, K1 is much smaller than K2.

6. The gravity balancing device for a rehabilitation robot arm of claim 5, characterized in that sizes of the guide pulleys and the springs are constrained as follows: $\{\begin{array}{c}{x}_1\frac{.Math..Math.d}{2}.Math.\\ l_1+x_1{d}_1.Math.\\ 2.Math.x_2\frac{.Math..Math.d}{2}.Math.\\ 2.Math.x_2+l_2{d}_2.Math.\\ \frac{.Math..Math.d}{2}+l_2{d}_2.Math.\end{array}$ where l.sub.1 represents the original length of the springs with the stiffness K.sub.1, x.sub.1 represents the maximum elongation amount of the springs with the stiffness K.sub.1, l.sub.2 represents the original length of the springs with the stiffness K.sub.2, x.sub.2 represents the maximum elongation amount of the springs with the stiffness K.sub.2, d represents the diameter of the shoulder joint, d.sub.1 represents the distance between the head end of the wire rope A and the guide pulley D and the distance between the head end of the wire rope A and the guide pulley C, d.sub.2 represents the distance between the guide pulley C and the guide pulley A and the distance between the guide pulley A and the guide pulley D.

7. The gravity balancing device for a rehabilitation robot arm of claim 1, characterized by further comprising a motor assembly A, a motor assembly B and a motor assembly C; the motor assembly B is mounted on a pivot joint of the shoulder joint connecting member and the upper arm connecting member to achieve shoulder joint flexion/extension freedom; the motor assembly A is mounted at an end of the shoulder joint connecting member to achieve shoulder joint abduction/adduction freedom; the motor assembly C is mounted at an end of the upper arm connecting member to achieve elbow joint internal rotation/external rotation freedom; rotation axes of the motor assembly A, the motor assembly B and the motor assembly C intersect at the same point.

8. The gravity balancing device for a rehabilitation robot arm of claim 1, characterized in that a wire rope groove is provided at a pivot end of the upper arm connecting member to limit the position of the wire rope E and the wire rope E during the rotation.

Description

BRIEF DESCRIPTION OF THE DRAWINGS

[0029] FIG. 1 is a schematic front view of the overall structure of the gravity balancing device according to the present invention;

[0030] FIG. 2 is a schematic front view of the structure of the gravity balancing assembly in FIG. 1;

[0031] FIG. 3 is a partial enlarged view of the portion I in FIG. 2;

[0032] FIG. 4 is a schematic rear view of FIG. 2;

[0033] FIG. 5 is a schematic diagram showing the principle of the counterweight mechanism in the state of FIG. 2;

[0034] FIG. 6 is a schematic diagram showing the principle of the counterweight mechanism when the upper arm connecting member in FIG. 2 is lifted to a horizontal position;

[0035] FIG. 7 is a schematic diagram showing the size relation in FIG. 5; and

[0036] FIG. 8 is a schematic structural diagram of the rehabilitation robot after being switched from the right hand training mode to the left hand training mode.

DETAILED DESCRIPTION OF THE EMBODIMENTS

[0037] For clear understanding of the objectives, features and advantages of the present invention, detailed description of the present invention will be given below in conjunction with accompanying drawings and specific embodiments. It should be noted that the embodiments described herein are only meant to explain the present invention, and not to limit the scope of the present invention. Furthermore, the technical features related to the embodiments of the invention described below can be mutually combined if they are not found to be mutually exclusive.

[0038] As shown in FIG. 1, a gravity balancing device for a rehabilitation robot arm comprises a gravity balancing assembly, motor assemblies and connecting members.

[0039] The motor assemblies includes a shoulder joint abduction/adduction freedom motor assembly A1, a shoulder joint flexion/extension freedom motor assembly B2 and an elbow joint internal rotation/external rotation freedom motor assembly C3; the connecting members includes a shoulder joint connecting member 4 and an upper arm connecting member 6; and the specific structure of the gravity balancing assembly is shown in FIGS. 4 and 5. As shown in FIG. 1 and FIG. 3, in order to switch the rehabilitation robot from the right hand training mode to the left hand training mode, the shoulder joint abduction/adduction freedom and the shoulder joint flexion/extension freedom are required to be rotated by 180, and after the mode switching, the device of the present invention can continue to balance the gravity of the robot arm. The device of the present invention provides a counterweight force for the shoulder joint flexion/extension freedom, and thus only three degrees of freedom of the shoulder joint and its adjacent joint are listed, omitting other degrees of freedom of the rehabilitation robot.

[0040] As shown in FIG. 2 to FIG. 4, the gravity balancing assembly 5 includes a guide pulley E7, a guide pulley F8, a guide pulley G9, a guide pulley B10, a guide pulley B11, a guide pulley G12, a guide pulley F13, a guide pulley E14, a guide pulley C15, a guide pulley A22, a guide pulley A24, a guide pulley D28, a guide pulley D36, a guide pulley C37, a wire rope C16, a wire rope E17, a wire rope E18, a wire rope D20, a wire rope D23, a wire rope C27, a wire rope B29, a wire rope A31, a wire rope A32, a wire rope B35, a spring B19, a spring C21, a spring C25, a spring B26, a spring A33, a spring A34 and a wire rope fixing member 30.

[0041] Further, the springs A33 and A34 have the same stiffness which is assumed to be K.sub.1, and the springs B19, C21, C25, B26 have the same stiffness which is assumed to be K.sub.2, K.sub.1 being much smaller than K.sub.2; the guide pulley C15 and the guide pulley D36 are fixed on the same shaft and can rotate synchronously. The guide pulley D28 and the guide pulley C37 are fixed on the same shaft and can rotate synchronously. The wire rope fixing member 30 is fixed on the shoulder joint connecting member 4, the wire rope A31 has one end fixedly connected to the wire rope fixing member 30 and the other end fixedly connected to the springs A33, the wire rope A32 has one end fixedly connected to the wire rope fixing member 30 and the other end fixedly connected to the springs A34, and the other ends of the springs A33 and A34 are fixedly connected to the guide pulleys D36 and C37 through the wire ropes B29 and B35, respectively; the wire rope C16 has one end fixedly connected to the guide pulley C15 and the other end fixedly connected to the spring B19, the wire rope D20 has one end fixedly connected to the spring B19 and the other end fixedly connected to the spring C21 after passing by the guide pulley A22, the wire rope E18 has one end fixedly connected to the spring C21 and the other end fixedly connected to the guide pulley B10 after passing by the guide pulleys E14, F13 and G12 and a wire rope groove at the upper end of the upper arm connecting member 6; the wire rope C27 has one end fixedly connected to the guide pulley D28 and the other end fixedly connected to the spring B26, the wire rope D23 has one end fixedly connected to the spring B26 and the other end fixedly connected to the spring C25 after passing by the guide pulley A24, and the wire rope E17 has one end fixedly connected to the spring C25 and the other end fixedly connected to the guide pulley B11 after passing by the guide pulleys E7, F8 and G9; the guide pulleys G9 and G12 are respectively used to prevent the wire rope from coming out of rope grooves of the guide pulleys F8 and F13.

[0042] In this embodiment, through forming holes in the guide pulley C15 and the shoulder joint connecting member 4, the guide pulleys C15 and D36 are locked by inserting the pin into the corresponding holes of the guide pulley C15 and the shoulder joint connecting member 4, and the guide pulleys C15 and D36 are unlocked by unplugging the pin. The guide pulleys D28 and C37 are locked in the same way. Of course, in other embodiments (not shown), locking or unlocking may also be performed by means of a brake, electronic control or the like.

[0043] As shown in FIGS. 2-4, in the initial position, the guide pulleys C15 and D36 are locked and cannot be rotated, and the guide pulleys D28 and C37 can be rotated freely; the springs C25, 26, 33 and 34 are in an original length state, the springs B19 and 21 are in a stretched state, and the springs provide a positive moment of motion for the shoulder flexion/extension joint to balance a part of the gravity of the robot arm. When the shoulder flexion/extension joint is rotated by 90 in the forward direction to reach the limit of human motion, the springs B19 and C21 are shortened but still in a stretched state, and the springs C25, B26 and A34 are elongated and in a stretched state. Since the stiffness K.sub.1 of the spring A34 is much smaller than the stiffness K.sub.2 of the springs C25 and B26, the deformation is mainly concentrated on the spring A34, and the lengths of the springs C25 and B26 are substantially unchanged. Therefore, it can be considered that the springs C25 and B26 are still in the original long state, and at this time, the springs still provide a positive moment.

[0044] Specifically, the working principle is shown in FIG. 5 and FIG. 6. Two pulleys fixed to ends of the wire ropes are symmetrically attached to the bracket of the upper arm. FIG. 5 shows the initial state of the counterweight mechanism in operating, and FIG. 6 shows the intermediate state of the counterweight mechanism in operating.

[0045] The counterweight mechanism provides the counterweight torque by the tension difference between the upper and lower wire ropes, thereby balancing the gravity of the robot arm. The upper and lower wire ropes of the counterweight mechanism have the same length, and springs connected in series to the wire ropes are the same, each including a small spring and two large springs. The small spring has a low stiffness, so that a large elongation amount can be generated by a small tensile force; and in contrast, the large spring has a large stiffness, so that only a small elongation amount can be generated by a large tensile force. When the counterweight mechanism operates, it is necessary to lock the rear guide pulley of the upper wire rope to prevent it from rotating, and to enable the rear guide pulley of the lower wire rope to rotate freely. When the upper wire rope is subjected to a tensile force, since the front guide pulley and the rear guide pulley are fixedly connected and cannot be rotated, the upper large springs are stretched, and the small spring remains the original length. When the lower wire rope is subjected to a tensile force, since the front and rear guide pulleys can be rotated and the small spring has a low stiffness, the lower large springs are hardly stretched, while the small spring is stretched significantly.

[0046] In the initial state shown in FIG. 5, since the upper wire rope is subjected to a tensile force, the two large springs K.sub.2 are simultaneously elongated, and the positive tensile force acting on the shoulder flexion/extension joint is

[00002]$F_1=\frac{K_2}{2}.Math.d_{\max },$

where d.sub.max represents the maximum elongation amount of the spring. Since the lower wire rope is not subjected to a tensile force, the negative tensile force acting on the shoulder flexion/extension joint is F.sub.2=0. At this time, F.sub.1F.sub.2. Therefore, the counterweight mechanism applies a positive moment to the joint to balance the gravity of the robot arm.

[0047] In the intermediate state shown in FIG. 6, similarly, the upper large springs K.sub.2 are elongated, and the positive tensile force acting on the joint is

[00003]$F_1=\frac{K_2}{2}.Math.d_2,$

where d.sub.2 represents the elongation amount of the spring. When the lower wire rope is subjected to a tensile force, since the stiffness difference between the large and small springs is too large, the large springs K.sub.2 approximately maintain the original length, and the small spring K.sub.1 is elongated, so that the negative tensile force acting on the shoulder flexion/extension joint is F.sub.2=K.sub.1d.sub.2. Since K.sub.2K.sub.1, F.sub.1F.sub.2. Therefore, the counterweight mechanism still applies a positive moment to the joint to balance the gravity of the robot arm.

[0048] It can be seen from the above principle analysis that after switching of the robot arm between the right hand training mode and the left hand training mode, the locking state and rotating state of the rear guide pulleys are adjusted, and the operating mode of the counterweight mechanism is the same as that described above, and will not be described again.

[0049] In designing of the size, as shown in FIG. 7, there are constraints in the following formula (1):

[00004]$\begin{array}{cc}\{\begin{array}{c}{x}_1\frac{.Math..Math.d}{2}.Math.\\ l_1+x_1{d}_1.Math.\\ 2.Math.x_2\frac{.Math..Math.d}{2}.Math.\\ 2.Math.x_2+l_2{d}_2.Math.\\ \frac{.Math..Math.d}{2}+l_2{d}_2.Math.\end{array}& \left(1\right)\end{array}$

where l.sub.1 represents the original length of the small springs (i.e., the springs with the stiffness K.sub.1, the same below), x.sub.1 represents the maximum elongation amount of the small springs, l.sub.2 represents the original length of the large springs (i.e., the springs with the stiffness K.sub.2, the same below), x.sub.2 represents the maximum elongation amount of the large springs, d represents the diameter of the shoulder joint, d.sub.1 represents the distance from the rope fixing block to the rear guide pulley, d.sub.2 represents the distance from the front fixed pulley to the guide pulley of the corresponding tension unit (i.e., the distance between the guide pulley C15 and the guide pulley A22, and the distance between the guide pulley A24 and the guide pulley D28).

[0050] Due to the limited space of the robot arm, the sizes are tentatively designed as follow: d=55 mm, d.sub.1=154 and d.sub.2=188 mm. In order to balance the gravity of the robot arm as much as possible, the following two springs were selected, whose parameters are as shown in Table 1 below.

TABLE-US-00001 TABLE 1 Parameters of counterweight springs for shoulder flexion/extension Elastic Original length Maximum elongation Maximum tension coefficient Type [mm] amount [mm] [N] [N/mm] Large spring 87.20 47.60 141 2.52 T32230 Small spring 31.75 95.00 3.42 0.035 E0180-014-1250-M

[0051] Through substituting the size parameters of the large and small springs into the formula (1), it can be easily calculated that the results meet the requirements.

[0052] According to the parameters shown in Table 1, the maximum joint torque provided by the spring set can be calculated according to the formula (2).

[00005]$\begin{array}{cc}T=F.Math.\frac{d}{2}& \left(2\right)\end{array}$

[0053] Thus, the maximum joint torque provided by the counterweight mechanism is

[00006]$T=141\frac{55}{21000}=3.88.Math..Math.\mathrm{Nm}.$

[0054] As shown in FIGS. 2-4 and FIG. 8, when the rehabilitation robot is switched from the right-hand training mode to the left-hand training mode, the shoulder flexion/extension joint is rotated by 180 in the forward direction. At this time, the guide pulleys D28 and 37 are locked, and the guide pulleys C15 and 36 are released, which is equivalent to returning to the initial position. Thus, balancing of the gravity of the robot arm can be continued.

[0055] In general, the gravity balancing device of the present invention is suitable for use in a left-right hand dual-purpose rehabilitation robot, in which a part of the gravity of the robot arm is balanced by springs, thereby reducing the motor load and improving the service life of the robot arm; the arrangement of the springs and the guide pulleys does not substantially increase the volume and weight of the robot itself; the counterweight force provided by the springs can be calculated according to the spring stiffness and the joint rotation angle, thereby effectively improving the stability and operability of the robot and improving the overall performance of the rehabilitation robot.

[0056] It should be readily understood to those skilled in the art that the above description is only preferred embodiments of the present invention, and does not limit the scope of the present invention. Any change, equivalent substitution and modification made without departing from the spirit and scope of the present invention should be included within the scope of the protection of the present invention.