Document Type : Original Research
Authors
- Amin Aref Adib ^{}
- Seyyed Arash Haghpanah ^{} ^{}
School of Mechanical Engineering, Shiraz University, Shiraz, Iran
Abstract
Background: Competitive sailing requires efforts pertinent to physiological limitations and coordination between different parts of the body. Such coordination depends on the torques applied by muscles to the joints.
Objective: This study aims to simulate the motion and provide a control law for the joint torques in order to track the desired motion paths.
Material and Methods: In this analytical study, an inverse dynamics based control is employed in order to simulate the motion by tracking the desired movement trajectories. First, the dynamics equations are obtained using Lagrange method for 5 degrees of freedom (5 DOF) model. In the following, a robust control scheme with inverse dynamics method based on the Proportional-Integral-Derivative (PID) approach is employed to track the desired joint angles obtained from the experiment.
Results: The simulation results demonstrate the performance of the proposed control method. Low settling times are achieved for the entire joint, which is appropriate in comparison with the time period of each cycle (3.75 s). Also, the maximum torques required to be applied to the joints are in physiological range.
Conclusion: This study provided an appropriate model for the analysis of human movement in rowing sport. The model can also be cited in terms of basic biological theories in addition to practical computational uses in biomechanical engineering. Accordingly, the generated control signals can help to improve the interactive body movements during paddling and in designing robotic arms for automatic rowing.
Highlights
Seyyed Arash Haghpanah (Google Scholar)
Keywords
Introduction
Human movement modeling and simulation play an important role in sport to understand how this multi-body system works and interacts with the environment. Also, the joint torques profiles could be computed in designing sport techniques. Rowing as a professional sport has been adopted in this study to simulate using an inverse dynamics method. The dynamic modeling provides a suitable platform to study the kinematics and kinetics of this motion, and also provides insight about how the central nervous system can control the body in this motion by the designed controller.
Rowing is a form of sailing and a sport, in which athletes compete on a boat using a paddle in a river, lake or sea. In this discipline, rowers sit backwards in a boat and steer their boat forward using two oars attached to the boat with a clamp. Rowing is scientifically attractive in many ways. The rider must be able to coordinate his entire upper torso and lower torso at the same time. This coordination must be maintained during all movement cycles to achieve the desired performance [ 1 ]. Therefore, there are many parameters to adjust the system to achieve a successful combination for its maximum efficiency. Rowing has been analyzed in many experimental studies and its various aspects have been widely investigated. For example, the relationship between strength in sailing and the muscular cross section of different parts has been investigated [ 2 ]. The relationship between the power and propulsion in water has been studied as a computational fluid dynamics problem [ 3 ]. Cabrera et al. [ 4 ] have devised a simple model of both sculling and sweep rowing that appropriately mimics real kinematic and force data. A visualization tool is created for rowers, decomposing the three movements in the stroke to provide suitable feedback by using three microelectromechanical system (MEMS) sensors [ 5 ]. A 5 degree of freedom (DOF) robotic arm has been controlled based on the Electromyogram (EMG) signals of the elbow muscles [ 6 ]. Design robust control with invers dynamics method of a 3DOF sit to stand motion was presented [ 7 ]. Range of motion and angles at the catch and finish was assessed using mixed model ANOVA and correlation analyses with rowing power [ 8 ]. An upper-limb exoskeleton robot with 5 DOF was investigated using an adaptive control approach [ 9 ]. Zakaria et al. [ 10 ] developed an indoor rowing exercise model based on the functional electrical simulation (FES) for patients suffering from spinal cord injury (SCI). Central pattern generator (CPG) as the controller of the nervous system based on co-active muscular modules was investigated [ 11 ]. Ahmed et al. [ 12 ] presented a fuzzy supervisory controller based on the Proportional-Integral-Derivative (PID) algorithm. This method tries to increase the performance of the system by tuning the parameters of the PID controller online. Also, exoskeleton nonlinear upper body control strategies such as computed torque control [ 13 ], sliding mode control method [ 14 ], iterative learning control scheme [ 15 ], and scheduling control approach [ 16 ] have been used.
Despite the importance of this sport and the need for modeling and controlling the movements, no research can be found in the published literature that has concentrated on the control issue of rowing dynamics or building a rowing robot. This study aims to control this nonlinear system using inverse dynamics to improve the performance of this action for professional rowers or build a rowing robot. Numerical simulations demonstrate the robustness of the trajectory tracking in the presence of the uncertainties using proposed methods.
Material and Methods
Dynamic Modeling
In this analytical study, the mathematical description of the human body dynamics is derived from the Lagrange technique. In this regard, the oarsman body is divided into 5 segments: leg, thigh, trunk, arm and forearm. Description of these parts, along with the center of mass of each member, is shown in Figure 1. In order to derive the dynamic model, the kinetic and potential energies have to be obtained in terms of generalized coordinates.
1) ${x}_{1}={d}_{1}\mathrm{cos}{\theta}_{1}$
2) ${y}_{1}={d}_{1}\mathrm{sin}{\theta}_{1}$
3) ${x}_{2}={L}_{1}\mathrm{cos}{\theta}_{1}+{d}_{2}\mathrm{cos}{\theta}_{2}$
4) ${y}_{2}={L}_{1}\mathrm{sin}{\theta}_{1}+{d}_{2}\mathrm{sin}{\theta}_{2}$
5) ${x}_{3}={L}_{1}\mathrm{cos}{\theta}_{1}+{L}_{2}\mathrm{cos}{\theta}_{2}+{d}_{3}\mathrm{cos}{\theta}_{3}$
6) ${y}_{3}={L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{d}_{3}\mathrm{sin}{\theta}_{3}$
7) ${x}_{4}={L}_{1}\mathrm{cos}{\theta}_{1}+{L}_{2}\mathrm{cos}{\theta}_{2}+{L}_{3}\mathrm{cos}{\theta}_{3}+{d}_{4}\mathrm{cos}{\theta}_{4}$
8) ${y}_{4}={L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{L}_{3}\mathrm{sin}{\theta}_{3}+{d}_{4}\mathrm{sin}{\theta}_{4}$
9) ${x}_{5}={L}_{1}\mathrm{cos}{\theta}_{1}+{L}_{2}\mathrm{cos}{\theta}_{2}+{L}_{3}\mathrm{cos}{\theta}_{3}+{L}_{4}\mathrm{cos}{\theta}_{4}+{d}_{5}\mathrm{cos}{\theta}_{5}$
10) ${y}_{5}={L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{L}_{3}\mathrm{sin}{\theta}_{3}+{L}_{4}\mathrm{sin}{\theta}_{4}+{d}_{5}\mathrm{sin}{\theta}_{5}$
In the above equations d_{i} and L_{i} are the position of i^{th} (i=1, 2, 3, 4, ) segment’s mass center and length, respectively. By means of Lagrange’s equations, the dynamic model of the human body with three segments is derived:
11) $\frac{d}{\mathrm{dt}}\left(\frac{\mathrm{\partial L}}{\partial \stackrel{.}{{\theta}_{i}}}\right)-\frac{\mathrm{\partial L}}{\partial {\theta}_{i}}={Q}_{i}$
12) $L=K-V$
where in L_{i}, θ_{i}, Q_{i}, and t are the Lagrangian of the system, the joint angles, the generalized moment and the time, respectively. The kinetic and potential energy (K and V) of the system can be obtained as following:
13) $K=\sum _{\mathrm{i=1}}^{5}(\frac{1}{2}{m}_{i}{V}_{i}^{2}+\frac{1}{2}{I}_{i}\stackrel{.}{{\theta}_{i}^{2}})$
14) $V={m}_{1}g{d}_{1}\mathrm{sin}{\theta}_{1}+{m}_{2}g({L}_{1}\mathrm{sin}{\theta}_{1}+{d}_{2}\mathrm{sin}{\theta}_{2})+{m}_{3}g({L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{d}_{3}\mathrm{sin}{\theta}_{3})+{m}_{4}g({L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{L}_{3}\mathrm{sin}{\theta}_{3}+{d}_{4}\mathrm{sin}{\theta}_{4})+{m}_{5}g({L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{L}_{3}\mathrm{sin}{\theta}_{3}+{L}_{4}\mathrm{sin}{\theta}_{4}+{d}_{5}\mathrm{sin}{\theta}_{5})$
where g denotes the gravitational acceleration, m_{i} is the mass, V_{i} is velocity of the mass center, and I_{i} is the moment of inertia of the i^{th} link.
15) $L=\frac{1}{2}({m}_{1}{d}_{1}^{2}+{m}_{2}{L}_{1}^{2}+{m}_{3}{L}_{1}^{2}+{m}_{4}{L}_{1}^{2}+{m}_{5}{L}_{1}^{2}+{I}_{1})\stackrel{.}{{\theta}_{1}^{2}}+\frac{1}{2}({m}_{2}{d}_{2}^{2}+{m}_{3}{L}_{2}^{2}+{m}_{4}{L}_{2}^{2}+{m}_{5}{L}_{2}^{2}+{I}_{2})\stackrel{.}{{\theta}_{2}^{2}}+\frac{1}{2}({m}_{3}{d}_{3}^{2}+{m}_{4}{L}_{3}^{2}+{m}_{5}{L}_{3}^{2}+{I}_{3})\stackrel{.}{{\theta}_{3}^{2}}+\frac{1}{2}({m}_{4}{d}_{4}^{2}+{m}_{5}{L}_{4}^{2}+{I}_{4})\stackrel{.}{{\theta}_{4}^{2}}+\left(\frac{1}{2}\right({m}_{5}{d}_{5}^{2}+{I}_{5})\stackrel{.}{{\theta}_{5}^{2}}+({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2}\left){L}_{1}\stackrel{.}{{\theta}_{1}}\stackrel{.}{{\theta}_{2}}\mathrm{cos}\right({\theta}_{1}-{\theta}_{2})+({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}\left){L}_{1}\stackrel{.}{{\theta}_{1}}\stackrel{.}{{\theta}_{3}}\mathrm{cos}\right({\theta}_{1}-{\theta}_{3})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}\left){L}_{1}\stackrel{.}{{\theta}_{1}}\stackrel{.}{{\theta}_{4}}\mathrm{cos}\right({\theta}_{1}-{\theta}_{4})+({m}_{5}{d}_{5}\left){L}_{1}\stackrel{.}{{\theta}_{1}}\stackrel{.}{{\theta}_{5}}\mathrm{cos}\right({\theta}_{1}-{\theta}_{5})+({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}\left){L}_{2}\stackrel{.}{{\theta}_{2}}\stackrel{.}{{\theta}_{3}}\mathrm{cos}\right({\theta}_{2}-{\theta}_{3})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}\left){L}_{2}\stackrel{.}{{\theta}_{2}}\stackrel{.}{{\theta}_{4}}\mathrm{cos}\right({\theta}_{2}-{\theta}_{4})+({m}_{5}{d}_{5}\left){L}_{2}\stackrel{.}{{\theta}_{2}}\stackrel{.}{{\theta}_{5}}\mathrm{cos}\right({\theta}_{2}-{\theta}_{5})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}\left){L}_{3}\stackrel{.}{{\theta}_{3}}\stackrel{.}{{\theta}_{4}}\mathrm{cos}\right({\theta}_{3}-{\theta}_{4})+({m}_{5}{d}_{5}\left){L}_{3}\stackrel{.}{{\theta}_{3}}\stackrel{.}{{\theta}_{5}}\mathrm{cos}\right({\theta}_{3}-{\theta}_{5})+({m}_{5}{d}_{5}\left){L}_{4}\stackrel{.}{{\theta}_{4}}\stackrel{.}{{\theta}_{5}}\mathrm{cos}\right({\theta}_{4}-{\theta}_{5})-{m}_{1}g{d}_{1}\mathrm{sin}{\theta}_{1}-{m}_{2}g({L}_{1}\mathrm{sin}{\theta}_{1}+{d}_{2}\mathrm{sin}{\theta}_{2})-{m}_{3}g({L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{d}_{3}\mathrm{sin}{\theta}_{3})-{m}_{4}g({L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{L}_{3}\mathrm{sin}{\theta}_{3}+{d}_{4}\mathrm{sin}{\theta}_{4})-{m}_{5}g({L}_{1}\mathrm{sin}{\theta}_{1}+{L}_{2}\mathrm{sin}{\theta}_{2}+{L}_{3}\mathrm{sin}{\theta}_{3}+{L}_{4}\mathrm{sin}{\theta}_{4}+{d}_{5}\mathrm{sin}{\theta}_{5})$
The virtual work δw is derived to calculate the moment at each joint.
16) $\mathrm{\delta w}=({T}_{1}-{T}_{2}+F{L}_{1}\mathrm{sin}{\theta}_{1})\delta {\theta}_{1}+({T}_{2}-{T}_{3}+F{L}_{2}\mathrm{sin}{\theta}_{2})\delta {\theta}_{2}+({T}_{3}-{T}_{4}+F{L}_{3}\mathrm{sin}{\theta}_{3})\delta {\theta}_{3}+({T}_{4}-{T}_{5}+F{L}_{4}\mathrm{sin}{\theta}_{4})\delta {\theta}_{4}+({T}_{5}+F{L}_{5}\mathrm{sin}{\theta}_{5})\delta {\theta}_{5}$
where T_{1}, T_{2}, T_{3}, T_{4} and T_{5} are the applied torques at the joints and F is force of oar. The dynamic equations of the rowing motion can be achieved:
17) $({m}_{1}{d}_{1}^{2}+{m}_{2}{L}_{1}^{2}+{m}_{3}{L}_{1}^{2}+{m}_{4}{L}_{1}^{2}+{m}_{5}{L}_{1}^{2}+{I}_{1})\stackrel{..}{{\theta}_{1}}+({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2}+){L}_{1}\stackrel{..}{{\theta}_{2}}\mathrm{cos}({\theta}_{1}-{\theta}_{2})+{m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}\left){L}_{1}\stackrel{..}{{\theta}_{3}}\mathrm{cos}\right({\theta}_{1}-{\theta}_{3})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}\left){L}_{1}\stackrel{..}{{\theta}_{4}}\mathrm{cos}\right({\theta}_{1}-{\theta}_{4})+({m}_{5}{d}_{5}\left){L}_{1}\stackrel{..}{{\theta}_{5}}\mathrm{cos}\right({\theta}_{1}-{\theta}_{5})+({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2}\left){L}_{1}\stackrel{.}{{\theta}_{2}^{2}}\mathrm{sin}\right({\theta}_{1}-{\theta}_{2})+({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}\left){L}_{1}\stackrel{.}{{\theta}_{3}^{2}}\mathrm{sin}\right({\theta}_{1}-{\theta}_{3})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}\left){L}_{1}\stackrel{.}{{\theta}_{4}^{2}}\mathrm{sin}\right({\theta}_{1}-{\theta}_{4})+({m}_{5}{d}_{5}\left){L}_{1}\stackrel{.}{{\theta}_{5}^{2}}\mathrm{sin}\right({\theta}_{1}-{\theta}_{5})+({m}_{1}{d}_{1}+{m}_{2}{L}_{1}+{m}_{3}{L}_{1}+{m}_{4}{L}_{1}+{m}_{5}{L}_{1})g\mathrm{cos}{\theta}_{1}={T}_{1}-{T}_{2}+F{L}_{1}\mathrm{sin}{\theta}_{1}$
18) $({m}_{2}{d}_{2}^{2}+{m}_{3}{L}_{2}^{2}+{m}_{4}{L}_{2}^{2}+{m}_{5}{L}_{2}^{2}+{I}_{2})\stackrel{..}{{\theta}_{2}}+({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2}+){L}_{1}\stackrel{..}{{\theta}_{1}}\mathrm{cos}({\theta}_{1}-{\theta}_{2})+({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{2}\stackrel{..}{{\theta}_{3}}\mathrm{cos}({\theta}_{2}-{\theta}_{3})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{2}\stackrel{..}{{\theta}_{4}}\mathrm{cos}({\theta}_{2}-{\theta}_{4})+\left({m}_{5}{d}_{5}\right){L}_{2}\stackrel{..}{{\theta}_{5}}\mathrm{cos}({\theta}_{2}-{\theta}_{5})-({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2}){L}_{1}\stackrel{.}{{\theta}_{1}^{2}}\mathrm{sin}({\theta}_{1}-{\theta}_{2})+({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{2}\stackrel{.}{{\theta}_{3}^{2}}\mathrm{sin}({\theta}_{2}-{\theta}_{3})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{2}\stackrel{.}{{\theta}_{4}^{2}}\mathrm{sin}({\theta}_{2}-{\theta}_{4})+\left({m}_{5}{d}_{5}\right){L}_{2}\stackrel{.}{{\theta}_{5}^{2}}\mathrm{sin}({\theta}_{2}-{\theta}_{5})+({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2})g\mathrm{cos}{\theta}_{2}={T}_{2}-{T}_{3}+F{L}_{2}\mathrm{sin}{\theta}_{2}$
19) $({m}_{3}{d}_{3}^{2}+{m}_{4}{L}_{3}^{2}+{m}_{5}{L}_{3}^{2}+{I}_{3})\stackrel{..}{{\theta}_{3}}+({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{1}\stackrel{..}{{\theta}_{1}}\mathrm{cos}({\theta}_{1}-{\theta}_{3})+{m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}\left){L}_{2}\stackrel{..}{{\theta}_{2}}\mathrm{cos}\right({\theta}_{2}-{\theta}_{3})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}\left){L}_{3}\stackrel{..}{{\theta}_{4}}\mathrm{cos}\right({\theta}_{3}-{\theta}_{4})+({m}_{5}{d}_{5}\left){L}_{3}\stackrel{..}{{\theta}_{5}}\mathrm{cos}\right({\theta}_{3}-{\theta}_{5})-({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}\left){L}_{1}\stackrel{.}{{\theta}_{1}^{2}}\mathrm{sin}\right({\theta}_{1}-{\theta}_{3})-({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}\left){L}_{2}\stackrel{.}{{\theta}_{2}^{2}}\mathrm{sin}\right({\theta}_{2}-{\theta}_{3})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}\left){L}_{3}\stackrel{.}{{\theta}_{4}^{2}}\mathrm{sin}\right({\theta}_{3}-{\theta}_{4})+({m}_{5}{d}_{5}\left){L}_{3}\stackrel{.}{{\theta}_{5}^{2}}\mathrm{sin}\right({\theta}_{3}-{\theta}_{5})+({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3})g\mathrm{cos}{\theta}_{3}={T}_{3}-{T}_{4}+F{L}_{3}\mathrm{sin}{\theta}_{3}$
20) $({m}_{4}{d}_{4}^{2}+{m}_{5}{L}_{4}^{2}+{I}_{4})\stackrel{..}{{\theta}_{4}}+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{1}\stackrel{..}{{\theta}_{1}}\mathrm{cos}({\theta}_{1}-{\theta}_{4})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{2}\stackrel{..}{{\theta}_{2}}\mathrm{cos}({\theta}_{2}-{\theta}_{4})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{3}\stackrel{..}{{\theta}_{3}}\mathrm{cos}({\theta}_{3}-{\theta}_{4})+\left({m}_{5}{d}_{5}\right){L}_{4}\stackrel{..}{{\theta}_{5}}\mathrm{cos}({\theta}_{4}-{\theta}_{5})-({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{1}\stackrel{.}{{\theta}_{1}^{2}}\mathrm{sin}({\theta}_{1}-{\theta}_{4})-({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{2}\stackrel{.}{{\theta}_{2}^{2}}\mathrm{sin}({\theta}_{2}-{\theta}_{4})-({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{3}\stackrel{.}{{\theta}_{3}^{2}}\mathrm{sin}({\theta}_{3}-{\theta}_{4})+\left({m}_{5}{d}_{5}\right){L}_{4}\stackrel{.}{{\theta}_{5}^{2}}\mathrm{sin}({\theta}_{4}-{\theta}_{5})+({m}_{4}{d}_{4}+{m}_{5}{L}_{4})g\mathrm{cos}{\theta}_{4}={T}_{4}-{T}_{5}+F{L}_{4}\mathrm{sin}{\theta}_{4}$
21) $({m}_{5}{d}_{5}^{2}+{I}_{5})\stackrel{..}{{\theta}_{5}}+\left({m}_{5}{d}_{5}\right){L}_{1}\stackrel{..}{{\theta}_{1}}\mathrm{cos}({\theta}_{1}-{\theta}_{5})+\left({m}_{5}{d}_{5}\right){L}_{2}\stackrel{..}{{\theta}_{2}}\mathrm{cos}({\theta}_{2}-{\theta}_{5})+\left({m}_{5}{d}_{5}\right){L}_{3}\stackrel{..}{{\theta}_{3}}\mathrm{cos}({\theta}_{3}-{\theta}_{5})+\left({m}_{5}{d}_{5}\right){L}_{4}\stackrel{..}{{\theta}_{4}}\mathrm{cos}({\theta}_{4}-{\theta}_{5})-\left({m}_{5}{d}_{5}\right){L}_{1}\stackrel{.}{{\theta}_{1}^{2}}\mathrm{sin}({\theta}_{1}-{\theta}_{5})-\left({m}_{5}{d}_{5}\right){L}_{2}\stackrel{.}{{\theta}_{2}^{2}}\mathrm{sin}({\theta}_{2}-{\theta}_{5})-\left({m}_{5}{d}_{5}\right){L}_{3}\stackrel{.}{{\theta}_{3}^{2}}\mathrm{sin}({\theta}_{3}-{\theta}_{5})-\left({m}_{5}{d}_{5}\right){L}_{4}\stackrel{.}{{\theta}_{4}^{2}}\mathrm{sin}({\theta}_{4}-{\theta}_{5})+\left({m}_{5}{d}_{5}\right)g\mathrm{cos}{\theta}_{5}={T}_{5}+F{L}_{5}\mathrm{sin}{\theta}_{5}$
The general form of the equations of motion is as follows:
22) $\mathrm{M(\theta )}\stackrel{..}{\theta}+C(\theta .\stackrel{.}{\theta})\stackrel{.}{\theta}+\mathrm{G(\theta )}=\mathrm{Q(\theta )}$
where M(θ)، $C(\theta .\stackrel{.}{\theta})$ and G(θ) are the inertia matrix, the Coriolis and centrifugal matrix, and the vector caused by gravitational forces, respectively. Also, Q is the generalized vector of the torques applied to the joints. In addition, θ is a vector, whose components, represent the angle of the segments (α represents the angle of the joints).
23) $\mathrm{M(\theta )}=\left[\begin{array}{ccccc}{M}_{11}& {M}_{12}& {M}_{13}& {M}_{14}& {M}_{15}\\ {M}_{12}& {M}_{22}& {M}_{23}& {M}_{24}& {M}_{25}\\ {M}_{13}& {M}_{23}& {M}_{33}& {M}_{34}& {M}_{35}\\ {M}_{14}& {M}_{24}& {M}_{34}& {M}_{44}& {M}_{45}\\ {M}_{15}& {M}_{25}& {M}_{35}& {M}_{45}& {M}_{55}\end{array}\right]$
24) ${M}_{11}=({m}_{1}{d}_{1}^{2}+{m}_{2}{L}_{1}^{2}+{m}_{3}{L}_{1}^{2}+{m}_{4}{L}_{1}^{2}+{m}_{5}{L}_{1}^{2}+{I}_{1})$
25) ${M}_{12}=({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2}){L}_{1}\mathrm{cos}({\theta}_{1}-{\theta}_{2})$
26) ${M}_{13}=({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{1}\mathrm{cos}({\theta}_{1}-{\theta}_{3})$
27) ${M}_{14}=({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{1}\mathrm{cos}({\theta}_{1}-{\theta}_{4})$
28) ${M}_{15}=\left({m}_{5}{d}_{5}\right){L}_{1}\mathrm{cos}({\theta}_{1}-{\theta}_{5})$
29) ${M}_{22}=({m}_{2}{d}_{2}^{2}+{m}_{3}{L}_{2}^{2}+{m}_{4}{L}_{2}^{2}+{m}_{5}{L}_{2}^{2}+{I}_{2})$
30) ${M}_{23}=({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{2}\mathrm{cos}({\theta}_{2}-{\theta}_{3})$
31) ${M}_{24}=({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{2}\mathrm{cos}({\theta}_{2}-{\theta}_{4})$
32) ${M}_{25}=\left({m}_{5}{d}_{5}\right){L}_{2}\mathrm{cos}({\theta}_{2}-{\theta}_{5})$
33) ${M}_{33}=({m}_{3}{d}_{3}^{2}+{m}_{4}{L}_{3}^{2}+{m}_{5}{L}_{3}^{2}+{I}_{3})$
34) ${M}_{34}=({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{3}\mathrm{cos}({\theta}_{3}-{\theta}_{4})$
35) ${M}_{35}=\left({m}_{5}{d}_{5}\right){L}_{3}\mathrm{cos}({\theta}_{3}-{\theta}_{5})$
36) ${M}_{44}=({m}_{4}{d}_{4}^{2}+{m}_{5}{L}_{4}^{2}+{I}_{4})$
37) ${M}_{45}=\left({m}_{5}{d}_{5}\right){L}_{4}\mathrm{cos}({\theta}_{4}-{\theta}_{5})$
38) ${M}_{55}=({m}_{5}{d}_{5}^{2}+{I}_{5})$
39) $C(q.\stackrel{.}{q})=\left[\begin{array}{ccccc}0& {C}_{12}& {C}_{13}& {C}_{14}& {C}_{15}\\ {C}_{21}& 0& {C}_{23}& {C}_{24}& {C}_{25}\\ {C}_{31}& {C}_{32}& 0& {C}_{34}& {C}_{35}\\ {C}_{41}& {C}_{42}& {C}_{43}& 0& {C}_{45}\\ {C}_{51}& {C}_{52}& {C}_{53}& {C}_{54}& 0\end{array}\right]$
40) ${C}_{12}=({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2}+){L}_{1}\stackrel{.}{{\theta}_{2}}\mathrm{sin}({\theta}_{1}-{\theta}_{2})$
41) ${C}_{13}=({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{1}\stackrel{.}{{\theta}_{3}}\mathrm{sin}({\theta}_{1}-{\theta}_{3})$
42) ${C}_{14}=({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{1}\stackrel{.}{{\theta}_{4}}\mathrm{sin}({\theta}_{1}-{\theta}_{4})$
43) ${C}_{15}=\left({m}_{5}{d}_{5}\right){L}_{1}\stackrel{.}{{\theta}_{5}}\mathrm{sin}({\theta}_{1}-{\theta}_{5})$
44) ${C}_{21}=-({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2}){L}_{1}\stackrel{.}{{\theta}_{1}}\mathrm{sin}({\theta}_{1}-{\theta}_{2})$
45) ${C}_{23}=({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{2}\stackrel{.}{{\theta}_{3}}\mathrm{sin}({\theta}_{2}-{\theta}_{3})$
46) ${C}_{24}=({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{2}\stackrel{.}{{\theta}_{4}}\mathrm{sin}({\theta}_{2}-{\theta}_{4})$
47) ${C}_{25}=\left({m}_{5}{d}_{5}\right){L}_{2}\stackrel{.}{{\theta}_{5}}\mathrm{sin}({\theta}_{2}-{\theta}_{5})$
48) ${C}_{31}=-({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{1}\stackrel{.}{{\theta}_{1}}\mathrm{sin}({\theta}_{1}-{\theta}_{3})$
49) ${C}_{32}=-({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3}){L}_{2}\stackrel{.}{{\theta}_{2}}\mathrm{sin}({\theta}_{2}-{\theta}_{3})$
50) ${C}_{34}=({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{3}\stackrel{.}{{\theta}_{4}}\mathrm{sin}({\theta}_{3}-{\theta}_{4})$
51) ${C}_{35}=\left({m}_{5}{d}_{5}\right){L}_{3}\stackrel{.}{{\theta}_{5}}\mathrm{sin}({\theta}_{3}-{\theta}_{5})$
52) ${C}_{41}=-({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{1}\stackrel{.}{{\theta}_{1}}\mathrm{sin}({\theta}_{1}-{\theta}_{4})$
53) ${C}_{42}=-({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{2}\stackrel{.}{{\theta}_{2}}\mathrm{sin}({\theta}_{2}-{\theta}_{4})$
54) ${C}_{43}=-({m}_{4}{d}_{4}+{m}_{5}{L}_{4}){L}_{3}\stackrel{.}{{\theta}_{3}}\mathrm{sin}({\theta}_{3}-{\theta}_{4})$
55) ${C}_{45}=\left({m}_{5}{d}_{5}\right){L}_{4}\stackrel{.}{{\theta}_{5}}\mathrm{sin}({\theta}_{4}-{\theta}_{5})$
56) ${C}_{51}=-\left({m}_{5}{d}_{5}\right){L}_{1}\stackrel{.}{{\theta}_{1}}\mathrm{sin}({\theta}_{1}-{\theta}_{5})$
57) ${C}_{52}=-\left({m}_{5}{d}_{5}\right){L}_{2}\stackrel{.}{{\theta}_{2}}\mathrm{sin}({\theta}_{2}-{\theta}_{5})$
58) ${C}_{53}=-\left({m}_{5}{d}_{5}\right){L}_{3}\stackrel{.}{{\theta}_{3}}\mathrm{sin}({\theta}_{3}-{\theta}_{5})$
59) ${C}_{54}=-\left({m}_{5}{d}_{5}\right){L}_{4}\stackrel{.}{{\theta}_{4}}\mathrm{sin}({\theta}_{4}-{\theta}_{5})$
60) $\mathrm{G(\theta )}=\left[\begin{array}{c}({m}_{1}{d}_{1}+{m}_{2}{L}_{1}+{m}_{3}{L}_{1}+{m}_{4}{L}_{1}+{m}_{5}{L}_{1})g\mathrm{cos}{\theta}_{1}\\ ({m}_{2}{d}_{2}+{m}_{3}{L}_{2}+{m}_{4}{L}_{2}+{m}_{5}{L}_{2})g\mathrm{cos}{\theta}_{2}\\ ({m}_{3}{d}_{3}+{m}_{4}{L}_{3}+{m}_{5}{L}_{3})g\mathrm{cos}{\theta}_{3}\\ ({m}_{4}{d}_{4}+{m}_{5}{L}_{4})g\mathrm{cos}{\theta}_{4}\\ \left({m}_{5}{d}_{5}\right)g\mathrm{cos}{\theta}_{5}\end{array}\right]$
61) $\mathrm{Q(\theta )}=\left[\begin{array}{c}{T}_{1}-{T}_{2}+F{L}_{1}\mathrm{sin}{\theta}_{1}\\ {T}_{2}-{T}_{3}+F{L}_{2}\mathrm{sin}{\theta}_{2}\\ {T}_{3}-{T}_{4}+F{L}_{3}\mathrm{sin}{\theta}_{3}\\ {T}_{4}-{T}_{5}+F{L}_{4}\mathrm{sin}{\theta}_{4}\\ {T}_{5}+F{L}_{5}\mathrm{sin}{\theta}_{5}\end{array}\right]$
Design Process of Controller
In this part, a robust controller based on inverse dynamics [ 7 ] is designed to control the rowing movement and to track the desired paths. The control actuators are the torques acting on the knee, hip, shoulder, and elbow. The desired path or control angles used in this paper are presented in [ 17 ]. Also, the force applied by the rower to the oar is introduced in [ 18 ]. Using the inverse dynamics control method as below, the nonlinear terms are omitted. Accordingly, the control law is introduced as follows:
62) $u=\mathrm{M(\theta )}{u}_{0}+C(\theta .\stackrel{.}{\theta})\stackrel{.}{\theta}+\mathrm{G(\theta )}$
Substituting this control input to equation (1) leads to a system with n decoupled linear equation:
63) $\stackrel{..}{\theta}={u}_{0}$
By defining u_{0} as,
64) ${u}_{0}=\stackrel{..}{{\theta}_{d}}+{K}_{d}(\stackrel{.}{{\theta}_{d}}-\stackrel{.}{\theta})+{K}_{p}({\theta}_{d}-\theta )+{K}_{I}\left({\int}_{0}^{t}\right({\theta}_{d}\mathrm{(\tau )}-\mathrm{\theta (\tau )}\left)\right)\mathrm{d\tau})$
where θ_{d}, $\stackrel{.}{{\theta}_{d}}$, and $\stackrel{..}{{\theta}_{d}}$ are the vectors, comprising desired angles, the first, and the second derivative of this vector with respect to time, respectively. In addition, K_{p}, K_{d} and K_{I} are the proportional, derivative, and integral gain matrices, respectively. It is worth mentioning that integral term has been added to increase the robustness of the controller against perturbation. By substituting equation (63) to equation (64), the error equation can be obtained as:
65) $\stackrel{\stackrel{..}{~}}{\theta}+{K}_{d}\stackrel{\stackrel{.}{~}}{\theta}+{K}_{p}+{K}_{I}\left({\int}_{0}^{t}\right(\stackrel{~}{\theta}\mathrm{(\tau )}\left)\right)\mathrm{d\tau})=0$
Now if we add the perturbation vector to equation (1), it becomes as below:
66) $\mathrm{M(\theta )}{u}_{0}+C(\theta .\stackrel{.}{\theta})\stackrel{.}{\theta}+\mathrm{G(\theta )}=u+d$
According to the above equations, a closed loop control system is formed as follow in the presence of perturbation:
67) $\stackrel{\stackrel{..}{~}}{\theta}+{K}_{d}\stackrel{\stackrel{.}{~}}{\theta}+{K}_{p}+{K}_{I}\left({\int}_{0}^{t}\right(\stackrel{~}{\theta}\mathrm{(\tau )}\left)\right)\mathrm{d\tau})={M}^{-1}\mathrm{(\theta )}d$
In these equations, d is an unknown matrix and $\stackrel{~}{\theta}$ is the difference between the real and the desired angles, which is defined as follows:
68) $\stackrel{~}{\theta}=\theta -{\theta}_{d}$
Also, it should be noted that all of the angles specified in Figure 1 are absolute angles of each arm, but the desired angles defined in [ 17 ] are the angles of each joint, which are relative angles. Thus, we must convert these angles to each other by geometric relations. It can be easily shown that:
69) ${\theta}_{1}=180-{\theta}_{s}-{\alpha}_{1}$
70) ${\theta}_{2}={\alpha}_{2}+{\theta}_{1}-180$
71) ${\theta}_{3}={\alpha}_{2}+{\theta}_{1}-{\theta}_{3}$
72) ${\theta}_{4}=180+{\theta}_{3}-{\alpha}_{4}$
73) ${\theta}_{5}={\theta}_{3}-{\alpha}_{4}+{\alpha}_{5}$
Simulation
The simulation of rowing motion has been performed by motion capture cameras with markers placed on each joint. This experiment was accomplished in [ 17 ]. In this experiment, the variations of the angles of the major joints, including the knee, thorax, shoulder, and elbow were investigated. According to Figure 1, there is a need to the values of the mass, gyration radius, and the length of each link. These values can be found in the anthropometric data provided in [ 19 ]. Considering that the subject was a male with age of 30 and had a height of 178 cm and a mass of 68 kg.
In this paper, the following values are used as perturbations in the simulations:
74) ${d}_{1}=\mathrm{2.2\; sin\; t}$
75) ${d}_{2}=\mathrm{2.2\; sin\; 2t}$
76) ${d}_{3}=\mathrm{1.8\; sin\; 3t}$
77) ${d}_{4}=\mathrm{1.5\; sin\; 1.5t}$
78) ${d}_{5}=\mathrm{1.2\; sin\; t}$
Results
The numerical simulations were performed based on the anthropometric data given in Table 1 and demonstrated an appropriate performance of the PID controller in such a way that the tracking error converges to zero in a very short time (about 0.5 s) in presentence of disturbances. The simulation results are shown in Figure 2(a-d). The diagrams of the torques applied to each joint is depicted in Figure 3(a-d).
Segment Name | Shank | Thigh | Trunk | Upper Arm | Forearm |
---|---|---|---|---|---|
Weight (Kg) | 3.162 | 6.800 | 33.790 | 1.904 | 1.088 |
Length (m) | 0.438 | 0.436 | 0.507 | 0.331 | 0.260 |
Center of gravity (m) | 0.248 | 0.247 | 0.254 | 0.187 | 0.148 |
Radius of gyration (m) | 0.132 | 0.141 | 0.206 | 0.107 | 0.122 |
Discussion
Numerical data expresses the angle of the joints while θ represents the absolute angle of the segments. Figure 2(a-d) shows the absolute angles and the desired ones for each joint. To trace these desired values, we have adjusted the PID coefficients. As mentioned, experimental data [ 17 ] has been used to draw the desired paths. As see in the Figure 2(a-d), the motion in one cycle is examined. The continuation of the motion is repetitive. Since the duration of each cycle is very short (close to 3.75 s) compared to other sports movements, and the achievement of this goal is more difficult. But, it is evident that the controller is able to follow the desired path well.
Since the rowing demands a sudden large force, acting to the oar at the beginning of the cycle, the system takes a sudden inertia, making it difficult to control. This causes high torques to the joints. However, the applied torques do not exceed the limit values of the joints, the settling time is short with a low overshoot. From Figure 2(a-d), it is evident that the proposed controller is also robust against imposed disturbances. However, the desired angles, provided by experimental data, seem to be smooth functions of time, the first and the second derivatives of these functions are accompanied by chattering. Due to the presents of this chattering in the desired angular acceleration of the links, this phenomenon can also be seen in the desired torques. Considering the experimental forces presented in [ 18 ], we can see that due to the high force acting to the system at the beginning of each cycle, a large overshoot in the torque diagrams occurs. Of course, an overshoot is obvious as a result of initial errors.
Conclusion
An appropriate model and controller is required for rowing movement in order to design rowing robots and improve the movement of athletes in this field. This paper presents a dynamic model of rowing movement in the form of 5 degrees of freedom inverse pendulum with non-uniform mass distributions. The equations are derived by the Lagrange method and a robust controller based on inverse dynamics is designed to track the motion trajectories reported from the professional athletes. Numerical results show the acceptable performance and robustness of the proposed controller against external disturbances. This control law can be used for designing a robot and optimizing the movement of athletes.
Authors’ Contribution
SA. Haghpanah conceived the idea. The whole manuscript was written by SA. Haghpanah and A. Aref Adib. Simulation and Results was carried out by A. Aref Adib and the Discussion was carried out by SA. Haghpanah. The research work was proofread and supervised by SA. Haghpanah. All the authors read, modified, and approved the final version of the manuscript.
Ethical Approval
Since this work is a simulation study, no Ethical Approval is necessary.
Conflict of Interest
None
References
- Kleshnev V. Biomechanics of rowing. Crowood Press Limited; 2016.
- Tachibana K, Yashiro K, Miyazaki J, IKEGAMI Y, Higuchi M. Muscle cross-sectional areas and performance power of limbs and trunk in the rowing motion. Sports Biomech. 2007; 6(1):44-58. DOI | PubMed
- Robert Y, Leroyer A, Barré S, Rongère F, Queutey P, Visonneau M. Fluid mechanics in rowing: the case of the flow around the blades. Procedia Eng. 2014; 72:744-9. DOI
- Cabrera D, Ruina A, Kleshnev V. A simple 1+ dimensional model of rowing mimics observed forces and motions. Hum Mov Sci. 2006; 25(2):192-220. DOI | PubMed
- Dobay B, Thornton B, Bowen J. Design of Visualization Tool for Biomechanical Rowing Analysis. Worcester Polytechnic Institute; 2020.
- Gowtham S, Krishna KA, Srinivas T, Raj RP, Joshuva A. IEEE: Chennai, India; 2020. DOI
- Nematollahi MH, Haghpanah SA, Taghvaei S. Inverse Dynamic Robust Control of Sit-to-Stand Movement. Biomed Eng: Applications, Basis and Communications. 2019; 31(06):1950041. DOI
- Li Y, Koldenhoven RM, Jiwan NC, Zhan J, Liu T. Trunk and shoulder kinematics of rowing displayed by Olympic athletes. Sports Biomech. 2020;1-3. DOI | PubMed
- Kang HB, Wang JH. Adaptive robust control of 5 DOF Upper-limb exoskeleton robot. Int J Control Autom Syst. 2015; 13(3):733-41. DOI | PubMed
- Hussain Z, Tokhi MO, Gharooni S. IEEE: Kuala Lumpur, Malaysia; 2008. DOI
- Haghpanah SA, Farahmand F, Zohoor H. Modular neuromuscular control of human locomotion by central pattern generator. J Biomech. 2017; 53:154-62. Publisher Full Text | DOI | PubMed
- Alassar AZ, Abuhadrous IM, Elaydi HA. IEEE: Singapore; 2010. DOI
- Nef T, Mihelj M, Riener R. ARMin: a robot for patient-cooperative arm therapy. Med Biol Eng. Comput. 2007; 45(9):887-900. DOI | PubMed
- Jezernik S, Wassink RG, Keller T. Sliding mode closed-loop control of FES controlling the shank movement. IEEE Trans Biomed Eng. 2004; 51(2):263-72. DOI | PubMed
- Freeman CT, Hughes AM, Burridge JH, Chappell PH, Lewin PL, Rogers E. Iterative learning control of FES applied to the upper extremity for rehabilitation. Control Eng Pract. 2009; 17(3):368-81. DOI
- Previdi F, Carpanzano E. Design of a gain scheduling controller for knee-joint angle control by using functional electrical stimulation. IEEE T Contr Syst T. 2003; 11(3):310-24. DOI
- Said KB, Ababou N, Ouadahi N, Ababou A. IEEE: Algiers, Algeria; 2016. DOI
- Černe T, Kamnik R, Munih M. The measurement setup for real-time biomechanical analysis of rowing on an ergometer. Measurement. 2011; 44(10):1819-27. DOI
- Winter DA. Biomechanics and motor control of human movement. John Wiley & Sons; 2009.