An optimal jerk-stiffness controller for gait pattern generation in rough terrain
- Amira Aloulou^{1}Email author and
- Olfa Boubaker^{1}
DOI: 10.1186/s40648-016-0052-4
© Aloulou and Boubaker 2016
Received: 26 November 2015
Accepted: 14 June 2016
Published: 11 July 2016
Abstract
In this paper, an optimal jerk stiffness controller is proposed to produce stable gait pattern generation for bipedal robots in rough terrain. The optimal jerk controller is different from the point-to-point and via-Point conventional approaches as trajectories are planned in the Cartesian space system whereas control laws are expressed in the joint space. Its major contribution resides in the generation of stable semi elliptic Cartesian trajectories during the swing phase that do combine benefits of trigonometric and polynomial functions. The stiffness controller is designed without gravity compensation and ensures for the robotic system elastic and stable contact forces with the ground during the impact and the double support phases. Not only, the control strategy proposed needs very few sensors to be implemented but also it ensures robustness to sensory noise and safety with rough terrain. Simulation performed on a 12 DOF bipedal robot shows the performances of the control laws combined to produce a 3D stable walking cycles without shaking in uneven terrain.
Keywords
Robot control Humanoid robots Legged locomotion Gait pattern generation Robot motionBackground
Prospective gait pattern generation is one of the main challenges of research dedicated to bipedal and humanoid robots. A typical walking cycle includes three main stages: the single support phase (SSP), the impact phase (IP) and the double support phase (DSP). The SSP occurs when one limb is pivoted to the ground while the other is swinging from the rear to the front. The IP occurs when the toe of the forward foot starts touching the ground. The impact between the toe of the swing leg and the ground takes place during an infinitesimal length of time. Finally, the DSP occurs when both limbs remain in contact with the ground. During the SSP, the robotic system is described by a free dynamic model while IP and DSP phases represent the constrained dynamic model.
In the last decades, many control techniques have been investigated to produce human-like walking gaits mainly based on the inverted pendulum principle [1]. During the SSP, several optimal control laws have been also proposed. Criteria to be optimized are often the energy consumption [2], the falling measure [3], the ZMP [4] and the jerk [5]. Focusing on the jerk criterion, the correspondent optimal control law has many benefits. Its main involvement resides in the generation of smooth motion trajectories in order to avoid sudden movements [6]. The optimal jerk based control techniques have affected many industrial areas such as machine tools, manufacturing, and robotics [7–11]. However, for the selection of mathematical function to describe desired trajectories to be tracked, there are divided opinions between researches selecting polynomial functions [12] and, others using trigonometric functions [13, 14]. For the first case, it is proved that polynomial trajectory references are easily followed by the actuators involved. However, such approaches have certain disadvantages like the long execution time which seriously jeopardizes the possibility of real time implementation. For the second case, it is proved that the involved joints in the movement are less oscillatory when trigonometric functions are considered. Another issue raised has also divided researchers in opinion: the space on which reference trajectories must be planed (Cartesian or joint space). For example, it is showed in [15] that if the minimization problem and its solution are formulated in the joint space, only physical limitations of the joint actuators will be included in the constraint statements. However, in a realistic environment, obstacles exist and cause changes in the trajectory direction. Actually, generating reference trajectories may be done whether in the joint or Cartesian space. The space’s choice should only be determined according to the constraints and the shape of the desired trajectory.
On the other hand, to produce stable and safe contact with the ground during the IP and DSP, a number of control techniques can be used to solve the force/position control problem [16]. The active stiffness approach, originally proposed by Salisbury in [17], can be adopted. Its goal is to establish a dynamic relation between the end-effector position and the contact force. Such control approach has the advantage to provide elastic contact with the constrained environment while requiring very little sensors. Unfortunately, it generally suffers of lack of precision and robustness. Recently, several research papers have proposed some improvements to overcome such problems [18–20].
In this paper, the major contribution lies in the proposal of two control laws combined to produce 3D safe walking cycles: An optimal jerk controller during the SSP and an active stiffness controller law without gravity compensation during the constrained phases. The resulting control approach guarantees a stable and safe gait pattern generation without vibration and shaking even in presence of sensory noise and rough terrain.
This paper is organised as follows: In ‘‘The robotic model” section, the robotic model during the SSP, the IP and the DSP is described. ‘‘The 3D desired trajectory of the swing foot” section presents the 3D desired trajectory of the swing foot during the SSP. Jerk optimal control and Stiffness control laws are designed in ‘‘Jerk optimal control” section and ‘‘Active stiffness controller” section, respectively. Finally, simulation results performed on a 12 DOF bipedal robot are given in ‘‘Simulation results” section.
The robotic model
The 3D desired trajectory of the swing foot
Jerk optimal control
Minimum jerk principle
To compute the parameters a _{0} … a _{5}, two main methods are used in the literature: The Point-to-point method [22] and the Via-point one [23]. The first methodology only requires the expression of the function to be minimized and the values of position, velocity and acceleration of the initial and final time of the movement. The corresponding control algorithm only needs to run once. For each joint, the following relation is used [22]:
The control law
As the dynamic modeling of the bipedal robot is known, \(K_{p,1} {\text{and }}K_{v,1}\) are computed offline to satisfy global stability conditions.
The jerk optimal algorithm
- i.
For desired initial and final Cartesian positions of the toe of the swing foot, compute the initial joint position vector ϕ _{ in } and the final joint position vector ϕ _{ f } using the inverse kinematic model (5).
- ii.
Generate the polynomial trajectories \(\phi_{a}\), \(\dot{\phi }_{a}\) and \(\ddot{\phi }_{a}\) described by (18–20) using the Point-to-Point method according to the relation (11).
- iii.
- iv.
Generate the desired joint trajectories \(\phi_{d}\), \(\dot{\phi }_{d}\) and \(\ddot{\phi }_{d}\) using (4–6).
- v.
Compute the jerk optimal control law U(t) using (26).
- vi.
Implement the control law U(t) for the free robotic system described by the dynamical model (1).
- vii.
Generate the Cartesian trajectories Xt) and \(\dot{X}\)(t) by applying the direct kinematic model (2) and the differential kinematic model (3). ϕ(t) and \(\dot{\phi }\)(t) are supposed to be measured via online sensors.
The differences between the proposed approach and the conventional ones can be summarised as follows: first, the reference trajectory of the swing foot is planned in the Cartesian space with constraints on positions, velocities and accelerations at every time iteration whereas for the point-to-point method constraints are to be found only at the boundary conditions and for the via-point method these constraints must also include intermediary positions, their velocities and their accelerations. Moreover, the proposed approach uses a trigonometric expression of desired trajectories that depends on a fifth order polynomial instead of just having recourse to a fifth order polynomial as done for the conventional approaches.
The proposed method of optimal jerk control is designed in order to reduce significantly the time of implementation. As trajectories are planned in the Cartesian space system whereas control laws are expressed in the joint space, it does combine benefits of trigonometric and polynomial functions. Indeed, trigonometric functions require fewer resources for real time implementation whereas polynomial functions give smoother dynamics and fewer vibrations.
Active stiffness controller
The control law (31) is then designed such that the common gravity compensation term found in many research works in the literature is eliminated thanks to the contact force virtual model proposed in (28). This further gives more robustness to the control law. The control law (31) has also the advantage to reduce the number of sensors. To be implemented, it is clear that only position and velocity sensors are needed.
Finally, to achieve a walking cycle and produce alternate footsteps, the minimum jerk controller (26) and the active stiffness controller (31) are combined to switch successively between the SSP described by the robotic model (1), and the IP and DSP described by the constrained robotic model (8).
Simulation results
Physical parameters of the robot
Link | k _{ i } (m) | l _{ i } (m) | m _{ i } (Kg) | Inertia about center of mass (Kg m^{−2}) | ||
---|---|---|---|---|---|---|
i _{ ix } | i _{ ix } | i _{ ix } | ||||
Right foot | 0.034 | 0.034 | 1.015 | 0.001 | 0.001 | 0.001 |
Right leg | 0.184 | 0.241 | 3.255 | 0.051 | 0.051 | 0.051 |
Right thigh | 0.184 | 0.240 | 7.000 | 0.113 | 0.113 | 0.113 |
Pelvis | 0.021 | 0.178 | 9.940 | 0.112 | 0.112 | 0.112 |
Left thigh | 0.240 | 0.184 | 7.000 | 0.113 | 0.113 | 0.113 |
Left leg | 0.241 | 0.184 | 3.255 | 0.051 | 0.051 | 0.051 |
Left foot | 0.034 | 0.034 | 1.015 | 0.001 | 0.001 | 0.001 |
Parameters of the cartesian desired trajectory
a (m) | b (m) | c (m) | d (m) | (u, v) (m) |
---|---|---|---|---|
0.15 | 0.53 | 0.1 | 16.5 | (0.15, 0) |
Simulation results emphasize the efficiency of the control laws as perturbations and rough terrain have no effect on the bipedal robot trajectory. Compared to previous work found in [24], not only fewer sensors are needed in the implementation of the control laws but the semi-elliptical trajectory duration has been also improved to 0.5 s. It corresponds to an enhanced velocity of the bipedal robot of 0.75 m s^{−1}. Also, an elastic and robust contact with the ground is ensured. This was not guaranteed with the impedance control law.
Conclusion
To produce a path similar to the one generated by a human foot when performing a walking cycle by a bipedal robot, we have proposed, in this paper, a specific walking control strategy using an optimal jerk and an active stiffness controllers based only on position and velocity sensors. Simulation results performed on a 12 DOF bipedal robot emphasized the efficiency of the control strategy even in presence of sensory noise and rough terrain and prove the superiority of the new algorithm regarding the step duration and the bipedal velocity compared to previous works.
Declarations
Authors’ contributions
AA proposed the jerk optimal controller and carried out simulation results. OB designed the active stiffness controller. Both authors write the final manuscript. Both authors read and approved the final manuscript.
Competing interests
The authors declare that they have no competing interests.
Open AccessThis article is distributed under the terms of the Creative Commons Attribution 4.0 International License (http://creativecommons.org/licenses/by/4.0/), which permits unrestricted use, distribution, and reproduction in any medium, provided you give appropriate credit to the original author(s) and the source, provide a link to the Creative Commons license, and indicate if changes were made.
Authors’ Affiliations
References
- Boubaker O (2013) The inverted pendulum benchmark in nonlinear control theory: a survey. Int J Adv Robot Syst 10:233. http://www.intechopen.com/books/international_journal_of_advanced_robotic_systems/the-inverted-pendulum-benchmark-in-nonlinear-control-theory-a-survey. Accessed May 2016
- Hasegawa Y, Arakawa T, Fukuda T (2000) Trajectory generation for biped locomotion robot. Mechatronics. 10:67–89. http://www.sciencedirect.com/science/article/pii/S0957415899000525. Accessed May 2016
- Kim B (2012) Optimal foot trajectory planning of bipedal robots based on a measure of falling. Int J Adv Robot Syst 9:172. http://www.intechopen.com/journals/international_journal_of_advanced_robotic_systems/optimal-foot-trajectory-planning-of-bipedal-robots-based-on-a-measure-of-falling. Accessed May 2016
- Vladareanu L, Tont G, Ion I, Munteanu MS, Mitroi D (2010) Walking robots dynamic control systems on an uneven terrain. Adv Electr Comput Eng 10:145–152. http://www.aece.ro/abstractplus.php?year=2010&number=2&article=26. Accessed May 2016
- Aloulou A, Boubaker O. Minimum jerk-based control for a three dimensional bipedal robot. In: Jeschke S, Liu H, Schilberg D (eds) Intelligent robotics and applications. Proceedings of the 4th international conference, ICIRA 2011, Aachen, Germany, December 6-8, 2011, Part II. Lecture notes in computer science, vol 7102, Springer, Berlin, Heidelberg, pp 251–262. http://link.springer.com/chapter/10.1007%2F978-3-642-25489-5_25. Accessed May 2016
- Hogan N (1984) An organizing principle for a class of voluntary movements J Neurosci 4:2745–2754. http://www.jneurosci.org/content/4/11/2745.short. Accessed May 2016
- Erkorkmaz K, Altintas Y (2001) High speed CNC system design. Part I: jerk limited trajectory generation and quintic spline interpolation. Int J Mach Tools Manuf 41:1323–1345. http://www.sciencedirect.com/science/article/pii/S0890695501000025. Accessed May 2016
- Perumaal SS, Jawahar N (2013) Automated trajectory planner of industrial robot for pick-and-place task. Int J Adv Robotic Syst 10:100. http://www.intechopen.com/books/international_journal_of_advanced_robotic_systems/automated-trajectory-planner-of-industrial-robot-for-pick-and-place-task. Accessed May 2016
- Gasparetto A, Zanotto V (2008) A technique for time-jerk optimal planning of robot trajectories. Robot Comput Integr Manuf 24:415–426, http://www.sciencedirect.com/science/article/pii/S0736584507000543. Accessed May 2016
- Mattmüller J, Gisler D (2009) Calculating a near time-optimal jerk-constrained trajectory along a specified smooth path. Int J Adv Manuf Technol 45:1007–1016. http://www.scopus.com/inward/record.url?eid=2-s2.0-70449523562&partnerID=40&md5=047c0720a43d669d80e74e0bd91a7c3f. Accessed May 2016
- Piazzi A, Visioli A (2000) Global minimum-jerk trajectory planning of robot manipulators. IEEE Trans Ind Electron 47:140–149. http://www.scopus.com/inward/record.url?eid=2-s2.0-0034135641&partnerID=40&md5=6448dd5e3647f33352656b4dfe8668d9. Accessed May 2016
- Osornio-Rios RA, Romero-Troncoso RJ, Herrera-Ruiz G, Castañeda-Miranda R (2009) FPGA implementation of higher degree polynomial acceleration profiles for peak jerk reduction in servomotors. Robot Comput Integr Manuf 25:379–392. http://www.sciencedirect.com/science/article/pii/S0736584508000045. Accessed May 2016
- Simon D, Dan I, Isik (1991) Optimal trigonometric robot joint trajectories. Robotica 9:379–386. http://journals.cambridge.org/action/displayAbstract?fromPage=online&aid=2555076&fileId=S0263574700000552. Accessed May 2016
- Nguyen KD, Ng TC, Chen IM (2008) On algorithms for planning s-curve motion profiles. Int J Adv Robot Syst 5:99–106. http://www.scopus.com/inward/record.url?eid=2-s2.0-40549146252&partnerID=40&md5=1f9cfea647e8d931ebd896db8e829b39. Accessed May 2016
- Kyriakopoulos KJ, Saridis GN (1988) Minimum jerk path generation. In: Proc. IEEE international conference on robotics and automation, Philadelphia, PA, USA, 1988, pp 364–369. http://www.scopus.com/inward/record.url?eid=2-s2.0-0023671834&partnerID=40&md5=af5421c5f5cc73fd24ea4e415a84296d. Accessed May 2016
- Zeng G, Hemami A (1997) An overview of robot force control. Robotica 15:473–482. http://dx.doi.org/10.1017/S026357479700057X. Accessed May 2016
- Salisbury JK (1980) Active stiffness control of a manipulator in cartesian coordinates. In: 19th IEEE Conference on decision and control including, the symposium on adaptive processes pp 95–100 http://ieeexplore.ieee.org/stamp/stamp.jsp?tp=&arnumber=4046624&isnumber=4046601. Accessed May 2016
- Mehdi H and Boubaker O (2011) Position/force control optimized by particle swarm intelligence for constrained robotic manipulators. In: Proc. IEEE International conference on intelligent systems design and applications (ISDA 2011), Cordoba, Spain, pp 190–195. http://ieeexplore.ieee.org/xpl/articleDetails.jsp?arnumber=6121653. Accessed May 2016
- Mehdi H, Boubaker O (2012) Stiffness and impedance control using Lyapunov theory for robot-aided rehabilitation. Int J Soc Robot 4:107–119. http://link.springer.com/article/10.1007/s12369-011-0128-5. Accessed May 2016
- Mehdi H, Boubaker O (2016) PSO-Lyapunov motion/force control of robot arms with model uncertainties. Robotica 34(3):634–651. doi: 10.1017/S0263574714001775. Accessed May 2016
- Morimoto J, Atkeson GG (2007) Learning Biped Locomotion IEEE Robot Autom Mag 14:41–51 http://ieeexplore.ieee.org/stamp/stamp.jsp?tp=&arnumber=4264366&isnumber=4263083. Accessed May 2016
- Miyamoto H, Morimoto J, Doya K, Kawato M (2004) Reinforcement learning with via-point representation. Neural Netw 17:299–305. http://www.sciencedirect.com/science/article/pii/S089360800300296X. Accessed May 2016
- Piazzi AA, Visioli A (1997) An interval algorithm for minimum-jerk trajectory planning of robot manipulators. In: Proc. 36th IEEE Conference on decision and control, vol 2, pp 1924–1927 http://ieeexplore.ieee.org/stamp/stamp.jsp?tp=&arnumber=657874&isnumber=14272. Accessed May 2016
- Aloulou A, Boubaker O A Minimum jerk-impedance controller for planning stable and safe walking patterns of biped robots. Mech Mach Sci 29:385–415. doi:10.1007/978-3-319-14705-5_13. http://link.springer.com/chapter/10.1007%2F978-3-319-14705-5_13. Accessed May 2016
- Aloulou A, Boubaker O A Relevant reduction method for dynamic modeling of a seven-linked Humanoid robot in the three-dimensional space. Procedia Eng 41:1277–1284. http://www.sciencedirect.com/science/article/pii/S187770581202711. Accessed May 2016
- Aloulou A, Boubaker O (2013) Model validation of a humanoid robot via standard scenarios. In: Proc. 14th International Conference on Sciences and Techniques of Automatic Control and Computer Engineering (STA 2013), pp 288–293. http://ieeexplore.ieee.org/xpl/login.jsp?tp=&arnumber=6783145&url=http%3A%2F%2Fieeexplore.ieee.org%2Fxpls%2Fabs_all.jsp%3Farnumber%3D6783145. Accessed May 2016