New Developments in Pure and Applied Mathematics MODELLING OF EXOSKELETON MOVEMENT IN VERTICALIZATION PROCESS Sergey Jatsun, Doctor of science, Professor, Head of the department of mechanics, mechatronics and robotics, Southwest State University Sergei Savin, Candidate of science, Junior research fellow of the department of mechanics, mechatronics and robotics, Southwest State University Petr Bezmen, Candidate of science, Associate professor of the department of mechanics, mechatronics and robotics, Southwest State University The paper is devoted to the analytical construction of exoskeleton motion trajectories by means of the experimental data characterizing the movement of a person in the getting up process. The solution of this problem will allow adapting the dynamic characteristics exoskeleton to the motion of person. Abstract—The present paper focuses on comparison and analysis of different techniques of data processing as related to the problem of acquiring experimental data of human getting up process in such form that it can be used as an input to the control system of an exoskeleton. Use of approximation by trigonometric series, polynomials and spline functions is discussed. Keywords—Experimental data processing, exoskeleton II. control inputs. I. The purpose of this paper is the comparative analysis of data processing methods to process information about the person motions during the process of getting up. It is possible to synthesize the control actions for the exoskeleton control system on the basis of these methods. The methods of obtaining the experimental data may be different and are not described here. We assume that the source data is written in the form of numerical sequences which define a person position at each time interval. A person position is determined by the generalized coordinates. In this paper, we consider the case when the system of three generalized coordinates defines the orientation of a shin, a hip and a trunk. These parts of a person body execute the plane-parallel motions but a foot remains stationary. Hence it appears that the person movement can be described as the four-link mechanism motion with one fixed link (figure 1). INTRODUCTION Nowadays, various robotics facilities are systems composed of two main elements – a man and a machine. These systems include objects called the exoskeleton and used to extend the functionality of a person. The interaction of these two components determines the quality of the system as a whole. Recently, the new generation of exoskeletons came into service and it allows a person to move in space, even in case of damage of the lower extremities. In addition, it becomes possible to significantly expand human capabilities when a person performs tasks that impose high demands on endurance and physical strength of a man. Obviously, the creation of such devices is possible with a well-developed theory of the functioning of “manmachine” systems, and the particular emphasis should be given to the control. The main aim demands the consideration of interaction between man and machine. The common problems in the theory of walking mechanisms have been developed in [1-4]. The mathematical modelling of elements motion is one of the most important tools in the study of behavior of the systems like an exoskeleton. At the same time it is necessary to process a large number of experimentally obtained movement curves, solve the problem of approximation and obtain the analytical dependences which reflect the change in generalized coordinates describing the position of the mechanism links. ISBN: 978-1-61804-287-3 STATEMENT OF THE PROBLEM Figure 1 A person in the process of getting up and the four-link mechanism 83 New Developments in Pure and Applied Mathematics Moreover, the smoothing shifts the boundaries of transitions between different stages of the movement. A shin orientation is determined by the angle ϕ1 , a hip orientation – by the angle ϕ 2 , and a trunk orientation – by the angle ϕ 3 . The figure 2 shows the human rising process data derived from experiments in the laboratory of the department of mechanics, mechatronics and robotics, Southwest State University. The corresponding numerical dependences are shown in figure 2 (a). III. THE APPROXIMATION BY TRIGONOMETRIC SERIES An approximation is a method of data processing that allows to selectively retain the required information about the motion by eliminating unwanted high-frequency components. We consider an approximation of the original dependences by the trigonometric Fourier series: 1 f i (t ) = ai ,0 + 2 where: fi ∑ (a n i ,k cos(k ⋅ t ) + bi ,k cos(k ⋅ t )) (2) k =1 – the function, that approximates the experimental dependence ϕ i , ai ,k , bi ,k – the Fourier a) series coefficients, i = 1, 2, 3 . The figure 3 shows the results of approximation at n = 30. The series coefficients for the i-th generalized coordinate are chosen by minimizing of the following positive definite function: Ei = ϕi t j − 1 ai ,0 − 2 j =1 ∑ () mi i ,k cos k ⋅ t j + bi ,k cos k ⋅ t j ∑ (a 30 k =1 ( ) ( )) 2 , (3) where mi – the total number of the dependence ϕ i points, i = 1, 2, 3 . b) 1, 2 and 3 – The time dependences ϕ1 (t ) , ϕ 2 (t ) and ϕ3 (t ) , respectively Figure 2 The experimental data: a) – before smoothing process, b) – after smoothing process The resulting graphs (figure 2 (a)) are largely nonlinear, which is due to the inaccuracy of measurement. High-frequency components of the signal give a stepped appearance and do not carry useful information and should be removed before the signal can be used as the input action for the exoskeleton control system. The smoothing method is the simplest way to process these signals. The figure 2 (b) shows the dependences received after data processing by the sliding window method that uses the following expression: ϕ~i (t j ) = 1 n ∑ϕ (t ) , a) n i j+k i = 1, 2, 3 , (1) k =1 ( ) where: ϕ i t j – the generalized coordinate ϕ i value at the time t before data processing, ϕ~i t j – the generalized ( ) b) 1, 2 and 3 – the approximation of the time dependences ϕ1 (t ) , coordinate ϕ i value at the time t after data processing, n – the width of the sliding window. The use of these dependences has several disadvantages. Smoothed graphs and their derivatives retain high-frequency components described above, (although their amplitude decreased significantly) that can impair the performance of the control system. ISBN: 978-1-61804-287-3 ϕ 2 (t ) and ϕ3 (t ) , respectively Figure 3 The approximation of the initial data by trigonometric series:a) with using of the formula (3), b) with using of the formula (4) It is possible to pay attention to the occurrence of oscillations on the “direct” sections of the graphs (where 84 New Developments in Pure and Applied Mathematics the first order time-derivative is equal to null, figure 3 (a)). The approximation by piecewise-defined function ϕ i (t1 ) if t ∈ [t i1 , ti 2 ] ρ i (t ) = ϕ i (t3 ) if t ∈ [ti 3 , ti 4 ] n 1 a + (a cos(k ⋅ t ) + bi, k cos(k ⋅ t )) otherwise, 2 i , 0 k =1 i , k can avoid these oscillations. We consider the case when the graph has two straight sections: (4) IV. THE APPROXIMATION BY POLYNOMIAL FUNCTIONS AND SPIELS ∑ The n-th order polynomial can be written in form: where: ρi (t ) – the piecewise-defined function used for n the approximation of original dependence ϕ i , [ti1 , ti 2 ] and [ti 3 , ti 4 ] – the first and the second sections, respectively, Pi (t ) = ∑c i,k tk , i = 1, 2, 3 , (5) k =0 where: Pi (t ) – the polynomial functions that are used for where ϕ i has the first order derivative that is equal to null. The figure 3 (b) presents the experimental data approximation results of the piecewise-defined function. We note that in both cases, the dependences have significant vibrational state, and it is especially conspicuous in the graphs of the time-derivatives. The figure 4 shows the first order time-derivatives plots of the functions f k in modulo. the approximation of the original dependence ϕ i , ci , k – the polynomial coefficients. The polynomial coefficients for the i-th generalized coordinate are chosen in the course of minimizing of the following function: (6) i = 1, 2, 3 , , E = ∑ ϕ (t ) − ∑ c t mi i j =1 2 n i i,k j k =0 k j The figure 5 shows the graphs obtained due to the approximation of the functions ϕ i by the sixth order polynomials. a) a) b) b) c) Figure 4 The time dependences a) f1 , b) f2 , c) f3 in a logarithmic scale c) The figures 3 and 4 allow us to conclude that the use of the approximation by trigonometric series make it possible to reliably reproduce the original dependences, but this method leads to additional high-frequency components in the signal spectrum. The use of functions obtained by this way as the input action for the exoskeleton control system can negatively affect the control process. 1 – the polynomial functions Pi (t ) , 2 – the time dependences ϕi Figure 5 The approximation of the experimental data by the sixth order polynomials for the generalized coordinate: a) ϕ1 b) ϕ 2 , c) ϕ3 As well as in the case of approximation by trigonometric series, the use of polynomial functions ISBN: 978-1-61804-287-3 85 New Developments in Pure and Applied Mathematics leads to errors in straight segment of the dependences ϕ i . To obtain the better results, we use the approximation by spline functions. For this purpose we divide the dependences ϕ1 (t ) and ϕ 2 (t ) into three portions, and the dependence ϕ3 (t ) into the four sections. Let this partitioning occur at the points corresponding to the time instants: t11 = 3.48 sec, t12 = 4.93 sec for the dependence ϕ1 (t ) , and t 21 = 2.69 sec, t22 = 4.4 sec for the dependence ϕ 2 (t ) , and t31 = 1.38 sec, t32 = 2.56 sec, t33 = 4.03 sec for the dependence ϕ3 (t ) . The first section and the last c) functions S1 (t ), S2 (t ), S3 (t ) , 7,8,9 – the functions S1 (t ), S2 (t ), S3 (t ) section of each spline are specified by the zero order polynomial, and the rest is defined by the seventh order polynomials. To calculate the polynomial coefficients, we can write the following conditions: S1 (t11 ) = ϕ1 (t11 ) , S1 (t12 ) = ϕ1 (t12 ) S1 (t11 ) = S1 (t11 ) = S1 (t11 ) = 0 S (t ) = S (t ) = S (t ) = 0 1 12 1 12 1 12 1, 2, 3 – the functions S1 (t ), S 2 (t ), S3 (t ) , 4, 5, 6 – the Figure 6 The graphs: a) the spline functions, b) the first order time-derivatives of spline functions, c) the second order timederivatives of spline functions S 2 (t 21 ) = ϕ 2 (t 21 ) , S 2 (t 22 ) = ϕ 2 (t 22 ) (t ) = S (t ) = 0 ( ) S t S = 2 21 2 21 2 21 S (t ) = S (t ) = S (t ) = 0 2 22 2 22 2 22 Because of the seven order spline functions, it is possible to achieve absence of function discontinuities in the graphs of the time dependences of the generalized velocities and accelerations (figure 6 (b) and (c)). Also, the spline functions eliminate the high-frequency oscillations. S3 (t31 ) = ϕ3 (t31 ) S3 (t32 ) = ϕ3 (t32 ) S3 (t33 ) = ϕ3 (t33 ) , (7) (t ) = S (t ) = 0 ( ) = S t S 3 31 3 31 3 31 S (t ) = S (t ) = S (t ) = 0 3 32 3 32 3 32 S3 (t33 ) = S3 (t33 ) = S3 (t33 ) = 0 V. THE DETERMINATION OF MOMENTS NEEDED TO IMPLEMENT THE OBTAINED MOVEMENT TRAJECTORIES OF THE MECHANISM where S1 (t ), S 2 (t ), S3 (t ) are the spline functions used for approximation of the time dependences ϕ1 (t ) , ϕ 2 (t ) и Different approaches with some accuracy allow obtaining the mechanism movement that is determined by certain changes of the generalized coordinates. For example, it is possible to build the automatic control system using negative feedback to control the generalized coordinates. We consider another approach: the moments sequence realizes the desired movement and can be determined by solving the inverse problem of dynamics. The equations of the flat three-link mechanism dynamics can be found in a number of papers, including [5], we do not give them in the paper. The flat three-link mechanism is a series of connected links by joints. In general terms, the equation of the mechanism dynamics can be written as follows: A(ϕ ) ⋅ ϕ + b ϕ ,ϕ + g (ϕ ) = T ⋅ τ , (8) where A(ϕ ) – the matrix of kinetic energy, ϕ ,ϕ ,ϕ – the vectors of the generalized coordinates, generalized velocities, and generalized accelerations, respectively, b (ϕ , ϕ ) – the vector bound with the compound centrifugal forces, g (ϕ ) – the vector of the generalized potential forces, τ – the vector consists of some elements – the moments which are generated by electrical drives, T – the transition matrix. The initial data for solving of the inverse problem of dynamics is the law of the generalized coordinates alteration and their first and second order time-derivatives. As a law, we use the functions S1 (t ), S 2 (t ), S3 (t ) , described in the previous section. In the solving of the inverse problem of ϕ3 (t ) , respectively. Due to using of the criterion (7), we can find the desired coefficients to plot splines (figure 6). ( ) a) b) ISBN: 978-1-61804-287-3 86 New Developments in Pure and Applied Mathematics dynamics, we obtained the results which depend on the moments of electrical drives (figure 7). 1, 2, 3 – the moments of electrical drives τ 1 (t ) , τ 2 (t ) и τ 3 (t ) mounted in the ankle joint, the knee joint and the coxofemoral joint of exoskeleton, respectively Figure 7 The time dependence of the moments generated by the exoskeleton drives Two graphs τ 1 (t ) and τ 2 (t ) have function discontinuities at t = 2.69 sec. (figure 7). Before this time moment t = 2.69 sec a hip and a shin were in static equilibrium under the influence of reaction at supports (i.e. a chair and a floor). Thus, the time moment t = 2.69 sec is the power up time of first and second electrical drives. VI. CONCLUSION This paper discusses various processing methods of experimental data which describe the motion of a person in the getting up process. It is shown that the approximation of initial relationships by trigonometric series provides a sufficient accuracy to reproduce the shape of the original dependences, but adds the highfrequency harmonics in the spectrum of the signal. These harmonics can adversely affect the quality of the control process. The paper demonstrates that this problem can be avoided by using the spline approximation. The solution results of the inverse problem of dynamics are presented. These results were gotten by means of the approximating spline functions and their derivatives. The spline functions make it possible to reduce the peak magnitude of the second order time-derivatives with respect to the original dependences and other types of approximating functions. REFERENCES [1]. Formalskiy A. M. Peremeshcheniye antropomorfnykh mekhanizmov. M.: Nauka, 1982. [2]. Beletskiy V. V., Berbyuk V. Ye. Nelineynaya model dvunogogo shagayushchego apparata, snabzhennogo upravlyayemymi stopami. M.: Nauka, 1982. [3]. Beletskiy V. V. Dvunogaya khodba: Model'nyye zadachi dinamiki i upravleniya. M.: Nauka, 1984. [4]. Vukobratovich M. K. Shagayushchiye roboty i antropomorfnyye mekhanizmy. M.: Mir, 1976. [5]. Vorochaeva L. Yu. Simulation of Motion of a Three Link Robot with Controlled Friction Forces on a Horizontal Rough Surface / L. Yu. Vorochaeva, G. S. Naumov, S. F. Yatsun // Journal of Computer and Systems Sciences International, 2015, Vol. 54, No. 1, pp. 151–164. ISBN: 978-1-61804-287-3 87
© Copyright 2026 Paperzz