Optimal Torque Control of a Snake-like Robot Based on the Minimum Infinity Norm
GUO Xian1,2, WANG Minghui1, LI Bin1, MA Shugen1,3, WANG Yuechao1
1. State Key Laboratory of Robotics, Shenyang Institute of Automation, Chinese Academy of Science, Shenyang 110016, China;
2. University of Chinese Academy of Sciences, Beijing 100049, China;
3. Department of Robotics, Ritsumeikan University, Kusatsu-Shi 525-8577, Japan
郭宪, 王明辉, 李斌, 马书根, 王越超. 基于最小无穷范数的蛇形机器人最优力矩控制[J]. 机器人, 2014, 36(1): 8-13.DOI: 10.3724/SP.J.1218.2014.00008.
GUO Xian, WANG Minghui, LI Bin, MA Shugen, WANG Yuechao. Optimal Torque Control of a Snake-like Robot Based on the Minimum Infinity Norm. ROBOT, 2014, 36(1): 8-13. DOI: 10.3724/SP.J.1218.2014.00008.
When the snake-like robot with passive wheels tracks the trajectory of the head, there are infinite solutions for the input torque. The minimum amplitude torque corresponds to the minimum rated torque of the motor which is the optimal torque mentioned in this paper. When the snake-like robot has no sideslip, the normal velocity of the snake-like robot is zero. So, a velocity constraint can be introduced into each module, and the snake-like robot is a nonholonomic system. The minimum amplitude torque corresponds to the torque with the minimum infinity norm. In this paper, the nonholonomic dynamics equations are developed, and the problem of solving the minimum amplitude torque is transformed into the problem of solving the minimum infinity norm under the constraints of dynamics equations. Using the numerical algorithm of the minimum infinity norm, the minimum infinity norm solution of the joint torque is derived when the snake-like robot tracks the head velocity. Using the minimum infinity norm solution, optimal torque control with minimum amplitude can be realized. The dynamics numerical simulation proves that the algorithm is valid.
[1] Saito M, Fukaya M, Iwasaki T. Serpnoid locomotion with robotic snakes[J]. IEEE Control Systems Magazine, 2002, 22(1): 64-81. [2] Tesch M, Lipkin K, Brown I, et al. Prarameterized and scripted gaits for modular snake robots[J]. Advanced Robotics, 2009, 23(9): 1131-1158. [3] Crespi A, Ijspeert A J. Online optimization of swimming and crawling in an amphibious snake robot[J]. IEEE Transactions on Robotics, 2008, 24(1): 75-87. [4] Lu Z L, Ma S G, Li B, et al. Gaits-transferable CPG controller for a snake-like robot[J]. Science in China, Series F: Information Sciences, 2008, 51(3): 293-305. [5] Date H, Takita Y. Adaptive locomotion of a snake like robot based on curvature derivatives[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2007: 3554-3559.[6] Watanabe K, Iwase M, Hatakeyama S, et al. Control strategy for a snake-like robot based on constraint force and verification by experiment[J]. Advanced Robotics, 2009, 23(7/8): 907-937.[7] Prautsch P, Mita T. Control and analysis of the gait of snake robot[C]//IEEE Intrenational Conference on Control Applications. Piscataway, USA: IEEE, 1999: 502-507.[8] Date H, Hoshi Y, Sampei M. Locomotion control of a snake-like robot based on dynamic manipulability[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2000: 2236-2241.[9] Date H, Sampei M, Nakaura S. Control of a snake robot in consideration of constraint force[C]//IEEE Intrenational Conference on Control Applications. Piscataway, USA: IEEE, 2001: 966-971.[10] Cadzow J A. A finite algorithm for the minimum solution to a system of consistent linear equations[J]. SIAM Journal on Numberical Analysis, 1973, 10(4): 607-617. [11] Shim I C, Yoon Y S. Stabilization constraint method for torque optimization of a redundant manipulator[C]//IEEE Intrenational Conference on Robotics and Automation. Piscataway, USA: IEEE, 1997: 2403-2408.[12] Ha I, Lee J. A new algorithm for a minimum infinity-norm solution and its application to trajectory planning of kinematically redundant manipulators[C]//IEEE/ASME Internatioal Conference on Advanced Intelligent Mechanics. 2001: 446-451.[13] Transeth A A, Pettern K Y, Liljeback P. A survey on snake robot modeling and locomotion[J]. Robotica, 2009, 27(7): 999-1015. [14] Zhao T S, Li N. Nominal mechanism method of dynamic modeling for snake-like robots[J]. Chinese Journal of Mechanical Engineering, 2007, 43(8): 66-71. [15] Sun H, Liu L X, Ma P S. On the tree-climbing static mechanism of a snake robot climbing trees[J]. Robot, 2008, 30(2): 112-116.[16] Ma S G. Analysis of creeping locomotion of a snake-like robot[J]. Advanced Robotics, 2001, 15(2): 205-224. [17] Wang Z F, Ma S G, Li B, et al. Dynamic modeling for locomotion manipulation of a snake-like robot by using geometric methods[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, USA: IEEE, 2009: 3631-3636.[18] Samson C. Control of chained systems application to path following and time-varying point stabilization of mobile robots[J]. IEEE Transaction on Automatic Control, 1995, 40(1): 64-77. [19] Luenberger D G. Optimization by vector space methods[M]. Hoboken, USA: John Wiley & Sons Inc., 1969.[20] Deo A S., Walker I D. Minimum effort inverse kinematics for redundant manipulators[J]. IEEE Transactions on Robotics and Automation, 1997, 13(5): 767-775.