An ankle joint auxiliary rehabilitation robot has been developed, which consists of an upper platform, a lower platform, a dorsiflexion/plantar flexion drive system, a varus/valgus drive system, and some connecting parts. The upper platform connects to the lower platform through a ball pin pair and two driving branch chains based on the S′PS′ mechanism. Although the robot has two degrees of freedom (DOF), the upper platform can realize three kinds of motion. To achieve ankle joint auxiliary rehabilitation, the ankle joint of patients on the upper platform makes a bionic motion. The robot uses a centre ball pin pair as the main support to simulate the motion of the ankle joint; the upper platform and the centre ball pin pair construct a mirror image of a patient’s foot and ankle joint, which satisfies the human body physiological characteristics; the driving systems adopt a rigid-flexible hybrid structure; and the dorsiflexion/plantar flexion motion and the varus/valgus motion are decoupled. These structural features can avoid secondary damage to the patient. The rehabilitation process is considered, and energy consumption of the robot is studied. An experimental prototype demonstrates that the robot can simulate the motion of the human foot.
Natural Science Foundation of Henan Province162300410316Zhengzhou University of Light Industry2016BSJJ009Key Science and Technology Research Project of Henan Province182102210159National Natural Science Foundation of China517054731. Introduction
Many studies have shown that high-intensity repetitive movements play an important role in the effectiveness of robot-assisted therapy [1]. Some ankle rehabilitation robots for treating ankle injuries have been developed. For example, Roy et al. [2] developed a three-DOF wearable ankle robot, back-drivable with low intrinsic mechanical impedance actuated by two actuators. Saglia et al. [3] designed a redundantly actuated parallel mechanism for ankle rehabilitation. Yoon and Ryu [4] presented a reconfigurable ankle rehabilitation robot to cover various rehabilitation exercise modes. Jamwal et al. [5] designed a rehabilitation robot with three-DOF rotation. The robot has four actuators. Girone et al. [6] used a Stewart platform-based system as an ankle robot with six DOFs. Veneva [7] introduced an ankle-foot orthosis with one DOF for the foot segment and another one for the shank segment. Agrawal et al. [8] designed a two-DOF orthosis with pronation-supination and flexion-extension movements. Bi [9] proposed a spherical parallel kinematic machine as an ankle rehabilitation robot, which can improve the adaptability to meet the patient’s needs during rehabilitation. Lu et al. [10] proposed a three-DOF ankle robot combining passive-active training. Aggogeri et al. [11] proposed a new device based on a single-DOF parallel mechanism able to perform trajectories similar to the patient’s ankle. Erdogan et al. [12] presented a configurable, powered exoskeleton for ankle rehabilitation. Liao et al. [13] proposed a novel hybrid ankle rehabilitation robot, which is composed of a serial and a parallel part. The parallel part of the robot was simplified as a constrained 3-PSP parallel mechanism. The kinematic analyses showed that the proposed hybrid rehabilitation robot can not only realize three kinds of ankle rehabilitation motions but also eliminate singularity with enhanced workspace.
Nowadays, research on ankle joint robots involves several aspects, including control, torque, motion planning, and optimization. For example, Rosado et al. [14] implemented PID controllers in the development of passive rehabilitation exercises. Meng et al. [15] presented a robust iterative feedback tuning technique for repetitive training control of a compliant parallel ankle rehabilitation robot. Zhang et al. [16] proposed a computational ankle model for use in robot-assisted therapy estimating the passive ankle torque. Ayas et al. [17] designed a fractional-order controller for a developed 2-DOF parallel ankle rehabilitation robot subject to external disturbance to improve the trajectory tracking performance.
At present, a number of rehabilitation robots are under investigation. However, only very few rehabilitation robots have been commercialised [9, 18, 19]. Rehabilitation robotics is penetrating the market very slowly. The significant limitations are the high cost and the difficulty to meet some specific needs from patients. For low-income and middle-income classes, only 5-15% of people who need assistive devices and technologies have access to these technologies [20]. There is a shortage of personnel trained to manage the provision of such devices and technologies. However, the research and development on rehabilitation robots is emerging due to the fact that the cost of excluding people with disabilities from taking an active part in community life is high and the improvement has to be borne by society, particularly for those who take on the burden of care. The following conclusions have been drawn from the literature reviews [9]:
The existing rehabilitation robots have unacceptably high price. Even though limited rehabilitation robots are commercially available, most of them are still placed at research institutes due to the lack of market attraction
Most of the existing ankle rehabilitation robots have coupled motions other than ankle rehabilitation needs. On the one hand, it increases the development cost since unnecessary redundant motions are used. Most importantly, due to the coupled translations, additional support will be required to endure the patient’s weight. For example, a few ankle rehabilitation robots have coupled motions of the legs. It becomes very inconvenient for a patient to sit down and concentrate on the ankle rehabilitation
Most of the existing rehabilitation robots are designed for hospital environments
There is no indication that patients can operate and tailor the rehabilitation routines to their own needs. A completely new control mode is in demand which will allow a patient to operate the device by themselves and in the home environment.
Therefore, the following three points have been considered in our designed rehabilitation robot to further improve their performance and reduce the manufacturing and use costs simultaneously:
Among the three allowed motions of the human ankle, only dorsiflexion/plantar flexion and varus/valgus are considered, as they are more important for ankle rehabilitation [21]. The basic idea is thus to develop a rehabilitation robot primarily intended for the above two motions to meet some special patients’ need and further reduce the cost of production and use
The objective is to design a robot in which the motion is fully decoupled into motion segments, to avoid the associated motion of multidrive motors
For existing robots, the motion law of rehabilitation needs to be further researched. In fact, by applying inappropriate rules while rehabilitating the patient, the exercise would be less effective and may lead to secondary damage to the patient
Based on these considerations, a bionic ankle joint auxiliary rehabilitation robot based on a 2-S′PS′ mechanism was designed.
The main innovation points include
The robot is designed with a special structure configuration. Between the upper platform and the lower platform, the centre sphere-pin pair and the two drive branch chains used for support are designed into a right triangle. Among them, the centre sphere-pin pair is a right-angle vertex, and the two drive branch chains are the vertexes of the two right-angle edges of the right triangle. For each drive branch chain, the spherical pin shafts of the two sphere-pin pairs are arranged along the direction of the right-angle side of the triangle. The spherical pin shaft of the centre sphere-pin pair is also arranged along the direction of another right-angle side of the triangle. Using this innovative structure configuration, the upper platform realizes dorsiflexion/plantar flexion and varus/valgus motions through rotation around two right-angle sides of the triangle
To make the robot motion be completely decoupled during dorsiflexion/plantar flexion or varus/valgus motions, dorsiflexion/plantar flexion and varus/valgus driving systems of the robot adopt the rigid-flexible hybrid structure. The two drive branch chains have the same structure. Each branched chain consists of a motor, slider block, spring, and others. When Motor I rotates to change Branch Chain 1 which results in motion of the upper platform, Branch Chain 2 will change its length to fit the upper platform motion. The compression of springs on Branch Chain 2 is large enough to compensate for this kind of change; therefore, Motor II on Branch Chain 2 keeps stationary. The same circumstance occurs for Motor II rotating to change Branch Chain 2
The robot uses a centre ball pin pair as the main support to simulate the motion of the ankle joint; a structure consisting of the upper platform and the centre ball pin pair is a mirror image of a patient’s foot and ankle joint, which satisfies the human body physiological characteristics
The speed, acceleration, and energy consumption of a typical rehabilitation exercise are considered to select different motion laws for the upper platform of the robot, for applying appropriate rules while rehabilitating the patient and avoiding secondary damage to the patient
Table 1 shows actuation, range of motion (RoM), and motion decoupled characteristics about our designed robot and some stationary ankle rehabilitation robots. From Table 1, only our robot is completely decoupled in dorsiflexion/plantar flexion or varus/valgus motions.
Actuation, RoM and motion decoupled characteristic of ankle rehabilitation robots.
Year
Authors
DOF
RoM
Actuator
Motion decouples
2006
Liu et al. [22]
3
41.9° plantarflexion
Electric motor
No
43.8° dorsiflexion
42.8° abduction
41.9° abduction
53.8° inversion
44.1° eversion
2006
Yoon et al. [23]
2
50° plantarflexion/dorsiflexion
Pneumatic actuator
No
55° inversion/eversion
2009
Saglia et al. [24]
2
30° dorsiflexion
Electric motor
No
60° plantarflexion
30° inversion
15° eversion
2009-2014
Jamwal et al. [25, 26]
3
46° plantarflexion/dorsiflexion
Pneumatic actuator
No
52° abduction/adduction
26° inversion/eversion
2010
Ding et al. [27]
2
45° plantarflexion/dorsiflexion
Magneto-rheological fluid (MRF)
No
12° inversion/eversion
2013
Bi [9]
3
99.50° inversion/eversion
Electric motor
No
56.00° dorsiflexion/plantarflexion
100.80° internal/external rotations
2018
Liao et al. [13]
3
75° plantar/dorsal flexion
Electric motor
No
42° inversion/eversion
2018
C.D. Wang (author of this paper)
2
60° dorsiflexion/plantar flexion
Electric motor
Yes
60° varus/valgus
The rest of the paper is organized as follows: In Section 2, the structure of the robot is presented. In Section 3, the kinematic model is established, and the workspace is calculated in Section 4. The motions of the robot’s upper platform are simulated and analyzed under different motion laws in Section 5. The control system and the experimental research are discussed in Section 6. Conclusions are outlined in Section 7.
2. Structure and Working Principle of the Robot
According to the anatomical structure of the human ankle, the ankle involves a total of three kinds of motions, i.e., dorsiflexion/plantar flexion, varus/valgus, and adduction/abduction. Among them, dorsiflexion/plantar flexion and varus/valgus are the two most important [21].
Therefore, an ankle joint auxiliary rehabilitation robot is designed according to the schematic shown in Figure 1. The robot with two drives and two DOFs is capable of three kinds of motions, namely, the dorsiflexion/plantar flexion motion, varus/valgus motion, and compound motion. The robot can be used by patients to exercise all these three motions. For patients with foot droop and lower limb muscle atrophy, the rehabilitation train can recover the ankle activity to normal, improve the muscle strength of lower limb muscle atrophy, and make the patient stand and walk during the rehabilitation period [28].
Schematic of the human ankle joint.
A schematic of the robot is shown in Figure 2, where (1) is the lower platform, (8) is the upper platform, and (9) is the ball pin structure supporting the two platforms. The two drive branch chains (namely, Branch Chain 1, A1B1 and Branch Chain 2, A2B2) are identical; each branched chain consists of a motor (2), U-shaped connector (3), screw rod (4), guide frame (5), slider block (6), and spring (7). The screw rod is connected to the motor, which is in turn fixed on the U-shaped connector. A screw pair is formed by the screw rod and slider block, while the slider block (6) and guide frame (5) form a sliding pair. Springs are installed between the slider block and guide frame forming the flexible transmission structure.
Schematic of the robot. (a) The robot rotates by an angle of α around the X0-axis. (b) Drive branch chain. (1) Lower platform, (2) motor, (3) U-shaped connector, (4) screw rod, (5) guide frame, (6) slider block, (7) spring, (8) upper platform, and (9) ball pin structure.
The guide frame (5) and the upper platform (8) and the lower platform (1) and the U-shaped connector (3) are connected by ball pin pairs, respectively. Points A1, B1, A2, B2, and O are centre points of the ball pin pairs, and lines B1B3 and A1A3 are perpendicular to lines B3B2 and A3A2, respectively. It is required that the spherical pin shafts of the ball pin pair A1 and B1 lie on the A1B1B3A3 plane. The spherical pin shafts of ball pin pair A2 and B2 lie on the A2B2B3A3 plane, and the spherical pin shaft of ball pin O lies on the A1B1B3A3 plane.
The structural model of the robot is shown in Figure 3. The foot joint of the patient is buckled on the upper platform (8) using the foot buckle (10). A structure consisting of the upper platform and the centric ball pin pair is a mirror image of a patient’s foot and ankle joint. When an ankle joint needs to perform the dorsiflexion and plantar flexion rehabilitation motions, Motor I starts rotating the screw rod (4) and drives the slider block (6). Then, the motion of the slider block (6) constricts the spring (7). Under the action of the spring force, the upper platform rotates by a certain angle along the direction of the dorsiflexion and plantar flexion rehabilitation motions.
The structural model of the robot: (1) lower platform, (2) motor, (3) U-shaped connector, (4) screw rod, (5) guide frame, (6) slider block, (7) spring, (8) upper platform, (9) ball pin structure, and (10) foot buckle.
For the dorsiflexion/plantar flexion motion, only Motor I on branch chain A1B1 is needed to drive the robot (when Motor I rotates to change branch chain A1B1 for making the dorsiflexion/plantar flexion motion, the branch chain A2B2 will change its length to fit the upper platform motion. The compression of springs on branch chain A2B2 is enough to compensate for this kind of change). For the varus/valgus rehabilitation motion, the robot operates in the same way but only Motor II on branch chain A2B2 drives the robot. For the compound rehabilitation motion, both motors drive the device.
Suppose the patient uses the robot to carry out a rehabilitation motion, the movement time of the dorsiflexion/plantar flexion, varus/valgus rehabilitation, and compound rehabilitation is the same, while the motor power expense for the dorsiflexion/plantar flexion and varus/valgus rehabilitation is the same. Compared with the undecoupled robot motion system, in normal conditions, the robot can reduce energy consumption of the motor by 30%.
3. Motion Modelling
The following three cases can be considered when analyzing the overall motion of the system:
Case 1.
Only Motor I rotates.
Case 2.
Only Motor II rotates.
Case 3.
Motor I and Motor II rotate simultaneously.
Each of the above cases can be divided into three modes:
A transition mode (i.e., the motor rotates and compresses the spring but cannot drive the motion of the upper platform)
A rigid-flexible combination driving mode (i.e., the motor rotates and compresses the spring, which drives the upper platform)
A rigid driving mode (i.e., the motor rotates and the spring is compressed to a rigid body, which drives the upper platform)
The transition mode is not considered, and the rigid driving mode cannot occur in a normal working state. Case 1 is used as an example to analyze the motion of the robot.
From Figure 2, B1, B2, and B3 are the initial positions of the upper platform, while B1′, B2′, and B3′ are the corresponding final positions.
In the initial state, let A1B1=l1, A2B2=l2, OB3=l3, A1A3=B1B3=n, and A2A3=B2B3=b. Set a fixed coordinate system X0Y0Z0 with the centre point O of the centre ball pin as the origin. The coordinate system is fixed to the lower platform. X0-axis is parallel to A2A3, Y0-axis is parallel to A1A3, and Z0-axis coincides with OA3. The coordinates of the points on the lower platform are A100,n,−l4, A20b,0,−l4, and A300,0,−l4. A motion coordinate system X1Y1Z1 is set up with point O as the origin, and the coordinate system is fixed to the upper platform. The X1-axis is parallel to B2B3, the Y1-axis is parallel to B1B3, and the Z1-axis coincides with OA3. The coordinates of the points on the upper platform are B110,n,l3, B21b,0,l3, and B310,0,l3. Due to the symmetrical structure of the upper platform, it is considered approximately that the mass centre point of the upper platform is point P in the middle of line B1B3 and its coordinates are P10,n/2,l3. In the initial state, the two coordinate systems X0Y0Z0 and X1Y1Z1 are coincident.
According to Figure 2, when the upper platform rotates by an angle α° around the shaft X0, the homogeneous transformation matrix is given by
(1)T10=10000cosα−sinα00sinαcosα00001.
We have B′10=T10⋅B11, B′20=T10⋅B21, B′30=T10⋅B31, and P′0=T10⋅P1.
In order to calculate relationship between the motor drive angle and the motion angle of the upper platform, the calculation steps are as follows.
Calculating Initial Compression Displacements of the Four Springs. Displacements x12 and x22 and x32 and x42 represent the initial compression displacements of the upper spring and the lower spring of Branch Chain 1 and Branch Chain 2, respectively. According to the forces and loads on the upper platform, establish equilibrium equations for forces and torques and the initial compression displacements x12, x22, x32, and x42 of the four springs can be calculated
Calculating Acceleration of the Mass Centre PointP. When Motor I rotates for a time ts, the upper platform rotates by an angle α° around the shaft X0 with the centre point O, and the rotation angle of Motor I is about φ10.
The acceleration P′¨O of the mass centre point P (see Figure 2) for the upper platform is as follows:
(2)X¨oP/=0,Y¨oP/=-ncosα⋅α̇2+sinα⋅α¨2+l3sinα⋅α̇2+cosα⋅α¨,Z¨oP/=n-sinα⋅α̇2+cosα⋅α¨2-l3cosα⋅α̇2+sinα⋅α¨,where α, α̇, and α¨ are the angle displacement, angle velocity, and angle acceleration of the upper platform rotation motion, respectively
Calculating Acting Force between Branch Chain 1 and the Upper Platform. The force between Branch Chain 1 and the upper platform is FB13, rotational inertia of the upper platform around the X0-axis is JX, and weight of the upper platform is m. Considering the inertia force and inertia moment of each part of Branch Chain 1, the equilibrium equation is established and FB13 is solved
Calculating Acting Force of the Upper Spring and the Lower Spring of Branch Chain 1. In the A1B1′ direction, suppose the slider block rises Δx1 and the guide frame rises Δx2. Then, the compression value (see Figure 2) for the spring is Δx1−Δx2. Therefore, we have
(3)F13=F13′=Kx12+Δx1−Δx2,F23=F23′=Kx22−Δx1−Δx2,where F13 and F13′ are the forces of the upper spring of Branch Chain 1 on the guide frame and on the guide block, respectively; F23 and F23′ are the forces of the lower spring of Branch Chain 1 on the guide frame and on the slider block, respectively; and k is the elastic coefficient of the spring. The elastic coefficients for the upper spring and the lower spring are assumed to be the same.
Establish the differential equation for guide frame (5). According to the initial conditions, t=0, Δx1=0, and Δx2=0, we have
(4)Δx2=−E2cos2K/m1t2K+E22K,where E2=2K⋅Δx1+Kx12−x22−FB13′−A12⋅G1. FB13′ represents the reaction force of the upper platform on the guide frame, FB13′=−FB13; m1 is the mass of the slider block; G1 is the gravity of the slider block; A12=nsinα+l3cosα+l4/ncosα−l3sinα−n2+nsinα+l3cosα+l42; n, l3, and l4 are the structural parameters of the robot; and α is the angle displacement of the upper platform rotation motion
Calculating Angle Relation between the Upper Platform Motion and the Motor Drive. When Motor I rotates by an angle φ10 for a time ts, and the moving displacement of the slider block is Δx1=φ10sn/2π, then sn is the screw pitch of the screw rod (4).
Thus, we can obtain
(5)φ10=D12−l1−x12−x22/2−FB13′/2K−G1⋅A12/2K1−cos2K/m1tsn1−cos2K/m1t/2π,where t≠0, D12=ncosα−l3sinα−n2+nsinα+l3cosα+l42, and FB13′=−FB13. Other parameters are the same as those for equations (2), (3), and (4)
4. Solving the Workspace
We use the movement locus of the centre point P on the upper platform to express workspaces of the upper platform. For solving the workspace, the numerical method and analytical method are combined. Taking Motor I as an example, with the upper platform rotating by an angle α°, calculate the lengths l1α and l2α of Branch Chains 1 and 2, respectively, at a given angle and evaluate whether or not l1α and l2α are between the shortest and longest ranges of allowed branch chains. If they are within an attainable range, Branch Chains 1 and 2 with lengths l1α and l2α, respectively, may form a position of the upper platform. By continuously changing the angle α° and evaluating the results, diverse positions for the upper platform can be obtained, corresponding to the workspace of the upper platform when Motor I runs. Similarly, the workspace for Motor II can be obtained. For solving the workspace when Motors I and II work jointly, first, the working space for each motor running solely must be obtained. Then, the two working spaces are aggregated.
4.1. Structure Constraints of the Branch Chain
The structural model of a branch chain is shown in Figure 4.
Structural model of the individual branch chain.
Its overall length is li (hereafter referred to as the rod length), solid length of the upper spring is l50, solid length of the lower spring is l60, length of the guide frame is l30, and distance between the top of the guide frame and the upper platform is l20. Distance between the U-shaped connector and the lower platform is l10, length of the screw rod is l40, and width of the slider block is l80. At the initial position, the length between the centre of the slider block and the lower edge of the guide frame is l70, distance between the lower edge of the guide frame and the upper edge of the U-shaped connector is l90, and l6 is the thickness of the guide frame.
4.2. Limit Angles of the Upper Platform for Solving the Workspace
In our research, a workspace computational model is established using the workspace of the centre point P on the upper platform as the robot’s workspace; the dorsiflexion/plantar flexion motion is taken as an example to explain limit angles of the upper platform for solving the workspace.
When Branch Chain I determines the motion, the maximum and minimum angles meet the following conditions:
(6)l10+l40+l20+l62=ncosαmin−l3sinαmin−n2+nsinαmin+l3cosαmin+l42,(7)l10+l40−εl40−l80−l50+l30+l202=ncosαmax−l3sinαmax−n2+nsinαmax+l3cosαmax+l42
When Branch Chain II determines the motion, the maximum and minimum angles meet the following conditions:
(8)l10+l40+l20+l62=l3sinαmin2+l3cosαmin+l42,(9)l10+l90+l70−l802−l50−l6+l30+l202=l3sinαmax2+l3cosαmax+l42
The minimum rotation angles are calculated by equations (6) and (8), and the maximum rotation angles are calculated by equations (7) and (9). For the calculation results, the absolute value of the minimum or the maximum angle is a limit angle of the upper platform for the dorsiflexion/plantar flexion motion.
4.3. Calculation Examples and Discussion
Based on the above analysis, a solving system for the workspace is established. Let n=150, b=150, l10=282, l20=33, l30=295, l40=289, εl40=2, l50=63, l60=24, l6=10, l70=73, l80=15, and l90=94. In the dorsiflexion/plantar flexion motion, αmax=30° and αmin=−30°, and in the varus/valgus motion, βmax=30° and βmin=−30°. We study the changes of ankle posture in rehabilitation motion.
Take adult males in China as an example: according to the National Report on Nutrition and Chronic Diseases of Chinese Residents and New National Standard of Human Dimensions of Chinese Adults, the adult male has a thigh length of 465 mm, a shank length of 369 mm, and a medial malleolus height of 112 mm [29, 30]. Based on the human dimensions of Chinese adults, establish a posture model of ankle joint rehabilitation motion as shown in Figure 5 and make simulation analysis in SOLIDWORKS.
A posture model of ankle joint rehabilitation motion: (1) body, (2) hip joint, (3) thigh, (4) knee joint, (5) shank, (6) ankle joint, (7) foot, (8) upper platform, and (9) ball pin structure.
In Figure 5, the dimensions are a thigh length of la=465 mm, a shank length of lb=369 mm, a medial malleolus height of lc=127 mm, and ball pin structure height l3=45 mm.
When an ankle joint carries out the dorsiflexion/plantar flexion motion, the upper platform is driven by Motor I and rotates around the X-axis at αmax=30° and αmin=−30°; limit postures of the ankle joint for the dorsiflexion motion and the plantar flexion motion are as shown in Figures 6 and 7.
Limit posture of the ankle joint for the dorsiflexion motion (αmax=30°).
Limit posture of the ankle joint for the plantar flexion motion (αmax=−30°).
Here, we use the movement locus of mass centre point P on the upper platform to express the workspaces of the upper platform. The workspaces are shown in Figure 8 for the dorsiflexion/plantar flexion motion.
Working space for the dorsiflexion/plantar flexion motion.
When an ankle joint carries out the varus/valgus motion, the upper platform is driven by Motor II and rotates around the Y-axis at βmax=30° and βmin=−30°; limit postures of the ankle joint for the varus motion and valgus motion are as shown in Figures 9 and 10. The workspaces are shown in Figure 11 for the varus/valgus motion.
Limit posture of the ankle joint for the varus motion (βmax=30°).
Limit posture of the ankle joint for the valgus motion (βmin=−30°).
Working space for the varus/valgus motion.
When an ankle joint carries out the compound motion, the robot is driven by the associated motion of Motor I and Motor II. The workspaces of the upper platform are shown in Figure 12.
Working space for Motor I and Motor II working simultaneously.
5. Motion Simulation for the Upper Platform Driven by Different Motion Laws
The performance of the robot is studied using the following three motion laws of the upper platform: modified trapezoid, modified constant velocity, and modified sine motion law [31].
Motion parameters are treated by dimensionless processing. The terms t, s, v, and a are the time, displacement, velocity, and acceleration, respectively, of the motion laws. The terms T, S, V, and A are the corresponding dimensionless parameters, and the following relationship can be established:
(10)T=tth,S=sh,V=dSdT=thhv,A=d2SdT2=th2ha,where h and th are the total displacement and total time of the motion phase, respectively; time t varies in 0,th, and when t=th, s=h. Ranges of T and S are 0,1.
Figure 13 shows a general harmonic trapezoidal motion law expressed in dimensionless quantities.
A general harmonic trapezoidal curve.
The curve is composed of seven sections, and the acceleration of each segment is expressed as
(11)A=A1sinTT1⋅π20≤T≤T1,A1T1<T≤T2,A1cosπT−T22T3−T2T2<T≤T3,0T3<T≤T4,−A2sinπT−T42T5−T4T4<T≤T5,−A2T5<T≤T6,−A2cosπT−T62T7−T6T6<T≤T7,
By choosing different Ti, the three motion laws listed in Table 2 can be obtained. For T=Ti, according to equation (11), we have
(12)A=Ai=ATi.
By integrating equation (12) twice, and substituting the boundary condition, i.e., T=0, S=0, and V=0 and T=1, S=1, and V=0, and the continuous variation conditions of the motion variables in motion process, we have
(13)S=Si=STi
In order to calculate a motor drive function, the maximum motion angle of the upper platform is αmax and time is th. At time ti0≤ti≤th, according to Ti=ti/th, we have Ti
Different motion laws.
T0
T1
T2
T3
T4
T5
T6
T7
Modified trapezoid motion law
0
1/8
3/8
1/2
1/2
5/8
7/8
1
Modified sinusoidal motion law
0
1/8
1/8
1/2
1/2
7/8
7/8
1
Modified constant velocity motion law
0
1/16
1/16
1/4
3/4
15/16
15/16
1
According to the motion law chosen for the upper platform, Si is calculated by equation (13) and the motion angle αi of the upper platform is calculated as follows:
(14)αi=Siαmax.
Then, equation (14) is substituted into equation (5), and a relationship between the rotating angle φ10 of the motor and the time t can be calculated.
Elastic coefficients of the upper spring and the lower spring might differ in the driven branch chain. To simplify the problem, when calculating the driving function of the motor, the elastic coefficients of the upper spring and the lower spring are selected with an identical value.
ADAMS software was used to simulate the motion of the upper platform. The parameters are as follows: n=150 mm, b=150 mm, l1=704.1 mm, l3=12.7 mm, and l4=691.4 mm; load on the upper platform is 2 kg; rotational inertia circling around X-axis is JX=43.175 kg·mm2; elasticity coefficient of the upper springs is K=5.5125 N/mm; elasticity coefficient of the lower springs is K=7.4059 N/mm; screw pitch of the screw rod is sn=5 mm; and weights of the upper platform and guide frame are m=6.537 kg and m1=1.269 kg, respectively. Here, only the simulation analysis of the dorsiflexion/plantar flexion motion is given.
The three-dimensional model of the robot is imported into ADAMS software (Figure 14). Revolving joint motion around the Z-axis is added to the motor to simulate the motor’s rotation.
Importing the model into ADAMS.
When only Motor І rotates, the upper platform is loading and the simulation is given here. In the work process, the upper platform adopts the modified trapezoid, the modified constant velocity, and the modified sinusoidal motion laws.
A cuboid whose outline size is 220 × 60 × 40 mm (L×H×W) is added to the upper platform, and a 2 kg mass is set to simulate the patient’s foot. The simulation time of the upward motion (i.e., α changes from 0° to 30°) or downward motion (α changes from 0° to -30°) of the upper platform is 5 s in steps of 0.1 s.
The upper platform is driven by motion laws previously established, and the motor torque changes are shown in Figures 15 and 16 when the upper platform moves from the equilibrium position upward to the top position and downward to the lowest position, respectively.
Torque for the upper platform moving upward. MOTION_1: modified constant velocity function; MOTION_2: modified sine function, MOTION_3: modified trapezoidal function.
Torque for the upper platform moving downward. MOTION_5: modified constant velocity function; MOTION_6: modified sine function; MOTION_7: modified trapezoidal function.
When the motion is driven by the modified trapezoidal function or the modified constant velocity function, the torque values of the motor fluctuate at the beginning, middle, and end of the motion. The use of the modified sine function enjoys better results than the other two kinds of driving function.
When the spring is set to the elastic state and the rigid state, simulation analysis is carried out. Some of the simulated parameters are summarized in Table 3.
Analysis results of maximum angular speed and acceleration of the platform and maximum motor torque.
Curve
Project
Maximum angular velocity (rad/s)
Maximum angular acceleration (rad/s2)
Motor maximum torque (N·mm)
Upward motion
Downward motion
Upward motion
Downward motion
Upward motion
Downward motion
Spring in the elastic state
Modified trapezoid
0.234
-0.223
-0.756
0.503
0.382
0.534
Modified constant velocity
0.164
-0.155
-0.222
-1.290
0.401
0.560
Modified sinusoidal
0.208
-0.197
0.200
0.440
0.384
0.538
Spring in the rigid state
Modified trapezoid
0.229
-0.222
0.414
-0.538
0.387
0.539
Modified constant velocity
0.157
-0.150
-0.209
-0.555
0.407
0.559
Modified sinusoidal
0.201
-0.194
-0.593
-0.197
0.391
0.541
For the spring in the elastic state, the maximum angular velocity is 0.234 rad/s and the maximum angular acceleration is -1.290 rad/s2, whereas for the spring in the rigid state, the maximum angular velocity is 0.229 rad/s and the maximum angular acceleration is -0.593 rad/s2. The maximum angular velocity value of the upper platform moving with the same motion law is larger for the spring in the case of the elastic state than that for the spring in the case of the rigid state. Moreover, the maximum angular acceleration value of the upper platform is significantly higher for the spring in the case of the elastic state. However, the maximum value of the torque does not significantly differ for the elastic state and the rigid state. Therefore, in the rehabilitation exercise, the patient can choose the different laws of motion based on the specific rehabilitation needs.
6. Control System and Prototype Experiment6.1. Control System Scheme
The control system shown in Figure 17 is composed of a PC, a multiaxis motion control card, and servo drive control systems. The PC provides the user with a graphical interface to complete different tasks such as the motion parameter setting. The multiaxis motion control card obtains the instructions and then converts them into the corresponding signals. The servo driver receives the corresponding signals and drives the servomotor.
Schematic of the overall control system.
6.2. Prototype Test
We design a pose measurement system. The measurement system uses a gyro accelerometer MPU6050 to measure the motion angle of the upper platform and a power analyzer HIOKI PW6001 to measure the currents and power of the motor. Measurement data is shown through the PC. The measurement system can display the upper platform movement in three-dimensional angle changes. Table 4 summarizes the main technical parameters of the servomotor used. The robot experimental prototype and the measurement system are shown in Figure 18.
Technical parameters of the servomotor.
Category
Parameter
Category
Parameter
Motor model
ACH-06040DC
Maximum torque
3.8 N·m
Rated power
400 W
Rated line current
2.8 A
Rated speed
3000 r/min
Rated line voltage
220 V
Rated torque
1.27 N·m
Number of encoder lines
2500 PPR
Experimental prototype of the robot and measurement system: (1) control cabinet, (2) gyro, (3) prototype of the robot, (4) load simulating patient foot, (5) PC for the control system of the robot, (6) PC for the measurement system, and (7) power analyzer.
To compare experiment results with the simulation results using ADAMS software, a cuboid load with overall dimensions of 190×130×50 mm (L×H×W) and weight of 2 kg is added on the platform to simulate the patient foot.
6.2.1. Single Motor Drives
Figure 19 shows the angle changes of the upper platform when the robot is driven by Motor I (see Figure 3) to realize the dorsiflexion/plantar flexion movement. Table 5 shows the angle changes of the upper platform.
The experiment for a single motor drive.
Angle changes for the upper platform.
Number
α (°)
β (°)
γ (°)
Around the shaft X0
Around the shaft Y0
Around the shaft Z0
1
-2.5763
0.0165
-0.0055
2
-3.3618
0.0275
-0.0055
3
-4.1473
0.0385
-0.0055
4
-5.0098
0.0439
-0.0055
5
-5.8667
0.0494
-0.0110
6
-6.8005
0.0439
-0.0055
7
-7.7069
0.0439
-0.0055
8
-8.5034
0.0604
-0.0110
9
-9.2889
0.0769
-0.0110
10
-9.9207
0.0989
-0.0165
11
-10.5414
0.1099
-0.0165
12
-11.0083
0.1263
-0.0220
13
-11.4203
0.1373
-0.0220
From Figure 19 and Table 5, the upper platform only conducts angle changes needed for the dorsiflexion/plantar flexion movement. Experiments for the varus/valgus movement have the same result. Those experiments show that the experimental prototype of the robot can realize drive motion decoupling.
6.2.2. The Compound Motion
Realizing the compound motion is tested by using two motor drives. Figure 20 shows the angle changes of the upper platform when the robot is driven using two motors. From Figure 20, the upper platform can conduct the angle changes needed for the compound motion.
The experiment for the compound motion.
6.2.3. The Maximum Working Angles for the Upper Platform
According to the design parameters, the maximum working angles for the dorsiflexion/plantar flexion motion or the varus/valgus motion change from -30° to +30°. Actual maximum working angles for the upper platform are tested. The experiment shows that the maximum working angles meet the design requirements.
The maximum working angles for the varus/valgus rehabilitation motion according to the modified sine motion law are shown in Figure 21.
The maximum working angles for the varus/valgus rehabilitation motion: (a) move up and (b) move down.
6.2.4. The Real-Time Process of Rehabilitation Motion
The varus/valgus motion, the dorsiflexion/plantar flexion motion, and the compound motion are tested. Here, only the varus/valgus motions are used as an example. The rehabilitation motion of the upper platform is driven by the modified sine motion law, and the cycle time is 20 s. The experiment results for three working angles (changing from -10° to +10°, -15° to +15°, and -20° to +20°) are shown in Figures 22, 23, and 24.
The working angles (from -10° to +10°) for the varus/valgus rehabilitation motion.
The working angles (from -15° to +15°) for the varus/valgus rehabilitation motion.
The working angles (from -20° to +20°) for the varus/valgus rehabilitation motion.
The theoretical values in Figures 22, 23, and 24 are simulated using ADAMS software. From the test results, we found that the overall trends of the actual value were consistent with the simulation results.
The actual working angles deviate from the ideal value between -1.7° and +1.6°, when the working angles change from -10° to +10° as shown in Figure 22. The actual working angles deviate from the ideal value by -1.2° to+1.0°, when the working angles change from -15° to +15° as shown in Figure 23. The actual working angles deviate from the ideal value by -1.1° to+0.6°, when the working angles change from -20° to +20° as shown in Figure 24.
The experiment result for the three working velocities corresponding to the angles changing in Figures 22, 23, and 24 is shown in Figure 25. The characteristic value of the working velocities is shown in Table 6. The actual velocity values are obtained by differential calculation from the actual working angle change values. While from Figure 25 the varus/valgus rehabilitation motion is not smooth, there are some velocity fluctuations. From Table 6, theoretical values of the velocity are obtained by calculating from the modified sine motion law used by the upper platform motion; the actual testing maximum value and minimum value of the velocity are larger than the ones of the theoretical velocity. The test results show that the speed fluctuates greatly when the upper platform moves to the extreme position and horizontal position. This result is caused by the rigid-flexible hybrid structure of the robot. The spring is subjected to the pressing force which causes it to fluctuate in the abovementioned stage, causing deformation fluctuations.
The working velocities for the varus/valgus rehabilitation motion.
The angular velocity characteristic value changes for the upper platform.
Working angles (°)
-20° to +20°
-15° to +15°
-10° to +10°
Angular velocity (°/s)
Theoretical value
Actual value
Theoretical value
Actual value
Theoretical value
Actual value
Maximum value
6.978
7.624
5.233
5.658
3.489
4.175
Minimum value
-6.978
-7.503
-5.233
-5.966
-3.489
-3.850
A power analyzer Hioki PW6001 is used to measure the working currents of the motor. A working interface of the power analyzer is shown in Figure 26. The working currents of the motor for the varus/valgus rehabilitation motion (from -20° to +20°) are shown in Figure 27. The maximum value of the currents is 2.62 A. The working currents of the motor for the varus/valgus rehabilitation motion (from -10° to +10°) are shown in Figure 28, and the maximum value of the currents is 2.21 A. From Table 4, the rated line current of the servomotor is 2.8 A, which indicates that the motor works in the normal range. The current changes periodically, and its period is basically the same with the speed period. The test results show that the current is relatively stable at 8.6-10 s. This is due to the fact that the upper platform moves close to the horizontal position and the upper platform moves at a lower speed. The load of the platform is mainly carried by the ball pin pair, and the load component of the varus/valgus branch chain is small and the change is not obvious.
A working interface of the power analyzer.
The working currents of the motor for the varus/valgus rehabilitation motion (from -20° to +20°).
The working currents of the motor for the Varus/valgus rehabilitation motion (from -10° to +10°).
According to the on-the-spot observation and test, the error between the actual values and the theoretical values may be caused by manufacturing and assembling precision for the structure, especially the manufacturing precision of the spring, the screw, etc. The performance of the spring is a critical factor.
6.2.5. Rehabilitation Motion on a Human Ankle Joint
We tested the robot on a human ankle joint in the lab; the test scenario is as shown in Figure 29.
Testing the robot on a human ankle joint.
We have tested the varus/valgus motion, the dorsiflexion/plantar flexion motion, and the compound motion, separately. The rehabilitation motion of the upper platform is driven by the modified sine motion law, and the cycle time is 20 s.
Here, only the varus/valgus motion (working angles changing from -15° to +15°) is used as an example. The experiment results are shown in Figure 30. The actual value deviates from the ideal value by -2.1° to +0.9°.
The working angles (from -15° to +15°) for the varus/valgus rehabilitation motion tested on a human ankle joint.
Analyzing the result in Figure 30, we found that the overall trends of the actual results tested on the human ankle joint are consistent with the theoretical values. Load on the upper platform for the human ankle joint is 7.2 kg. Comparing this result with the result tested on adopting the cuboid load (cuboid load is 2 kg, as shown in Figure 18), there are small differences.
A further in-depth study about clinical data is our future work target.
7. Conclusion
This paper presents an ankle joint rehabilitation robot with a rigid-flexible hybrid driving structure based on a 2-S′PS′ mechanism. The robot has two DOFs but can realize the three kinds of motion for the ankle joint rehabilitation.
The robot uses a centre ball pin pair as the main support to reduce the load of the drive system. The structure of the robot consisting of an upper platform and a centre ball pin pair is a mirror image of a patient’s foot and ankle joint, which accords with physiological characteristics of the human body. In the dorsiflexion/plantar flexion or varus/valgus driving system, the robot adopts the rigid-flexible hybrid structure and the robot motion is completely decoupled.
The presented robot has low manufacturing and usage costs. The theoretical analysis and experimental prototype show that the robot can meet some rehabilitation needs of different patients.
NomenclatureP′¨O:
Acceleration of the mass centre point P
x12:
The initial compression displacements of the upper spring of Branch Chain 1
x22:
The initial compression displacements of the lower spring of Branch Chain 1
x32:
The initial compression displacements of the upper spring of Branch Chain 2
x42:
The initial compression displacements of the lower spring of Branch Chain 2
FB13:
The force between Branch Chain 1 and the upper platform
FB13′:
The reaction force of the upper platform on the guide frame
JX:
The rotational inertia of the upper platform around the X0-axis
m:
The weight of the upper platform
Δx1:
The rising displacement of the slider block
Δx2:
The rising displacement of the guide frame
F13:
The force of the upper spring of Branch Chain 1 on the guide frame
F13′:
The force of the upper spring of Branch Chain 1 on the guide block
F23:
The force of the lower spring of Branch Chain 1 on the guide frame
F23′:
The forces of the lower spring of Branch Chain 1 on the slider block
K:
The elastic coefficient of the spring
m1:
The mass of the slider block
G1:
The gravity of the slider block
n:
The structural size of the upper platform
b:
The structural size of the upper platform
l3:
The structure height of the ball pin
l4:
The length between the centre point O of the centre ball pin and the lower platform
sn:
The screw pitch of the screw rod
li:
The overall length of the branch chain
l1:
The overall length of the branch chain in the initial state
l50:
The solid length of the upper spring
l60:
The solid length of the lower spring
l30:
The length of the guide frame
l20:
The distance between the top of the guide frame and the upper platform
l10:
The distance between the U-shaped connector and the lower platform
l40:
The length of the screw rod
l80:
The width of the slider block
l70:
The length between the centre of the slider block and the lower edge of the guide frame at the initial position
l90:
The distance between the lower edge of the guide frame and the upper edge of the U-shaped connector
l6:
The thickness of the guide frame
la:
The length of a thigh
lb:
The length of a shank
lc:
The height of the medial malleolus
h:
The total displacement of the motion phase
th:
The total time of the motion phase.
Data Availability
The data used to support the findings of this study are available from the corresponding author upon request.
Conflicts of Interest
The authors declare that they have no conflicts of interest.
Acknowledgments
This work is supported by the National Natural Science Foundation of China (Grant no. 51705473); Key Science and Technology Research Project of Henan Province (182102210159), China; Doctoral Research Funded Projects of Zhengzhou University of Light Industry (2016BSJJ009); and Natural Science Foundation of Henan Province (Grant no. 162300410316).
HashimotoY.KomadaS.HiraiJ.Development of a biofeedback therapeutic exercise supporting manipulator for lower limbs2006 IEEE International Conference on Industrial Technology2006Mumbai, India35235710.1109/icit.2006.3723742-s2.0-51349140534RoyA.KrebsH. I.WilliamsD. J.BeverC. T.ForresterL. W.MackoR. M.HoganN.Robot-aided neurorehabilitation: a novel robot for ankle rehabilitation200925356958210.1109/TRO.2009.20197832-s2.0-67649277691SagliaJ. A.TsagarakisN. G.DaiJ. S.CaldwellD. G.A high-performance redundantly actuated parallel mechanism for ankle rehabilitation20092891216122710.1177/02783649091042212-s2.0-69249101252YoonJ.RyuJ.A novel reconfigurable ankle/foot rehabilitation robotProceedings of the 2005 IEEE International Conference on Robotics and Automation2006Barcelona, Spain2290229510.1109/robot.2005.15704542-s2.0-33846122300JamwalP. K.XieS. Q.TsoiY. H.AwK. C.Forward kinematics modelling of a parallel ankle rehabilitation robot using modified fuzzy inference201045111537155410.1016/j.mechmachtheory.2010.06.0172-s2.0-77956393450GironeM.BurdeaG.BouzitM.PopescuV.DeutschJ. E.A Stewart platform-based system for ankle telerehabilitation200110220321210.1023/A:10089381210202-s2.0-0035280872VenevaI.Design and implementation of device for control of active ankle–foot orthosis20104048192AgrawalA.SangwanV.BanalaS. K.AgrawalS. K.Binder-MacleodS. A.Design of a novel two degree-of-freedom ankle-foot orthosis20071291111371143BiZ. M.Design of a spherical parallel kinematic machine for ankle rehabilitation201327212113210.1080/01691864.2012.7033062-s2.0-84874932724LuZ.WangC.DuanL.LiuQ.SunT.ShenY.ShiQ.LiM.WangY.LongJ.WeiJ.LiW.TakanishiA.WuZ.Development of an ankle robot MKA-III for rehabilitation training2016 IEEE International Conference on Real-time Computing and Robotics (RCAR)2016Angkor Wat, Cambodia52352710.1109/rcar.2016.77840842-s2.0-85010069463AggogeriF.PellegriniN.AdaminiR.Functional design in rehabilitation: modular mechanisms for ankle complex20162016810.1155/2016/97078012-s2.0-849812873989707801ErdoganA.CelebiB.SaticiA. C.PatogluV.Assist on-ankle: a reconfigurable ankle exoskeleton with series-elastic actuation201741374375810.1007/s10514-016-9551-72-s2.0-84959533340LiaoZ.YaoL.LuZ.ZhangJ.Screw theory based mathematical modeling and kinematic analysis of a novel ankle rehabilitation robot with a constrained 3-PSP mechanism topology20182335136010.1007/s41315-018-0063-930294664RosadoW. M. A.ValdesL. G. V.OrtegaA. B.AscencioJ. R.BeltranC. D. G.Passive rehabilitation exercises with an ankle rehabilitation prototype based in a robot parallel structure2017151485610.1109/TLA.2017.78278872-s2.0-85010986986MengW.XieS. Q.LiuQ.LuC. Z.AiQ.Robust iterative feedback tuning control of a compliant rehabilitation robot for repetitive ankle training201722117318410.1109/TMECH.2016.26187712-s2.0-85013427974ZhangM.MengW.DaviesT. C.ZhangY.XieS. Q.A robot-driven computational model for estimating passive ankle torque with subject-specific adaptation201663481482110.1109/TBME.2015.24751612-s2.0-8496362344926340767AyasM. S.AltasI. H.SahinE.Fractional order based trajectory tracking control of an ankle rehabilitation robot201640255056410.1177/01423312166678102-s2.0-85041084909MahoneyR.Robotic products for rehabilitation: status and strategyInternational Conference on Rehabilitation Robotics1997Bath, UK1222KhalidY. M.GouwandaD.ParasuramanS.A review on the mechanical design elements of ankle rehabilitation robot2015229645246310.1177/09544119155855972-s2.0-84930437821QianZ. Q.BiZ. M.Recent Development of Rehabilitation Robots201572111HouY.-P.CengX.-F.XuQ.The mechanism research for ankle rehabilitation20133525558LiuG.GaoJ.YueH.ZhangX.LuG.Design and kinematics analysis of parallel robots for ankle rehabilitation2006 IEEE/RSJ International Conference on Intelligent Robots and SystemsOctober 2006Beijing, China25325810.1109/iros.2006.2817102-s2.0-34250660060YoonJ.RyuJ.LimK.-B.Reconfigurable ankle rehabilitation robot for various exercises200622S1S15S3310.1002/rob.201502-s2.0-33750330006SagliaJ. A.TsagarakisN. G.DaiJ. S.CaldwellD. G.A high performance 2-DoF over-actuated parallel mechanism for ankle rehabilitation2009 IEEE International Conference on Robotics and Automation (ICRA 2009)May 2009Kobe, Japan2180218610.1109/robot.2009.51526042-s2.0-70350352745JamwalP. K.XieS.AwK. C.Kinematic design optimization of a parallel ankle rehabilitation robot using modified genetic algorithm200957101018102710.1016/j.robot.2009.07.0172-s2.0-70249086531JamwalP. K.XieS. Q.HussainS.ParsonsJ. G.An adaptive wearable parallel robot for the treatment of ankle injuries2014191647510.1109/tmech.2012.22190652-s2.0-84895064445DingY.SivakM.WeinbergB.MavroidisC.HoldenM. K.NUVABAT: Northeastern University virtual ankle and balance trainer2010 IEEE Haptics SymposiumMarch 2010Waltham, MA, USA50951410.1109/haptic.2010.54446082-s2.0-77952697832YuG. R.YangY. F.ZhangK.MeiJ.ZhuH.ZhouJ. L.MaR. Z.WangY. J.Experimental study of subtalar and ankle joint in hind foot motion2005254236239National Health and Family Planning Commission of PRCNational Report on Nutrition and Chronic Diseases of Chinese Residents2015Chinese Academy of Standardization and Information Classified CodingHuman dimensions of Chinese adults1988Beijing, ChinaGB/T 10000-1988, Standards Press of ChinaWangL.-W.LiH.-P.WangX.-J.DuW.-L.SongK.-K.Simulation analysis of bionic auxiliary device for ankle rehabilitation based on RecurDynInternational Conference on Mechatronics and Automation Engineering (ICMAE2016)2017Xiamen, China12613510.1142/9789813208537_0016