I.INTRODUCTION

Exoskeletal devices are widely used for rehabilitation of patients with disorders of the musculoskeletal system [18]. The maximum effect is achieved when the patient and the exoskeleton form an integrated human-machine system (HMS), the effectiveness of which is determined by the degree of consistency (synchronicity) of the elements of this system, including the human and active exoskeleton [912]. To meet this requirement, the system contains a human-machine interface (HMI), which is a technical means that provides interaction between the patient and the exoskeleton. This system, consisting of the patient, the exoskeleton, and HMI, was named bio-electromechanical system (BEMS).

The BEMS structure consists of an exoskeleton, a HMI, a patient, and a support surface.

At an early stage of rehabilitation, the patient occupies a passive position, and the movements of the lower limbs are performed using an exoskeleton along program-defined trajectories in accordance with the rehabilitation exercises performed, for example, the patient’s walking on a path.

At later stages, a combined mode of BEMS operation is possible, in which at certain times the patient takes an active position and the exoskeleton implements the movements set by the patient, and at another time, the operator switches to a passive mode, and the exoskeleton performs the movements set by the program.

Various control strategies are implemented in these modes [1315]. In the first case, we can talk about a tracking control system, and in the second one about a combination of tracking and copying control strategies. As the review of information sources shows, most scientific works consider walking on a fixed base [1618], which in most cases reflects the real conditions of the use of walking machines, but in the case of creating a rehabilitation complex, the task of studying walking on a movable base, synchronizing the movement of the walking device, and the moving surface is relevant [19,20].

The design of the exoskeleton considered in this work is equipped with special sensors system that allows assessing the interaction forces between the operator and the exoskeleton [19]. Also, an important feature of the work is the use of piecewise polynomial functions when specifying the exoskeleton foot movement trajectory.

The device studied in the article is intended for mechanotherapy for patients with lower extremities musculoskeletal system dysfunctions [6,17].

The main contributions of this paper are as follows:

  • −the mathematical models of BEMS executive units movement,
  • −the new trajectory planning method,
  • −algorithms of the system motion control that provides collaborative functioning of the human exoskeleton and the movable supporting surface,
  • −the numerical modeling results, proving the proposed methods applicability in the exoskeleton practical implementation.

II.MATHEMATICAL MODEL AND FORMULATION OF THE SIMULATION PROBLEM

The paper deals with the lower limbs’ exoskeleton during the walk implementation along the moving belt of a treadmill (Fig. 1). The upper part of the exoskeleton 1 is attached to a fixed base – the frame. The femoral links 2 (left leg) and 4 (right leg) by means of active joints that contain electric drives creating moments, that can have an assisting effect on the patient, are attached to the body. To control the relative position of the links, the active hinges are equipped with angle sensors and torque sensing systems. In a similar way, the femoral links are connected to the lower leg links 3 (left leg) and 5 (right leg).

FIGURE 1. Design diagram of the device in the process.

FIGURE 2. Planning the trajectory of moving links of a walking machine.

FIGURE 3. Trajectories defined by equations (6)–(9) for the step parameters: (a) s¯=(0.2,0.3,0.7,0.5,4)T, (b) s¯=(0.6,0.1,0.8,0.25,4)T.

FIGURE 4. Walking simulation results: a – at 0 s, b – at 0.2 s, c – at 0.4 s, d – at 0.6 s.

The task of the system that controls drives of the hip and knee joints of the device is to realize this relative motion of links, at which points OL3 and OR3 move along the desired trajectory, implementing a walking motion of the exoskeleton. An important feature of the desired trajectory is to ensure that there is no slippage or impact at the moment of contact with the surface, which is provided by the choice of appropriate boundary conditions. In this work, there are number of assumptions: The trajectory of the foot attachment point is symmetrical with respect to the vertical axis, the movable surface is parallel to the horizon, the size and shape of the feet are neglected, considering that the contact of the robot’s links with the surface occurs through the points OL3 and OR3.

For mathematical description of the kinematics of motion, there is a system of equations:

xOL2=xO+l1cos(ϕL1)yOL2=yO+l1sin(ϕL1)xOR2=xO+l1cos(ϕR1)yOR2=yO+l1sin(ϕR1);xOL3=xO+l1cos(ϕL1)+l2cos(ϕL2)yOL3=yO+l1sin(ϕL1)+l2sin(ϕL2)xOR3=xO+l1cos(ϕR1)+l2cos(ϕR2)yOR3=yO+l1sin(ϕR1)+l2sin(ϕR2)
where l1 and l2 are long links, respectively: thighs and shins, xO, yO – are coordinates of the femoral joint in the inertial reference system, ϕLi, ϕRi are absolute rotation angles of the left and right leg links.

