Keywords

1 Introduction

As the global aging of the population is becoming increasingly serious, stroke has become the second leading cause of death in people over 60 years old [1]. In addition, the number of patients with upper-limb dysfunction caused by natural disasters, emergencies and other acquired causes is also increasing. How to maximize the recovery of normal motor ability of patients with upper-limb dysfunction is a difficult problem in the field of rehabilitation medicine. Compared with the artificial rehabilitation, the upper-limb rehabilitation robot has the advantages in precise rehabilitation training, low cost and high efficiency. Therefore, it has unique advantages to realize the functional recovery of the affected limb through the upper-limb rehabilitation robot [2].

According to the different structure forms, upper-limb rehabilitation robot can be divided into two types: the exoskeleton rehabilitation robot and the end traction rehabilitation robot [3]. The exoskeleton upper-limb rehabilitation robot realizes rehabilitation training by controlling the exoskeleton to drive the coordinated movement of the affected limb. The Chicago Institute of Rehabilitation and the University of California had jointly developed a 3-DOF upper-limb rehabilitation robot ARM Guide. The robot has an active degree of freedom, the linear guide is driven by the motor to realize the flexion/extension movement of the upper-limb [4, 5]. A 5-DOF SAIL upper-limb rehabilitation robot was designed by the University of Southampton in the United Kingdom. The torsion spring elastic auxiliary support mechanism was installed at the shoulder and elbow joints. VR technology was combined with electrical signal stimulation of upper-limb muscles. The robot realizes upper-limb rehabilitation through the above measures [6]. The main mechanism of the end traction upper-limb rehabilitation robot is an ordinary linkage mechanism or a tandem robot mechanism. Through the mechanism at the end of the robot to pull the affected limb to complete the rehabilitation. Hogan proposed a robot system with gravity compensation—the 2-DOF arm planar rehabilitation robot system MIT-MANUS [7]. Subsequently, a 2-DOF wrist rehabilitation robot was also proposed [8, 9]. The two rehabilitation robots formed a complete upper-limb 4-DOF rehabilitation system. The GENTLE/S upper-limb rehabilitation robot developed by the University of Reading used cable to reduce the weight of the affected limb. Based on the drive of Haptic MASTER industrial robot, the shoulder and elbow joint were trained [10, 11]. Many institutions have conducted in-depth research on upper-limb rehabilitation robot. However, the research on the size, structure, human-machine compatibility and secondary injury prevention of the upper-limb rehabilitation robot can still be carried out in-depth [12].

The cable-driven robot is a new type of robot. It uses cable to replace traditional rigid connectors. By controlling the motor to drive the pulley to change the length of cable, the pose control of the end effector is completed. British Jensen designed a 9-cable drive parallel robot SACSO. The literature detailed the kinematics, cable tension and dynamic characteristics of the object under the redundant constraint state driven by 9 cables. The wind tunnel model test was carried out [13]. Williams of Ohio State University designed a simulation dynamics and control system of the planar translational cable-oriented robot (CDDR). It improved the cable interference problem of the existing CDDRs, and avoided applying negative cable tension to the environment during dynamic movement [14]. The cable-driven robot has the advantages in large workspace, high inertia ratio, fast response of load speed, and easy reorganization of robot mechanism [15, 16].

To solve the problems of the upper-limb rehabilitation robot mentioned above, a cable-driven upper-limb rehabilitation robot (CULR) with features of modular design, simple structure, and good human-machine compatibility was presented in this paper. Through the shoulder flexion/extension, trajectory planning, kinematics analysis, workspace verification and human-machine experiment research were carried out. Based on these, the robot assisted patients in different rehabilitation stages to develop a variety of task-oriented rehabilitation.

2 Cable-Driven Upper-Limb Rehabilitation Robot

2.1 Composition of CULR

