A Twist-based Method for Real-time Trajectory Planning in Task Space
HAN Da-peng1, WEI Qing1, YANG Le-ping2, LI Ze-xiang3
1. College of Mechatronic Engineering and Automation, National University of Defense Technology, Changsha 410073, China; 2. College of Aerospace and Material, National University of Defense Technology, Changsha 410073, China; 3. Department of Electrical and Electronic Engineering, Hong Kong University of Science and Technology, Hong Kong 999077, China
Abstract:A novel algorithm based on twist is presented for real-time task-space trajectory planning.Inheriting the notion of robot guidance,based on the background of object capture for space robot,the trajectory planning under multiple constraints can be accomplished relying only on the observation information of the line-of-sight.Firstly,a twist-based representation is established for a vector,based on which a novel 3D guidance law similar to proportional navigation is developed.The longitudinal acceleration is computed according to the guidance law,the lateral acceleration is computed based on safety considerations,and the real-time algorithm for trajectory generation is established by combining the two processes together.The generated trajectory is feasible and safe,and has certain optimizing properties.Simulation results demonstrate the effectiveness of the proposed algorithm.
[1] Taylor R H.Planning and execution of straight line manipulator trajectories[J].IBM Journal of Research and Development,1979,23(4):424~436.
[2] Volpe R.Task space velocity blending for real-time trajectory generation[A].Proceedings of the IEEE International Conference on Robotics and Automation[C].Piscataway,NJ,USA:IEEE,1993.680~687.
[3] 赵东标,查选芳,王珉,等.基于螺旋理论的机械手最优位姿轨迹规划方法研究[J].航空学报,1999,20(4):331~334.Zhao Dong-biao,Zha Xuan-fang,Wang Min,et al.Screw theory based optimal trajectory planning for robot manipulators[J].Acta Aeronaufica et Astronantica Sinica,1999,20(4):331~334.
[4] Zha X F.Optimal pose trajectory planning for robot manipulators[J].Mechanism and Machine Theory,2002,37(10):1063~1086.
[5] Nejat G,Benhabib B.High-precision task-space sensing and guid ance for autonomous robot localization[A].Proceedings of the IEEE International Conference on Robotics and Automation[C].Piscataway,NJ,USA:IEEE,2003.1527~1532.
[6] Nejat G,Benhabib B.Short-range guidance of autonomous vehicles-a comparative study[J].Robotics and Computer-Integrated Manufacturing,2005,21(4~5):401~411.
[7] Nejat G,Benhabib B.Line-of-sight task-space sensing methodology for the localization of robotic end-effectors[J].IEEE/ASME Transactions on Mechatronics,2006,11(2):225~232.
[8] 朱仁璋,汤溢,尹艳.空间交会最终平移轨迹安全模式设计[J].宇航学报,2004,25(4):443~448.Zhu Ren-zhang,Tang Yi,Yin Yan.Safety mode design of final translation trajectories of space rendezvous[J].Journal of Astronautics,2004,25(4):443~448.
[9] 杨乐平,朱彦伟,安雪滢.基于组合机动的空间V-bar交会策略[J].国防科技大学学报,2006,28(5):6~10.Yang Le-ping,Zhu Yan-wei,An Xue-ying.Study on the strategy for space V-bar rendezvous based on combined maneuver[J].Journal of National University of Defense Technology,2006,28(5):6~10.
[10] 丰保民,马广程,温奇咏,等.任务空间内空间机器人鲁棒智能控制器设计[J].宇航学报,2007,28(4):914~919.Feng Bao-min,Ma Guang-cheng,Wen Qi-yong,et al.Design of robust intelligent controller for space robot in task spacetJl.Journal of Astronautics,2007,28(4):914~919.
[11] 葛景华,陈力.双臂空间机器人系统末端惯性空间轨迹的反馈跟踪控制[J].力学季刊,2007,28(3):455~460.Ge Jing-hua.Chen Li.Feedback control for dual arm space robot system to track desired trajectory in inertia space[J].Chinese Quarterly of Mechanics,2007,28(3):455~460.
[12] 洪炳镕,柳长安,刘宏.自由飞行空间机器人运动控制及仿真[M].北京:国防工业出版社,2005.Hong Bing-rong,Liu Chang-an,Liu Hong.Motion Control and Simulation of Free Flying Space Robot[M].Beijing:National Defense Industry Press,2005.
[13] Nejat G,Benhabib B.A guidance-based motion-planning methodology for the docking of autonomous vehicles[J].Journal of Robotic Systems,2005,22(12):779~793.
[14] 周荻.寻的导弹新型导引规律[M].北京:国防工业出版社,2002.Zhou Di.New Guidance Laws for Homing Missiles[M].Beijing:National Defense Industry Press,2002.
[15] Goldstein H.Classical Mechanics[M].Boston,MA,USA:Addison Wesley Publishing Company,1980.
[16] Yoshida K,Nakanishi H.Impedance matching in capturing a satel lite by a space robot[A].Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems[C].Piscataway,NJ,USA:IEEE.2003.3059~3064.
[17] 陈克俊,赵汉元.一种适用于攻击地面固定目标的最优再入机动制导律[J].宇航学报,1994,15(1):1~7.Chen Ke-jun,Zhao Han-yuan.An optimal reentry maneuver guid ance taw applying to attack the ground fixed target[J].Journal of Astronautics,1994,15(1):1~7.