I.INTRODUCTION
Exoskeletal devices are widely used for rehabilitation of patients with disorders of the musculoskeletal system [1–8]. 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 [9–12]. 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 [13–15]. 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 [16–18], 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).
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 and 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 and .
For mathematical description of the kinematics of motion, there is a system of equations:
where and are long links, respectively: thighs and shins, , – are coordinates of the femoral joint in the inertial reference system, , 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:
Using these equations, it is possible to determine the absolute rotation angles of links when a point moves in the lower quadrants of the coordinate plane . The angles , for the second leg of a walking machine can be obtained in a similar way.
III.TRAJECTORY PLANNING
The trajectories of the points and 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 , where is the speed along the linear part of the trajectory (movement together with the support), 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, in which is the step length, is the height of the leg when walking, is the distance from the hip joint to the treadmill running, is the duration of one step. Note that the parameters and 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:, , .
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):
Polynomial functions for changing coordinates can be represented as follows:
where coefficients are determined by: where is initial time of the trajectory fragment, is final time, is initial value of the coordinate and its derivative, 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 and becomes possible by setting the length of the step and dividing it by 8 equal intervals , where , Time is current time value.
By setting the step parameter values, it becomes possible to obtain different trajectories of the point movement.
As shown in the graphics, the developed trajectory planning algorithm allows obtaining a continuous trajectory for multiple step parameters. When the coefficient 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 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 , has been specified.
In Fig. 5, a space-time diagram for the coordinates and is presented.
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 . Then, the values of the required coordinates are transmitted to the unit for determining the setting angles for the drive control system . 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:
where, 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:
where, are mass of the links of the exoskeleton, , , and are distance from the hinge to the point of application and the absolute angles of effort generated by the patient , defined by the difference in the coordinates of the points , and also defined by the suspension stiffness . , are torques generated by the drive, is the speed coefficient of the motor, and are inductance and active resistance of the motor armature winding, is total gear ratio of the drive gearbox.For the patient’s leg, described as a two-link mechanism, we can write similar equations:
where are mass of the hip and lower leg of the patient, , , and distance from the hinge to the point of application and the absolute angles of effort generated by the exoskeleton. 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 . The system parameters threshold ranges and the mathematical model used parameters are presented in Table 1.
Parameter description | Symbol | Used in the model value | Range of values |
---|---|---|---|
Mass of the femoral link of the exoskeleton | m1 | 3.5 kg | – |
Mass of the lower leg link of the exoskeleton | m2 | 4.5 kg | – |
Mass of the hip of the patient | mh1 | 11.3 kg | 7, 9.14, 7 kg |
Mass of the lower leg, including the foot | mh2 | 4.65 kg | 3, 3.6, 0 kg |
Length of the femoral link of the exoskeleton | l1 | 0.52 m | 0, 39.0, 65m |
Length of the lower leg link of the exoskeleton | l2 | 0.52 m | 0, 39.0, 65m |
Length of the hip of the patient | lh1 | 0.52 m | 0, 39.0, 65 m |
Length of the lower leg of the patient | lh2 | 0.52 m | 0, 39.0, 65m |
Distance from the hip to the hip cuff | lhH | 0.39 m | – |
Distance from the knee to the cuff on the lower leg | lhS | 0.45 m | – |
Cuff suspension stiffness coefficient | cH,cS | 8 N/mm | 6, 4.9, 6 N/mm |
Armature winding inductance | L | 0.072 mH | – |
Armature winding resistance | R | 0.103 Ω | – |
Torque coefficient | km | 0.35 Nm/A | – |
Speed coefficient | kE | 25.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.
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 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.