As shown in Fig. 1, CULR is composed of frame, seven groups of cable-driven units, rotating seat, cable and movable platform. Movable platform is shown in Fig. 2. By controlling the angle change of the rollers in the seven groups of cable-drive units, the structure of the cable-drive units is shown in Fig. 3, the coordinated variation of the seven cables are realized. Therefore, the platform can be pulled to drive the affected limb according to the planned trajectory to perform rehabilitation. The contact part between the patient and robot is small, and the human-machine compatibility is good.

Fig. 1.
figure 1

The composition of CULR.

Fig. 2.
figure 2

The structure of movable platform

Fig. 3.
figure 3

The structure of the cable-drive unit

2.2 Shoulder Flexion and Extension

This paper has planned a trajectory that simulated the flexion / extension movement of the shoulder joint in the xOz plane (as shown in Fig. 4). The law of forearm center of mass movement is as formula (1), where the shoulder joint rotation angle θs ranges from −30° to 30° (anti-clockwise rotation is positive, clockwise rotation is negative).

$$ \left\{ {\begin{array}{*{20}l} {x = - 430\left( {\cos \left( u \right) - 1} \right)} \hfill \\ {z = 430\sin \left( u \right)} \hfill \\ {\theta_{y} = u} \hfill \\ \end{array} } \right.\left( { - \pi /6 \le u \le \pi /6} \right) $$
(1)
Fig. 4.
figure 4

Shoulder flexion and extension

3 Robot Kinematics Analysis

3.1 Inverse Kinematics

Figure 5 shows the 3R3T (three rotation and three translation) parallel cable-drive mechanism (PCDM). The seven driving points Mi (XMi, YMi) (i = 1, 2,…, 7) of mechanism are M1 (-a, -b, -e), M2 (a, -b, -e), M3 (a, b, -e), M4 (-a, b, -e), M5 (-a,-b, e), M6 (a, b, e), M7 (-a, b, e) (a, b and e are greater than 0), the global rectangular coordinate system Oxyz is located at the center of the cube composed of seven driving points. The seven (three) traction points of the movable platform (some traction points coincide) are shown in Fig. 5. The seven cables PiMi (i = 1, 2, …, 7) are connected to the seven (three) traction points of the movable platform by the output of seven driving points. The local coordinate system of the movable platform is Pxpypzp, the pose of the center of movable platform in the global rectangular coordinate system is expressed as P (x, y, z, θx, θy, θz). Pi (XPi, YPi, ZPi) represents the traction point in the local coordinate system, then the point Pi (i = 1, 2,…, 7) in the global coordinate system can be expressed as:

$$ \left[ {\begin{array}{*{20}c} {x_{{P_{i} }} } \\ {y_{{P_{i} }} } \\ {z_{{P_{i} }} } \\ \end{array} } \right] = \left[ {\begin{array}{*{20}c} x \\ y \\ z \\ \end{array} } \right] + {\varvec{D}}\left[ {\begin{array}{*{20}c} {X_{{P_{i} }} } \\ {Y_{{P_{i} }} } \\ {Z_{{P_{i} }} } \\ \end{array} } \right] $$
(2)

Among them, D is the direction cosine vector.

Fig. 5.
figure 5

Mechanism model of 3R3T PCDM

\({\varvec{r}}_{i} = {\varvec{PP}}_{i}\) (i = 1, 2,…, 7) is the vector from the center point P of the movable platform to the traction point Pi. \({\varvec{L}}_{i} {\mathbf{ = }}{\varvec{P}}_{i} {\varvec{M}}_{i}\) is the vector from the traction point Pi to the driving point Mi, then the length of the cable can be expressed as \(l_{i} = \left\| {{\varvec{L}}_{i} } \right\|\). \({\varvec{u}}_{i} {\mathbf{ = }}{\varvec{L}}_{i} /l_{i}\) is the unit vector of the ith cable, ti is the force value of the ith cable, then the tension vector of the ith cable acting on the movable platform is \({\varvec{t}}_{i} \user2{ = u}_{i} t_{i}\). According to the principle of robot mechanism and mathematics vector closure, the length of the cable is:

$$ {\varvec{l}} = \left[ {\begin{array}{*{20}l} {l_{1} } \hfill & {l_{2} } \hfill & {l_{3} } \hfill & {l_{4} } \hfill & {l_{5} } \hfill & {l_{6} } \hfill & {l_{7} } \hfill \\ \end{array} } \right]^{{\text{T}}} $$
(3)

3.2 Forward Kinematics

The variation of the cable has been calculated during the movement of the movable platform, the next step is to control the length of the cable in real time to pull the movable platform to complete the expected action. Because there is no root formula for solving the nonlinear equations of the cable length, so the approximate solution of cable length is solved by numerical calculation, that is, the Newton-Raphson iterative method is used to solve the Eq. (3). The principle of this method is to substitute the guessed solution, iterate layer by layer, and produce an ideal solution within the allowable error range after a finite iteration step. The specific solution process is as follows:

According to formula 3, construct the following formula:

$$ F_{i} \left( {\varvec{X}} \right) = \left\| {{\varvec{L}}_{i} } \right\|^{2} - l_{i}^{2} ,i = 1,2, \ldots ,7 $$
(4)
$$ {\varvec{J}}_{i} = \left[ {\begin{array}{*{20}l} {\frac{{\partial F_{i} }}{\partial x}} \hfill & {\frac{{\partial F_{i} }}{\partial y}} \hfill & {\frac{{\partial F_{i} }}{\partial z}} \hfill & {\frac{{\partial F_{i} }}{\partial \alpha }} \hfill & {\frac{{\partial F_{i} }}{\partial \beta }} \hfill & {\frac{{\partial F_{i} }}{\partial \gamma }} \hfill \\ \end{array} } \right]_{1 \times 6} ,i = 1,2, \ldots ,7 $$
(5)
$$ {\varvec{J}} = \left[ {\begin{array}{*{20}l} {J_{1} } \hfill & {J_{2} } \hfill & {J_{3} } \hfill & {J_{4} } \hfill & {J_{5} } \hfill & {J_{6} } \hfill & {J_{7} } \hfill \\ \end{array} } \right]_{7 \times 6}^{\rm{T}} ,i = 1,2, \ldots ,7 $$
(6)
$$ {\varvec{F}}\left( {\varvec{X}} \right) = [F_{1} \left( {\varvec{X}} \right)\;F_{2} \left( {\varvec{X}} \right)\,F_{3} \left( {\varvec{X}} \right)\;F_{4} \left( {\varvec{X}} \right)F_{5} \left( {\varvec{X}} \right)\;F_{6} \left( {\varvec{X}} \right)\;F_{7} \left( {\varvec{X}} \right)]^{\rm{T}} $$
(7)
$$ {\varvec{X}}{ = }\left[ {\begin{array}{*{20}l} x \hfill & y \hfill & z \hfill & \alpha \hfill & \beta \hfill & \gamma \hfill \\ \end{array} } \right]^{{\text{T}}} $$
(8)
$$ \begin{array}{*{20}c} {{\varvec{J}}\delta {\varvec{X}}_{K} = - {\varvec{F}}\left( {\varvec{X}} \right)} & {or} & {\delta {\varvec{X}}_{K} = - {\varvec{J}}^{ + } {\varvec{F}}\left( {\varvec{X}} \right)} \\ \end{array} $$
(9)
$$ {\varvec{X}}_{K + 1} = {\varvec{X}}_{K} + \delta {\varvec{X}}_{K} $$
(10)
$$ \left\| {\delta {\varvec{X}}_{K} } \right\| < \varepsilon $$
(11)

According to matrix theory, the pseudo-inverse of Newton-Raphson Jacobian matrix J is \({\varvec{J}}^{ + } = \left( {{\varvec{J}}^{\rm{T}} {\varvec{J}}} \right)^{ - 1} {\varvec{J}}^{\rm{T}}\).

Through the above method, the forward kinematics analysis is carried out on the 3R3T PCDM. The center pose of movable platform can be obtained according to the length of the cable for subsequent motion control.

3.3 Workspace Analysis

The 3R3T PCDM in this paper is a fully constrained mechanism. Considering the general situation, when solving the workspace of the 3R3T PCDM, the DOF of the mechanism is n. Assuming that the pose of the movable platform in the global Cartesian coordinate system is \({\varvec{X}}^{n}\), \({\varvec{T}} \in {\varvec{R}}^{m} \left( {{\varvec{T}} \ge 0} \right)\) is the tension of each cable, \({\varvec{F}} \in {\varvec{R}}^{n}\) is a force spiral vector acting on the movable platform. If \({\varvec{J}}^{\rm{T}} {\varvec{T}} = {\varvec{F}}\) holds, \({\varvec{X}}^{n}\) is the controllable workspace of the movable platform [17]. The tension matrix is \({\varvec{T}} = \left[ {\begin{array}{*{20}c} {t_{1} } & \ldots & {t_{m} } \\ \end{array} } \right]^{\rm{T}}\),and the \({\varvec{J}}^{{\text{T}}}\) is the structure matrix, \({\varvec{J}}^{{\text{T}}} { = }\left[ {\begin{array}{*{20}l} {u_{1} } \hfill & \ldots \hfill & {u_{m} } \hfill \\ {r_{1} \times u_{1} } \hfill & \ldots \hfill & {r_{m} \times u_{m} } \hfill \\ \end{array} } \right]\).

Figure 6 shows the n-DOF mechanism model of PCDM. Assuming that the force and torque acting on the movable platform by the cable are removed, \({\varvec{f}}_{\rm{P}}\) and \({\varvec{\tau}}_{\rm{P}}\) are the external force and torque.

Fig. 6.
figure 6

n-DOF mechanism model of PCDM.

According to the D'Alembert principle, the force spiral balance equations of the movable platform are:

$$ \sum\limits_{i = 1}^{m} {t_{i} } + {\varvec{f}}_{{\text{p}}} = {\mathbf{0}} $$
(12)
$$ \sum\limits_{i = 1}^{m} {{\varvec{r}}_{i} } \times {\varvec{t}}_{i} + {\varvec{\tau}}_{\rm{P}} = 0 $$
(13)

According to (12) and (13),

$$ {\varvec{J}}^{{\text{T}}} {\varvec{T}}{ = }\left[ {\begin{array}{*{20}l} {u_{1} } \hfill & \ldots \hfill & {u_{m} } \hfill \\ {r_{1} \times u_{1} } \hfill & \ldots \hfill & {r_{m} \times u_{m} } \hfill \\ \end{array} } \right]{\varvec{T}} = {\varvec{F}} $$
(14)

In the formula, F is the external force spiral matrix acting on the movable platform, \({\varvec{F}} = \left[ {\begin{array}{*{20}c} { - {\varvec{f}}_{\rm{P}} } & { - {\varvec{\tau}}_{\rm{P}} } \\ \end{array} } \right]^{T}\).

If the workspace has practical significance, the pose of movable platform of the PCDM must meet the following conditions:

  1. (a)

    The movable platform is controllable, that is \({\varvec{J}}^{\rm{T}} {\varvec{T}} = {\varvec{F}}\);

  2. (b)

    The tension value of the cable is greater than 0, that is, ti > 0 (i = 1, 2,…, m), and it is within the allowable tension range;

  3. (c)

    There is no singular position in the movement of the movable platform, that is \(\rm{rank}\left( {\user2{J}^{\rm{T}} } \right) = n\);

  4. (d)

    The PCDM has sufficient strength.

In addition, based on the tension ti of each cable must be greater than 0, that is T = (IJT+J) > 0 (JT+ is the pseudo-inverse matrix of the cable structure matrix JT), Kawamura and Verhoeven obtained the necessary and sufficient condition for judging whether the movable platform pose Xn in the PCDM is in the controllable workspace: the zero space structure matrix \({\varvec{J}}^{\rm{T}}\) is greater than 0, which is N(JT) > 0 [18].

Fig. 7.
figure 7

Relationship between shoulder joint flexion/extension movement trajectory and workspace

Therefore, for the n-DOF PCDM, only \(\rm{rank}\left( {\user2{J}^{\rm{T}} } \right) = n\) and N(JT) > 0 are satisfied at the same time, the pose of the movable platform is within the controllable workspace.

When the upper-limb is driven by the movable platform to conduct shoulder joint flexion/extension, the relationship between the motion trajectory of the center of mass of forearm and the workspace is shown in Fig. 7. It can be seen from the figure that the trajectory of the center of the movable platform (the center of mass of forearm) is completely enclosed in the robot’s workspace. Therefore, the 3R3T parallel CULR can meet the requirements of upper-limb basic rehabilitation. At this time the length changes of each cable under the two motion trajectories are shown in Fig. 8, it will pave the way for the subsequent experimental verification.

Fig. 8.
figure 8

Cable variation of shoulder joint flexion/extension movement

4 Experimental Research on CULR

This experimental research was carried out based on the LINKS real-time semi-physical simulation system. In the experiment, a healthy adult male with a height of 178 cm and a weight of 63 kg was selected as the experimental object. The robot drove the experimental object to move the upper-limb to simulate the shoulder flexion/extension. The movable platform drove the subject’s upper-limb to make a circular motion with a rotation angle θ of 60° and a period T of 5 s. The experimental process is shown in Fig. 9, and the experimental results are shown in Fig. 10.

Fig. 9.
figure 9

Shoulder joint flexion/extension exercise experiment

Fig. 10.
figure 10

Experimental curve of shoulder joint flexion/extension exercise

From the experimental results in Fig. 10(a) to 10(g), in the experimental research of shoulder joint flexion/extension rehabilitation exercise, the actual length change of the seven cables basically is coincide with the given amount. It can be seen from Fig. 10(h) that the maximum error of the cable length change amount is about 10 mm. The extremely small error is caused by the cable-drive unit mechanism itself. But the experimental effect reached the expected goal and met the requirements. It can be seen from Fig. 10(i) and 10(j) that the change range of tension and linear velocity of each cable is small, and in a controllable range, without large mutation. The effectiveness and safety of the upper-limb rehabilitation robot are verified.

By analyzing the experimental results, the following conclusions can be drawn:

  1. (a)

    By analyzing the relationship between the actual length change of the flexible cable and the given amount, the effectiveness of the designed position servo controller isSS verified.

  2. (b)

    The human-machine experiment has completed the simulation of the flexion/extension movement of the shoulder joint, the experimental effect is good. The feasibility of the upper-limb rehabilitation robot is verified, and the rehabilitation has high efficiency and diversified forms.

  3. (c)

    By interviewing the subject’s feelings and analyzing the feedback data during the experiment, the CULR drives the upper-limb for rehabilitation with less human-machine interference and high comfort.

5 Conclusion

In this paper, a cable-driven upper-limb rehabilitation robot was proposed based on 3R3T PCDM. The shoulder joint flexion/extension movement trajectory was planned, and the kinematics analysis of the 3R3T PCDM was carried out, the method of controllable workspace analysis was proposed, finally, the change law of cable was obtained. The human-machine experiment that simulated the rehabilitation of shoulder joint flexion/extension exercise has been completed and the experimental effect is good. This paper has laid a strong foundation for the research of parallel cable-driven upper-limb rehabilitation robot.

Based on this work, the kinematic characteristics will be analyzed further, and the control strategies of different rehabilitation modes will also be studied. The results were prepared for the following prototype experiment and human-machine experiment.