Disclosure of Invention
Aiming at the defects of the prior art, the application aims to provide the rigid-flexible coupling ankle rehabilitation robot.
The application solves the technical problems by adopting the following technical scheme:
a rigid-flexible coupling ankle rehabilitation robot comprises a fixed platform, a movable platform, a first branched chain, a second branched chain and a third branched chain; the three branched chains are connected with the fixed platform and the movable platform, and the first branched chain and the second branched chain have the same structure and are symmetrically distributed on two sides of the third branched chain; it is characterized in that the method comprises the steps of,
the first branched chain comprises a first branched chain driving motor, a first branched chain first connecting rod, a first branched chain rigid-flexible coupling module and a first branched chain second connecting rod; the first branched chain driving motor is connected with the fixed platform, one end of a first branched chain first connecting rod is connected with an output shaft of the first branched chain driving motor, the other end of the first branched chain first connecting rod is rotationally connected with the first branched chain rigid-flexible coupling module, the first branched chain rigid-flexible coupling module is simultaneously rotationally connected with one end of a first branched chain second connecting rod, and the other end of the first branched chain second connecting rod is rotationally connected with the middle rear part of the movable platform;
the third branched chain comprises a third branched chain driving motor, a third branched chain first connecting rod, a third branched chain rigid-flexible coupling module, a third branched chain second connecting rod and a third branched chain third connecting rod; the third branched chain driving motor is positioned at the lower part of the fixed platform, an output shaft of the third branched chain driving motor is connected with one end of a third branched chain first connecting rod, the other end of the third branched chain first connecting rod is rotationally connected with a third branched chain rigid-flexible coupling module, the third branched chain rigid-flexible coupling module is simultaneously rotationally connected with one end of a third branched chain second connecting rod, two sides of the other end of the third branched chain second connecting rod are respectively rotationally connected with two sides of the upper end of a third branched chain third connecting rod, and the lower end of the third branched chain third connecting rod is fixedly connected with the middle and rear part of the movable platform;
the first branched rigid-flexible coupling module and the third branched rigid-flexible coupling module have the same structure and comprise four connecting rods and torsion springs; the four connecting rods are sequentially connected in a rotating way to form a parallelogram, and a torsion spring is arranged at the joint of two adjacent connecting rods;
the rehabilitation robot is provided with a centering ball and a movable ball center, a driving motor of three branched chains controls the posture of a movable platform to realize dorsiflexion/toe flexion, varus/valgus and varus/valgus of an ankle joint, and a rigid-flexible coupling module of the three branched chains adjusts the position of the movable ball center through a torsion spring so that the movable ball center moves on a spherical surface taking the length of a talus as a radius to fit the position of a human subtalar joint.
Further, the talus pose parameter (α) of the rehabilitation robot T /β T ) The mapping relation between the foot posture parameter (alpha/beta/gamma) and the foot posture parameter (alpha/beta/gamma) is shown as a formula (19), and the structural parameter of the rehabilitation robot is obtained according to the mapping relationRealizing structural optimization;
wherein: g α (·)、g β (. Cndot.) is a mapping function, alpha T And beta T For the rotation angle of the talus around the x, y axes of the coordinate system, alpha, beta and gamma are the rotation angles of the foot around the x, y and z axes of the coordinate system, (b) 11 ,b 12 ,b 13 ) T Is the axis O 1 B U1 Unit vector b in fixed coordinate system 1 ,(b 21 ,b 22 ,b 23 ) T Is the axis O 1 B U2 Unit vector b in fixed coordinate system 2 ,Is the axis O 1 A 1 Unit vector a in fixed coordinate system 1 Included angle with x-axis of fixed coordinate system, +.>Is the unit vector a 1 The angle between the projection on the fixed coordinate plane yoz and the z-axis of the fixed coordinate system, +.>Is the axis O 2 C 1 Unit vector c in fixed coordinate system 1 Included angle with x-axis of dynamic coordinate system, +.>Is the unit vector c 1 The projection on the dynamic coordinate system plane yoz is at an angle to the x-axis of the dynamic coordinate system, +.>And->Respectively the unit vectors b i With axis O 1 A i And O 2 C i Angle of (1)>Is of a double-core line O 1 O 2 And unit vector b 1 Or b 2 Included angle of O 1 Centering ball for rehabilitation robot, O 2 The dynamic sphere center of the rehabilitation robot, b i Is the axis O 1 B Ui Unit vector in fixed coordinate system, B Ui Is the rotation center of the i th first connecting rod and the first branched rigid-flexible coupling module, A i C is the rotation center of the ith branched chain driving motor and the first connecting rod i Is the rotation center of the second connecting rod of the ith branched chain and the movable platform, < >>Is an included angle->Cosine values of (2); the origin of the fixed coordinate system is positioned at the center of the spherical center of the rehabilitation robot, the z axis is vertical to the movable platform downwards, and the y axis is rigidly and flexibly coupled with the first connecting rod of the third branched chain and the third branched chainThe rotation axes of the combination modules are overlapped, and the x-axis obeys the right hand rule; the origin of the dynamic coordinate system is positioned at the dynamic sphere center of the rehabilitation robot, the z axis is vertical to the dynamic platform and downward, the x axis coincides with the rotation axis on the right side of the upper end of the third branched chain third connecting rod and the right side of the other end of the third branched chain second connecting rod, and the y axis complies with the right hand rule.
Further, the unit vector b i The following equation is satisfied:
wherein: (a) i1 ,a i2 ,a i3 ) Is the axis O 1 A i Unit vector coordinates in a fixed coordinate system, (b) i1 ,b i2 ,b i3 ) T Is the unit vector b i Coordinates of (c) i1 ,c i2 ,c i3 ) Is the axis O 2 C i The unit vector coordinates in the fixed coordinate system,is an included angle->Cosine value of>Is an included angle->Cosine values of (a) are provided.
Further, the rotation axes of the two ends of the first branched chain first connecting rod, the rotation axes of the two ends of the second branched chain first connecting rod and the rotation axes of the third branched chain first connecting rod and the third branched chain rigid-flexible coupling module are intersected with the centering center of the rehabilitation robot; the axes of the two ends of the first branched chain second connecting rod, the axes of the two ends of the second branched chain second connecting rod, the axes of the two ends of the third branched chain second connecting rod and the axes of the third branched chain third connecting rod and the connecting hole of the movable platform are intersected with the movable spherical center of the rehabilitation robot.
Compared with the prior art, the application has the beneficial effects that:
1. aiming at different tibial-to-subtalar joint motion coupling relations of different patients, on the basis of an SS model, a rigid-flexible coupling module is added into each branched chain, so that not only can the dorsiflexion/plantar flexion, the varus/valgus and the varus/valgus of the ankle joint be realized, but also the position of a movable ball center is finely adjusted through a torsion spring of the rigid-flexible coupling module in the motion process, so that the movable ball center moves on a spherical surface with the length of a talus as a radius to fit the position of the subtalar joint, the motion coupling between the tibial-to-subtalar joint and the subtalar joint is realized, thereby conforming to different positions of feet of the patients, conforming to different rehabilitation tracks of different patients, improving the rehabilitation efficiency of the ankle joint and reducing the possibility of secondary injury.
2. According to the mapping relation between the talus posture parameters and the foot posture parameters, the structural parameters of the rehabilitation robot can be obtained, and the optimal design of the rehabilitation robot is realized.
Detailed Description
Specific embodiments are given below with reference to the accompanying drawings. The specific embodiments are only used for describing the technical scheme of the application in detail, and are not used for limiting the protection scope of the application.
The application relates to a rigid-flexible coupling ankle rehabilitation robot which comprises a fixed platform 1, a movable platform 2, a first branched chain 3, a second branched chain 4 and a third branched chain 5; the three branched chains are connected with the fixed platform 1 and the movable platform 2, and the first branched chain 3 and the second branched chain 4 are symmetrically distributed on two sides of the third branched chain 5.
The fixed platform 1 comprises an upper connecting plate 101, a fixed platform upright post 102, a lower connecting plate 103 and a base 104; the base 104 is a frame structure formed by welding aluminum profiles, the lower connecting plate 103 is positioned on the base 104, the upper connecting plate 101 is connected with the lower connecting plate 103 through a plurality of movable platform upright posts 102, the upper connecting plate 101 is provided with a U-shaped notch for accommodating the lower leg of a human body, and the movable platform 2 is positioned in a space between the upper connecting plate 101 and the lower connecting plate 103.
The first branched chain 3 and the second branched chain 4 have the same structure, and the first branched chain 3 is taken as an example for explanation, and the first branched chain 3 comprises a first branched chain driving motor 301, a first branched chain first connecting rod 302, a first branched chain rigid-flexible coupling module 303 and a first branched chain second connecting rod 304; the first branched chain driving motor 301 is fixedly connected with the upper connecting plate 101 of the fixed platform 1, the first branched chain driving motor 301 is connected with one end of a first branched chain first connecting rod 302 through a speed reducer, the other end of the first branched chain first connecting rod 302 is rotationally connected with a first branched chain rigid-flexible coupling module 303, the first branched chain rigid-flexible coupling module 303 is simultaneously rotationally connected with one end of a first branched chain second connecting rod 304, and the other end of the first branched chain second connecting rod 304 is rotationally connected with the middle and rear part of the movable platform 2.
The third branched chain 5 comprises a third branched chain driving motor 501, a third branched chain first connecting rod 502, a third branched chain rigid-flexible coupling module 503, a third branched chain second connecting rod 504 and a third branched chain third connecting rod 505; the third branched chain driving motor 501 is fixed at the bottom of the lower connecting plate 103 of the fixed platform 1, an output shaft of the third branched chain driving motor 501 passes through the lower connecting plate 103 and is connected with one end of a third branched chain first connecting rod 502 through a speed reducer, the other end of the third branched chain first connecting rod 502 is rotationally connected with a third branched chain rigid-flexible coupling module 503, the third branched chain rigid-flexible coupling module 503 is simultaneously rotationally connected with one end of a third branched chain second connecting rod 504, two sides of the other end of the third branched chain second connecting rod 504 are respectively rotationally connected with two sides of the upper end of a third branched chain third connecting rod 505, and the lower end of the third branched chain third connecting rod 505 is fixedly connected with the middle rear part of the movable platform 2;
the rotation axes of the two ends of the first link 302, the rotation axes of the two ends of the second link, and the rotation axes of the first link 502 and the rigid-flexible coupling module 503 intersect at a point, which is the centering O of the rehabilitation robot 1 The method comprises the steps of carrying out a first treatment on the surface of the The axes of the rotation of the two ends of the first branched chain second connecting rod 304, the rotation of the two ends of the second branched chain second connecting rod, the rotation of the two ends of the third branched chain second connecting rod 504 and the rotation of the third branched chain third connecting rod 505 and the axis of the connecting hole of the third branched chain third connecting rod 505 and the movable platform 2 intersect at a point which is the movable spherical center O of the rehabilitation robot 2 。
The rigid-flexible coupling modules of the three branches have the same structure, wherein the first rigid-flexible coupling module 303 of the branched chain comprises a first rigid-flexible coupling module connecting rod 303-1, a second rigid-flexible coupling module connecting rod 303-2, a third rigid-flexible coupling module connecting rod 303-3, a fourth rigid-flexible coupling module connecting rod 303-4 and a torsional rigid-flexible coupling module spring 303-5; the two ends of the rigid-flexible coupling module second connecting rod 303-2 are respectively connected with the rigid-flexible coupling module first connecting rod 303-1 and the rigid-flexible coupling module fourth connecting rod 303-4 in a rotating way through connecting shafts, the two ends of the rigid-flexible coupling module third connecting rod 303-3 are respectively connected with the rigid-flexible coupling module first connecting rod 303-1 and the rigid-flexible coupling module fourth connecting rod 303-4 in a rotating way through connecting shafts, and the connecting points of the rigid-flexible coupling module first connecting rod 303-1, the rigid-flexible coupling module second connecting rod 303-2, the rigid-flexible coupling module third connecting rod 303-3 and the rigid-flexible coupling module fourth connecting rod 303-4 form a parallelogram, and each connecting shaft is provided with a rigid-flexible coupling module torsion spring 303-5 for realizing the resetting of the parallelogram; one end of a first connecting rod 303-1 of the rigid-flexible coupling module is rotatably connected with the other end of the first branched-chain first connecting rod 302, and one end of a fourth connecting rod 303-4 of the rigid-flexible coupling module is rotatably connected with one end of a second connecting rod 304 of the first branched-chain.
When the ankle joint rehabilitation training device is used, the feet of a patient are bound on the movable platform 2, the driving motors of the three branched chains are controlled by the controller, the movable platform 2 moves around the movable sphere center, and the movable platform 2 drives the feet of the patient to move, so that the ankle joint rehabilitation training is realized. The robot has three rotational degrees of freedom and two movement degrees of freedom, wherein the three rotational degrees of freedom are embodied in three driving motors, so that the complete control of the posture of the movable platform 2 can be realized, and the dorsiflexion/toe flexion, the varus/valgus and the internal/external rotation of the ankle joint are realized. The two degrees of freedom of movement are embodied in the rigid-flexible coupling modules of the three branched chains, and the positions of the movable spherical centers are finely adjusted through the torsion springs, so that the movable spherical centers move on the spherical surfaces with the length of the talus as the radius to fit the positions of the joints below the talus of a patient, so that the positions of feet of the patient are complied with, and the rehabilitation robot can control the positions and the postures of the movable platform to complied with the rehabilitation tracks of different patients.
In addition to the rigid ankle structure, the ankle joint includes a number of complex tissue ligaments under which the tibial and subtalar joints are no longer independent of each other, but instead are coupled in motion, which allows the ankle joint to macroscopically exhibit only three degrees of freedom, namely dorsiflexion/toe flexion in the sagittal plane, varus/valgus in the coronal plane, and varus/valgus movements about the longitudinal axis (horizontal plane) of the body, while the momentary posture of the talus is related to these three macroscopic angles of movement. Therefore, in order to accurately describe the instantaneous motion law of the ankle joint, the ankle joint rehabilitation robot is provided by considering the effect influence of ankle tissue ligaments on the basis of an SS type ankle bone structure.
When the rehabilitation robot is used for ankle rehabilitation training, a foot-distance associated motion model which can describe the motion correlation of ankle talus and foot is constructed, namely a man-machine system model. Defining a fixed coordinate system o of a rehabilitation robot 1 -x 1 y 1 z 1 Origin and centering O 1 Overlap, z 1 Shaft sagStraight down the moving platform, y 1 The axis coincides with the rotation axis of the third branched first link 502 and the third branched rigid-flexible coupling module 503, x 1 The axis is determined by the right hand rule; dynamic coordinate system o of rehabilitation robot 2 -x 2 y 2 z 2 Origin and dynamic sphere center O 2 Overlap, z 2 The axis is vertical to the movable platform and downwards, x 2 The axis coincides with the rotation axis of the right side of the upper end of the third branched chain third connecting rod 505 and the right side of the other end of the third branched chain second connecting rod 504, y 2 The axis is determined by the right hand rule.
The foot pose matrix is expressed as:
R Foot =Rot(x 1 ,α)Rot(y 1 ,β)Rot(z 1 ,γ) (1)
wherein: rot (x) 1 ,α)、Rot(y 1 Beta) and Rot (z 1 γ) is the rotation matrix of the foot around each axis of the fixed coordinate system, α, β and γ are the rotation angles of the foot around each axis of the fixed coordinate system, i.e., dorsiflexion/plantarflexion, varus/valgus, and varus/valgus angles of the ankle joint, α e (-30 °,45 °), β e (-22 °,22 °), γ e (-36 °,36 °);
the talus pose matrix is expressed as:
R Talus =Rot(x 1 ,α T )Rot(y 1 ,β T )Rot(z 1 ,γ T )(3)
wherein: rot (x) 1 ,α T )、Rot(y 1 ,β T ) And Rot (z) 1 ,γ T ) Rotation matrix, alpha, for talus around each axis of a fixed coordinate system T 、β T And gamma T Setting the rotational angle of each axis of the coordinate system for the talus, i.e., dorsiflexion/plantarflexion, varus/valgus and varus/valgus angle of the talus;
the pose transformation matrix using the dynamic coordinate system relative to the fixed coordinate system can be used for ankle instantaneous motion description, and is therefore defined as an "ankle motion matrix", expressed as:
p Talus =R Talus (0,0,l) T (5)
wherein: p is p Talus The position vector of the center of the tibial talus joint in a fixed coordinate system is represented by l, which is the talus length;
it is not difficult to find out by taking formula (3) into formula (5), vector p Talus Angle gamma with talus internal/external rotation T Independent, i.e. gamma T Does not affect the motion description of the ankle joint, so only the rotation angle alpha is used T And beta T Defined as talus motor parameters, and rotational angles α, β, and γ are defined as foot stance parameters;
talus pose parameter (alpha) T /β T ) The functional model as a function of foot posture parameter (α/β/γ) is defined as a "foot-distance correlated motion model", which is expressed as:
wherein: k (k) α 、k β As a scale factor, E α (α,β,γ)、E β (α, β, γ) is an error function;
to ensure structural symmetry of the rehabilitation robot, the axis O 1 A 0 Z with fixed coordinate system 1 Axis of coincidence, axis O 1 A 1 With O 1 A 2 With respect to plane y 1 o 1 z 1 Symmetrically arranged, A 0 A is the connection center of the third branched chain third connecting rod 505 and the movable platform 2 1 A is the rotation center of the first branched chain driving motor 301 and the first branched chain first connecting rod 302 2 Is the rotation center of the second branched chain driving motor and the second branched chain first connecting rod, thus, the axis O 1 A i (i=0, 1, 2) unit vector a in fixed coordinate system i Can be expressed by spherical coordinates as:
wherein:is the unit vector a 1 And x 1 Included angle of shaft->Is the unit vector a 1 In plane y 1 o 1 z 1 Projection onto and z 1 Included angle of shaft->Is an included angle->Sine and cosine values of +.>Is an included angle->Sine and cosine values of (a);
axis O 2 C 0 And x 2 Axis of coincidence, axis O 2 C 1 With O 2 C 2 With respect to plane y 2 o 2 z 2 Symmetrically arranged, C 0 C is the rotation center of the right side of the third branched chain second connecting rod and the right side of the third branched chain third connecting rod 1 C is the rotation center of the first branched chain second connecting rod and the movable platform 2 The second connecting rod is a second branched chain and is the rotation center of the second connecting rod and the movable platform; thus, the axis O 2 C i (i=0, 1, 2) unit vector c in fixed coordinate system i Can be expressed by spherical coordinates as:
wherein:is the unit vector c 1 And x 2 Included angle of shaft->Is the unit vector c 1 In plane y 2 o 2 z 2 Projection onto and x 2 Included angle of shaft->Is an included angle->Sine and cosine values of +.>Is an included angle->Sine and cosine values of (a);
axis O 1 B Ui Parallel to O 2 B Li (i=0,1,2),B Ui B is the rotation center of the first connecting rod of the ith branched chain and the rigid-flexible coupling module Li Is the rotation center of the i-th branched chain rigid-flexible coupling module and the second connecting rod, so that the axis O 1 B Ui Unit vector b in fixed coordinate system i Expressed as:
b i =(b i1 ,b i2 ,b i3 ) T (9)
the axis O can be calculated according to the pose transformation matrix of the dynamic coordinate system relative to the fixed coordinate system 2 C i The unit vector coordinates in the fixed coordinate system are:
O 2 C i =R Foot ×c=(c 1 ,c 2 ,c 3 ) T (10)
define a plane perpendicular to the axis O 1 A i And O 2 C i Is d i It is expressed as:
d i =(d i1 ,d i2 ,d i3 )=O 1 A i ×O 2 C i =(a i2 c i3 -a i3 c i2 ,a i3 c i1 -a i1 c i3 ,a i1 c i2 -a i2 c i1 ),i=0,1,2 (11)
according to the unit vector b i With axis O 1 A i And O 2 C i Included angles of (a) are respectivelyAnd->The following equation can thus be established:
wherein,,and->Respectively is an included angle->And->Cosine values of (2);
the method comprises the following steps of:
during rehabilitation exercise, the double-axis line O of the rehabilitation robot 1 O 2 Always coincides with the ankle talus, so according to formula (4), the two-axis line O 1 O 2 The unit vector coordinates within the fixed coordinate system can be expressed as:
to ensure the symmetry of the rehabilitation robot structure, the double-core line O is arranged 1 O 2 Vector b of AND 1 And b 2 Are equal in included angleThis can be achieved by:
the preparation method comprises the following steps of:
combining equations (17), (18), (13), (14) and (11) may yield talus pose parameters (α) T /β T ) Mapping relation with foot posture parameter (alpha/beta/gamma), expressed as:
wherein: g α (·)、g β (. Cndot.) is a mapping function;
talus posture parameter (alpha) is known T /β T ) And foot posture parameter (alpha/beta)Gamma) of the rehabilitation robot according to formula (19)The optimal design of the rehabilitation robot is realized.
The application is applicable to the prior art where it is not described.