The links’ rotation angles can be determined in various ways, in the framework of this work, they are defined as follows:

ϕL1={arctng(yOL3xOL3)+arccos(l12l22+(xOL32+yOL32)2l1xOL32+yOL32)if(xOL3>0)arctng(yOL3xOL3)+arccos(l12l22+(xOL32+yOL32)2l1xOL32+yOL32)πif(xOL30)ϕL2=ϕL1+(π+arccos(l12+l22(xOL32+yOL32)2l1l2))

Using these equations, it is possible to determine the absolute rotation angles of links when a point OL3 moves in the lower quadrants of the coordinate plane (yOR3<0). The angles ϕR1, ϕR2 for the second leg of a walking machine can be obtained in a similar way.

III.TRAJECTORY PLANNING

The trajectories of the points OL3 and OR3 are determined by the mechanism parameters, type of gait, and step parameters. Let us introduce a coefficient that determines the shape of the trajectory of the points kυ=υf/υb, where υf is the speed along the linear part of the trajectory (movement together with the support), υb is the maximum foot speed; for the symmetrical walking, it is the upper intersection point of the trajectory with the ordinate axis.

Using the coefficient, we can obtain a vector of gait parameters, s¯=(s,hs,Hs,kυ,Ts)T in which s is the step length, hs is the height of the leg when walking, Hs is the distance from the hip joint to the treadmill running, Ts is the duration of one step. Note that the parameters s and Ts determine the walking speed and can be calculated based on the speed of the moving base.

Since the trajectory is symmetrical, it is convenient to use a piecewise polynomial function, splitting it into 3 fragments:AB, BD, DA.

In order to provide the continuity of the trajectory setting functions, as well as the lack of collision of the links on the surface, the conditions must be met at each point. Next, an example related to the function for left leg is presented and performed (for the right, leg the function is going to be similar):

At point A:{xOL3=0;yOL3=(Hshs);x˙OL3=υb;y˙OL3=0.
At point B:{xOL3=s/2;yOL3=Hs;x˙OL3=υf;y˙OL3=0.
At point D:{xOL3=s/2;yOL3=Hs;x˙OL3=υf;y˙OL3=0.

Polynomial functions for changing coordinates can be represented as follows:

q¯(t0,tlast,q0,qlast,q˙0,q˙last,t)=(i=03kiti)T
where coefficients ki are determined by:
[k0k1k2k3]=[1t0t02t031tlasttlast2tlast3012t03t02012tlast3tlast2]·[q0qlastq˙0q˙last]
where t0 is initial time of the trajectory fragment, tlast is final time, q0,q˙0 is initial value of the coordinate and its derivative, qlast,q˙last is final value of the coordinate and its derivative corresponding to the trajectory fragment.

In order to record the simultaneous trajectories of the both legs of the device, an additional point has been introduced into the trajectory. This point corresponds to the A point in the trajectory for the other leg. Trajectory recalculating in a loop can be implemented as a function mod (a, b). This function returns the remainder of dividing a by b. Thus, the use of the equations for coordinates OL3 and OR3 becomes possible by setting the length of the step Ts and dividing it by 8 equal intervals [tA,tB),[tB,tC),[tC,tD),[tD,tA)t, where t=mod(Time,Ts), Time is current time value.

{xOL3=q(tA,tB,0,(s/2),υb,υf,t);yOL3=q(tA,tB,(Hshs),Hs,0,0,t);xOR3=tυ;yOR3=Hs;if(tAt<tB)
{xOL3=tυf+s;yOL3=Hs;xOR3=q(tB,tC,(s/2),0,υf,υb,t);yOR3=q(tB,tC,Hs,(Hshs),0,0,t);if(tBt<tC)
{xOL3=t·υ+s;yOL3=Hs;xOR3=q(tC,tD,0,(s/2),υb,υf,t);yOR3=q(tC,tD,(Hshs),Hs,0,0,t);if(tCt<tD)
{xOL3=q(tA,tD,(s/2),0,υf,υb,t);yOL3=q(tA,tD,Hs,(Hshs),0,0,t);xOR3=tυf+2s;yOR3=Hs;if(tDt<tA)

By setting the step parameter values, it becomes possible to obtain different trajectories of the OL3 point movement.

As shown in the graphics, the developed trajectory planning algorithm allows obtaining a continuous trajectory for multiple step parameters. When the coefficient kυ decreases, the trajectory becomes elongated, due to the synchronization requirements imposed to the links movement, which are composed of a movable base (collision is not stipulated).

Using the trajectory shape coefficient kυ results possible to obtain the required law of movement of links. This law is necessary to establish the parameters of the mechanotherapy of a specific patient, which simplifies the configuration and preparation of equipment.

IV.NUMERICAL SIMULATION OF THE MOVEMENT KINEMATIC OF THE ACTING LINKS OF A TWO-LEGGED WALKING MACHINE-EXOSKELETON ON A MOVABLE BASE

Mathematical modeling of the device movement at walking on a movable base stage has been performed. The length of the links of the device (0.5 m), as well as the step parameters s¯=(0.5,0.2,0.8,0.5,1)T, has been specified.

In Fig. 5, a space-time diagram for the coordinates OL3 and OR3 is presented.

FIGURE 5. Law of change of the coordinates OL3 и OR3 at trajectory performing.

FIGURE 6. Laws of change of the absolute angles of rotation of the device links at trajectory performing.

FIGURE 7. Design diagram of the device and control system structure.

During the modeling process, absolute and relative angles related to the movement of the links were also obtained when the symmetrical trajectory of movement of the links of the acting mechanism of the two-legged walking machine on a horizontal movable base is performed.

V.CONTROL SYSTEM AND HUMAN-MACHINE SYSTEM DESIGN

In order to setup the coefficients of the regulators, adjust the HMS and other system parameters, it is necessary to perform a mathematical modeling of the control system of the links of the exoskeletal system.

Since the control loops for the left and right legs are the same and differ only in the phases of the trajectories, we will describe one leg in the simulation process. Also, we will not consider the interaction of the patient’s foot and the corresponding nodes of the exoskeletal system. In many rehabilitation devices designed to simulate walking and rehabilitation of the hip and knee joints, the ankle joint does not contain actuators, in these cases, the foot is simply fixed on elastic elements that provide comfort to the patient [12,20].

The control task is reduced to working out the required trajectory of movement. The principle of operation of the HMS is as follows. The patient or the exoskeleton operator selects the necessary mode and the parameters of the exercise and starts its execution. Next, the trajectory construction unit synthesizes the laws of changing the coordinates of the foot joint x3*(t),y3*(t). Then, the values of the required coordinates x3*(t),y3*(t) are transmitted to the unit for determining the setting angles for the drive control system φ1*(t),φ2*(t). The required rotation angles are fed to the input of the PD controller, where the control voltages for the electric motors of the exoskeleton are generated:

Ui=kp(ϕi*ϕi)+kd(ϕ˙i*ϕ˙i)
where, kp,kd are coefficients of the PD controller. The coefficients of the regulator were selected as result of computational experiments.

Thus, the legs of the exoskeleton and patient can be represented by two-coordinate pendulums with a common base and connected each other by elastic elements that simulate the operation of the cuffs, whereas the links of the exoskeleton will be driven by the moments of electric drives equipped with a position control system.

In this case, the system of differential equations describing the leg of the exoskeleton will take the form:

ϕ¨1l12(m1+m2)+ϕ¨2m2l1l2cos(ϕ1ϕ2)+ϕ˙22m2l1l2sin(ϕ1ϕ2)==M1P1lP1sin(γ1ϕ1)P2lP1sin(γ2ϕ1)(m1+m2)gl1sinϕ1,ϕ¨2l22m2+ϕ¨1m2l1l2cos(ϕ1ϕ2)ϕ˙12m2l1l2sin(ϕ1ϕ2)==M2P2lP2sin(γ2ϕ2)m2gl2sinϕ2,LdI1dt+RI1+kÅϕ1iG=U1,Ì1=kmI1,LdI2dt+RI2+kÅϕ2iG=U2,Ì2=kmI2,
where, m1,m2 are mass of the links of the exoskeleton, lP1, lP2, γ1 and γ2 are distance from the hinge to the point of application and the absolute angles of effort generated by the patient P1,P2, defined by the difference in the coordinates of the points C1,CH1, C2,CH2 and also defined by the suspension stiffness c1,c2. Ì1, Ì2 are torques generated by the drive, kÅ is the speed coefficient of the motor, L and R are inductance and active resistance of the motor armature winding, iG is total gear ratio of the drive gearbox.

For the patient’s leg, described as a two-link mechanism, we can write similar equations:

ϕ¨h1lh12(mh1+mh2)+ϕ¨h2mh2lh1lh2cos(ϕh1ϕh2)++ϕ˙h22mh2lh1lh2sin(ϕh1ϕh2)=Mh1+P1lP1Hsin(γ1Hϕh1)++P2lP2Hsin(γ2Hϕh1)(mh1+mh2)glh1sinϕh1,ϕ¨h2lh22mh2+ϕ¨h1mh2lh1lh2cos(ϕh1ϕh2)ϕ˙h12mh2lh1lh2sin(ϕh1ϕh2)=Mh2++P2lP2Hsin(γ2Hϕh2)mh2glh2sinϕh2,
where mh1,mh2 are mass of the hip and lower leg of the patient, lP1H, lP2Hγ1H, and γ2H distance from the hinge to the point of application and the absolute angles of effort generated by the exoskeleton. Ìh1Ìh2 are torques generated by the patient.

In this case, by setting the values of the torques, we can model the torques of resistance in the patient’s joints, including the phenomenon of spasticity, characterized by the appearance of uncontrolled muscle contractions, paralysis, and hypertonicity of the muscles.

VI.NUMERICAL SIMULATION OF THE MOVEMENT DYNAMICS OF THE ACTING LINKS OF A TWO-LEGGED WALKING MACHINE-EXOSKELETON ON A MOVABLE BASE

In this part of the work, we will perform a numerical simulation of the system by ignoring the torques in the patient’s joints (Mhsi=0). The system parameters threshold ranges and the mathematical model used parameters are presented in Table 1.

Table I. Parameters of the mathematical model

Parameter descriptionSymbolUsed in the model valueRange of values
Mass of the femoral link of the exoskeletonm13.5 kg
Mass of the lower leg link of the exoskeletonm24.5 kg
Mass of the hip of the patientmh111.3 kg7, 9.14, 7 kg
Mass of the lower leg, including the footmh24.65 kg3, 3.6, 0 kg
Length of the femoral link of the exoskeletonl10.52 m0, 39.0, 65m
Length of the lower leg link of the exoskeletonl20.52 m0, 39.0, 65m
Length of the hip of the patientlh10.52 m0, 39.0, 65 m
Length of the lower leg of the patientlh20.52 m0, 39.0, 65m
Distance from the hip to the hip cufflhH0.39 m
Distance from the knee to the cuff on the lower leglhS0.45 m
Cuff suspension stiffness coefficientcH,cS8 N/mm6, 4.9, 6 N/mm
Armature winding inductanceL0.072 mH
Armature winding resistanceR0.103 Ω
Torque coefficientkm0.35 Nm/A
Speed coefficientkE25.9 rad/Vs

The parameters patient’s limbs lengths and masses are determined by the human physiological parameters. The values used for modeling correspond to the patient having a height of 175 sm and weight 80 kg.

In Fig. 8, the angular movements of the exoskeleton links and the operator’s limb during a single step are shown, as well as the torques on the electric drives and the projection of forces between the exoskeleton and the patient due to inertia and mass.

FIGURE 8. The results of modeling the movement of the HMS at Mh1=Mh2=0.

In this case, as a trajectory, we take the characteristic movement of walking with the following parameters: The step width is 0.35 m, and the height of the leg lift is 0.1 m.

From the simulation results, we can observe that the actuators reach forces up to 100 Nm, with a maximum force of 200 N fixed in the ankle cuff, when performing a step.

The selection of movement parameters and suspension parameters allows reducing the effort and moments, which can be useful when setting up a rehabilitation unit.

VII.CONCLUSION

A mathematical model of the movement of a two-legged walking mechanism on a movable base of a treadmill has been carried out. A method for studying this mechanism has been proposed. Also, trajectory planning algorithms have been developed, and the equations for solving the inverse kinematics problem for the mechanism links have been written. In order to set the shape of the trajectory, a coefficient kυ is proposed. This coefficient represents the relationship between the speed values of movement of the legs on the surface and above the surface. Also, this coefficient in conjunction with other step parameters, such as length, height, and duration, allows getting the required movement of the links of the walking mechanism, which are necessary for conducting a mechanotherapy treatment. The presented method is approved by mathematical modeling, which demonstrates the applicability and appropriate operation of the developed algorithms for trajectory planning for robot-exoskeleton devices.

In this paper, a block diagram of the control system is proposed. This control system diagram describes the strategy of generating the required supply voltages for the drives of the exoskeleton when working out the trajectory. The presented mathematical model allows taking into account the dynamics of the HMS as well as to obtain the load diagrams for the drives of the device in walking mode and estimate the value of the forces arising between the exoskeleton and the patient due to the existence of inertia and gravity.

In the future researches, it is planned to develop a prototype of a rehabilitation complex for practical investigation of the proposed models and algorithms, as well as their modernization to meet the requirements of rehabilitation doctors.