Motion Planning of Sampling Flexible Manipulator on Planet

Abstract

In order to adapt to a wide range of planetary surface sample acquisition and requirements of weight optimization, manipulator usually consists of several slender arms and rotary joints. This makes the flexibility compensation and vibration suppression become research focus in the manipulator control system. In this paper, a smooth trajectory planning method with parabolic contour for sampling motion of manipulator is proposed. In the motion process acceleration is made to be continuous to avoid joint torque mutation and debase the peak value farthest. Firstly, the kinematic equations of manipulator based on D-H and dynamics model with flexible deformation of joints and arms are established. Then, the variable acceleration-uniform motion-deceleration trajectory is planned in Cartesian space, which acceleration is consistent and smooth. Finally, the typical tasks of manipulator are simulated. Results indicate that this method is useful to make acceleration of joint motion continuous. This control strategy can obviously improve dynamic tracking accuracy and position precision.

Keywords

sampling on planet / flexible manipulator / motion optimization

References

[1] 叶培建,邓湘金,彭兢.国外深空探测态势特点与启示[J].航天器环境工程,2008,25(5):403-405 [Ye P J, Deng X J, Peng J. Features of deep space exploration in other countries and the enlightenment for the development in China[J]. Spacecraft Environment Engineering, 2008,25(5):403-405.]
[2] Park K, Park Y. Fourier-based optimal design of a flexible manipulator path to reduce residual vibration of the endpoint [J]. Robotica, 1993, ll(3):263-272.
[3] Sarkar P K, Yamamoto M, Mohri A. Significance of spline curve in path planning of flexible manipulator [C]//Proc of the 1997 IEEE Inter Conf on Robotics & Automation. Albuquergue New Mexico: IEEE, 1997:2535-2540.
[4] Pond B, Sharf I. Motion planning for flexible manipulators [C]//IEEE Inter Conf on Systems, Man and Cybernetics. [S.l.]: IEEE, 1995:2103-2108.
[5] Kojima H, Kibe T. Optimal trajectory planning of a two-link flexible robot arm based on genetic algorithm for residual vibration reduction[C]//Proc of the 2001 IEEE/RSJ Inter Conf on Intelligent Robots and Systems. Maui, Hawaii. USA: IEEE, 2003:2276-2281.
[6] 戈新生,崔玮,赵秋玲.刚柔性耦合机械臂轨迹跟踪与振动抑制[J].工程力学,2005,22(6):188-191.[Ge X S, Cui W, Zhao Q L. Trajectory tracking control and vibration suppression of rigid flexible manipulators[J]. Engineering Mechanics, 2005,22(6):188-191.]
[7] 刘志全,庞彧,李新立.深空探测自动采样机构的特点及应用[J].航天器工程,2011,20(3):120-125. [Liu Z Q, Pang Y, Li X L. Characteristics and applications of automatic sampling mechanisms for deep space exploration[J]. Spacecraft Engineering, 2011,20(3):120-125.]
[8] 蔡自兴.机器入学[M].北京:清华大学出版社,2000.[Cai Z X. Robotics[M]. Beijing:Tsinghua University Press,2000.]
[9] 朱炜.TELBOT机器人弹性臂仿真及误差补偿[D].北京,北京邮电大学,硕士学位论文,2001.[Zhu Wei. Flexible arm simulation and error compensation of TELBOT robot[D]. Beijing: University of Posts and Telecommunications, 2001.]
[10] 张志涌.精通MATLAB6.5版[M].北京:北京航空航天大学出版社,2003.[Zhang Z Y. Jing Tong MATLAB6.5[M]. Beijing: Beijing University Press,2003.]
[11] 陈礼顺,李立,杨志军.基于MATLAB四自由度焊接机器人轨迹规划及仿真[J].机械设计与研究,2009年增刊:136-140.[Chen L S, Li L, Yang Z J. Track planning and motion simulink of 4-DOF welt-robot based on MATLAB[J]. Machine Design and Research, 2009:136-140.]
[12] 陈辛.机械臂的动力学研究[D].哈尔滨,哈尔滨工程大学,硕士学位论文,2007.[Chen Xin. Study on dynamics of manipulator [D]. Harbin: Harbin Institute of Technology, 2007.]
[13] 彭祺擘,李海阳.基于虚拟样机技术的机械臂建模与仿真[J].华东理工大学学报,自然科学版,2007,33(6):58-62.[Peng Q B, Li H Y. Modeling and simulation of robot manipulator based on virtual prototyping technology [J]. Journal of East China University of Science and Technology (Natural Science Edition), 2007,33(6):58-62.]