Task planning for CE-3 rover's manipulator to probe in place based on SA* algorithm
-
摘要: 针对机械臂规划方法无法满足CE-3巡视器成像及探测光照约束、避碰及机械臂位形切换次数等约束的不足,提出一种基于SA*的月面巡视器机械臂就位探测任务规划算法。该算法在机械臂的工作空间进行搜索,根据星历计算太阳光照以解决光照约束,通过层次包围盒高效准确地进行机械臂碰撞检测以满足机械臂与环境不存在干涉的约束条件,通过相邻运动行为的代价削减保证规划后机械臂位形切换次数最少。最终通过月面巡视器在轨任务结果验证该算法的可行性。Abstract: This paper focuses on the shortage of past researches which do not satisfy the conditions that CE-3 lunar rover is required to satisfy the constraints of imaging, light detection, obstacle avoidance, and number of manipulator switching. A new approach based on SA* algorithm is presented for task planning of lunar rover's manipulator. The algorithm searches the manipulator work space and calculates the sun light based on the ephemeris to satisfy the lighting constraint, and manipulator and environment collision are avoided by an effective method of collision detection based on hierarchical bounding box. Moreover, motion sequence generated by this algorithm according to cost cuts satisfies the constraints:Minimum number of transformation of manipulator. The feasibility of SA* algorithm for manipulator are verified by the result of on-orbit mission.
-
Key words:
- lunar rover /
- manipulator /
- collision detection /
- SA* algorithm /
- task planning
-
[1] 居鹤华,贾阳,申振荣,等.运动链符号演算与自主行为控制[M].北京:中国宇航出版社,2015:4-6. JU H H,JIA Y,SHEN Z R,et al.Kinematic chain symbol calculus autonomous behavior control[M].Beijing:China Astronautic Publishing House,2015:4-6(in Chinese). [2] 叶培建,孙泽洲,饶炜.嫦娥一号月球探测卫星研制综述[J].航天器工程,2007,16(6):9-15. YE P J,SUN Z Z,RAO W.Research and development of Chang'E 1[J].Spacecraft Engineering,2007,16(6):9-15(in Chinese). [3] BRESINA J L,MORRIS P H.Mission operations planning:Beyond MAPGEN[C]//Proceedings of 2nd IEEE International Conference on Space Mission Challenges for Information Technology.Piscataway,NJ:IEEE Press,2006:151-156. [4] 李大生,刘欣,吴明华,等.基于动力学约束的机器人无碰运动规划[J].机器人,1990,12(5):14-19. LI D S,LIU X,WU M H,et al.Collision-free movement planing of robots with dynamic constraints[J].Robot,1990,12(5):14-19(in Chinese). [5] 戈新生,吴永东.欠驱动空间机械臂输入参数化的运动规划方法[J].机械科学与技术,2011,30(2):317-320. GE X S,WU Y D.Motion planing of underactuated space manipulator based on joint parameters[J].Mechanical Science and Technology for Aerospace Engineering,2011,30(2):317-320(in Chinese). [6] LOZANO-PEREZ T.Automatic planning of manipulator transfer movement[J].IEEE Transactions on Systems,Man,and Cybemetics,1981,11(10):681-698. [7] CHEUNG E,LUMELSKY V J.Proximity sensing in robot manipulator motion planning:System and implementation issues[J].IEEE Transactions on Robotics and Automation,1989,5(6):740-751. [8] KHATIB O.Real-time obstacle avoidance for manipulators and mobile robots[J].International Journal of Robotics Research,1986,5(1):90-98. [9] BAZAZ S A,TONDU B.On-line computing of a robotic manipulator joint trajectory with velocity and acceleration constraints[C]//Proceeding of the 1997 IEEE International Symposium on Assembly and Task Planning.Piscataway,NJ:IEEE Press,1997:1-6. [10] ANGELES J.Fundamentals of robotic mechanical systems[M].New York:Springer-Verlag Inc.,2006:141-161. [11] 付荣.基于智能优化方法的机械臂轨迹规划研究[D].北京:北京工业大学,2011:16-20. FU R.Research on trajectory planning of manipulator based on intelligent algorithm[D].Beijing:Beijing University of Technology,2011:16-20(in Chinese). [12] 吴克,冷舒,李群智,等.嫦娥三号月面巡视器机械臂就位探测规划[J].宇航学报,2015,36(4):375-382. WU K,LENG S,LI Q Z,et al.In-situ manipulator exploration planning of Chang'E 3 lunar rover[J].Journal of Astronautics,2015,36(4):375-382(in Chinese). [13] 付荣,居鹤华.高精度解耦六自由度机械臂逆运动学解法[J].计算机测量与控制,2010,18(7):1637-1640. FU R,JU H H.Real-time and high-accurate inverse kinematic control algorithm for decoupled six-DOF manipulator[J].Computer Measurement & Control,2010,18(7):1637-1640(in Chinese). [14] 王晓荣.基于AABB包围盒的碰撞检测算法的研究[D].武汉:华中师范大学,2007:20-30. WANG X R.Research on collision detection algorithm based on AABB bounding volume[D].Wuhan:Central China Normal University,2007:20-30(in Chinese). [15] GINO V D B.Collision detection in interactive 3D environments[M].San Francisco:Morgan Kaufmann Publishers Inc.,2003:538-544.
点击查看大图
计量
- 文章访问数: 982
- HTML全文浏览量: 55
- PDF下载量: 555
- 被引次数: 0