自由漂浮空间机器人路径优化的Legendre伪谱法

戈新生; 陈凯捷

doi:10.6052/0459-1879-16-158

自由漂浮空间机器人路径优化的Legendre伪谱法

doi: 10.6052/0459-1879-16-158

戈新生^1, ,,
陈凯捷²

1.
北京信息科技大学理学院, 北京 100192
2. 北京信息科技大学机电工程学院, 北京 100192

基金项目: 国家自然科学基金资助项目(11472058).

详细信息

通讯作者:
戈新生,教授,主要研究方向:多体系统动力学、航天器姿态动力学与控制.E-mail:gebim@vip.sina.com

中图分类号: V448.2
计量
- 文章访问数: 773
- HTML全文浏览量: 43
- PDF下载量: 1773
- 被引次数: 0
出版历程
- 收稿日期: 2016-06-06
- 修回日期: 2016-06-13
- 刊出日期: 2016-07-18

PATH PLANNING OF FREE FLOATING SPACE ROBOT USING LEGENDRE PSEUDOSPECTRAL METHOD

Ge Xinsheng^{1
, ,},
Chen Kaijie²

1.
School of Applied Science, Beijing Information Science & Technology University, Beijing 100192, China
2. School of Mechanical & Electrical Engineering, Beijing Information Science & Technology University, Beijing 100192, China

摘要

摘要: 基于Legendre 伪谱法研究自由漂浮空间机器人非完整路径规划的最优控制问题. 自由漂浮是空间机器人执行任务常用的工作模式，其路径优化是空间机器人完成复杂空间任务的基础. 由于空间机器人不具有固定基座，机械臂和载体之间存在非完整约束，使得自由漂浮空间机器人路径规划完全不同于地面机器人而变得具有挑战性. 本文提出自由漂浮空间机器人路径规划的最优控制伪谱方法. 首先，利用多体动力学理论建立自由漂浮空间机器人动力学模型，给定系统的初始和目标位形，选取机械臂关节耗散能最小为性能指标，并考虑实际控制输入受限，建立其路径规划的Bolza 问题. 然后，应用Legendre 伪谱法，将状态和控制变量在Legendre-Gauss-Lobatto (LGL) 点上离散，并构造Lagrange 插值多项式逼近系统状态和控制变量，将连续路径优化问题离散化为非线性规划问题求解. 最后通过数值仿真表明，应用Legendre 伪谱法求解自由漂浮空间机器人非完整路径规划问题，得到的机械臂和载体最优运动轨迹，较好地满足各种约束条件，且计算精度高、速度快，并具有良好的实时性.
- 空间机器人 /
- Legendre 伪谱法 /
- 非完整约束 /
- 路径规划 /
- 最优控制
Abstract: Based on the Legendre pseudospectral method, the optimal control of free floating space robots path planning problems are studied. Free floating is the working status for the space robots in task and path planning is the foundation for them to fulfil a complex space task. Because the space robots have no fixed pedestal and there are nonholonomic constraints between the manipulator and the carrier, and it makes the path planning for free floating space robots different from those on the ground. In this paper, the Legendre pseudospectral method which can realize the optimal control of free floating space robots path planning problem is presented. Firstly, a dynamic model of free floating space robots is established by using multi-body dynamics theory. The path planning problem of Bolza with certain initial and terminal stance is then obtained. Here, we select the minimum joint dissipation as performance index and consider the actual control input saturation. Then, by applying the Legendre pseudospectral method, the state and control variables are discretized at Legendre-Gauss-Lobatto (LGL) point and Lagrange interpolation polynomials are constructed to approximate the state and control variables. The problem of continuous path optimization is discretized to solve a nonlinear programming problem. Finally, results of the numerical simulation show that using the application of Legendre pseudospectral method to solve the problem of free floating space robot path planning can get the optimal trajectory of manipulator and carrier. It can fit various constraint conditions well. And this method is with fast simulation calculation, high accuracy and good real-time performance.
- space robot /
- Legendre pseudospectral /
- nonholonomic constraint /
- path planning /
- optimal control

HTML全文

参考文献(27)

1 Dubowsky S, Papadopoulos E. The kinematics, dynamics, and control of free-flying and free-floating space robotic systems. IEEE Transactions on Robotics and Automation, 1993, 9 (5): 531-542

2 Krishman S. Vadali SR. Optimal rotational maneuvers of spacecraft using manipulator arms. Proc. of AIAA Conference on Guidance, Navigation and Control, 1994

3 Yamada K, Yoshikawa S. Feedback control of space robot attitude by cyclic arm motion. Journal of Guidance,Control,and Dynamics, 1997, 20(4): 715-720

4 Nakamura Y, Mukherjee R. Nonholonomic path planning of space robots via a bi-directional approach. IEEE Transactions on Robotics and Automation, 1991, 7 (4): 500-514

5 刘延柱, 顾晓勤. 空间机械臂逆动力学的Liapunov 方法. 力学学报, 1996, 28 (5): 558-563 (Liu Yanzhu, Gu Xiaoqin. The Liapunov method for the inverse dynamics of a space manipulator. Acta Mechanica Sinica, 1996, 28 (5): 558-563 (in Chinese))

6 Coverstone VL, Wilkey NM. Optimal control of a satellite-robot system using direct collocation with non-linear programming. Acta Astronautica, 1995, 36 (3): 149-162

7 Cerven WT, Coverstone VL. Optimal reorientation of multibody spacecraft through joint motion using averaging theory. Journal of Guidance,Control,and Dynamics, 2001, 24(4): 788-795

8 Fenandes C, Gurvits L, Li ZX. Attitude control of a space platform/manipulator system using internal motion. The Inter Journal of Robotics Research, 1994, 13(4): 289-304

9 Rui C, Kolmanovsky IV, McClamroch NH. Nonlinear attitude and shape control of spacecraft with articulated appendages and reaction wheels. IEEE Transactions on Automatic Control, 2000, 45(8): 1455-1469

10 王景,刘良栋. 双臂空间机器人利用内部运动的姿态控制. 宇航学报, 2000, 21(1): 28-35 (Wang Jing, Liu Liangdong. Attitude control of dual-arm space robot using internal control. Journal of Astronautics, 2000, 21(1): 28-35 (in Chinese))

11 赵晓东, 王树国, 严艳军等. 基于轨迹规划的自由漂浮空间机器人抓取运动物体的研究. 宇航学报, 2002, 23(3): 48-51 (Zhao Xiaodong, Wang Shuguo, Yan Yanjun, et al. Algorithm of capturing at a moving body for a free-floating space manipulator based on trajectory planning. Journal of Astronautics, 2002, 23(3): 48-51(in Chinese))

12 Ge XS, Chen LQ, Liu YZ. Optimal control of the deployment process of solar wings on spacecraft. Acta Astronautics, 2007, 60(8): 684-690

13 戈新生, 孙鹏伟. 自由漂浮空间机械臂的非完整运动规划粒子群优化算法, 机械工程学报, 2007, 43(4): 34-38 (Ge Xinsheng, Sun Pengwei. Nonholonmic motion planning of space manipulator system using particle swarm optimization. Chinese Journal of Mechanical Engineering, 2007, 43(4): 34-38(in Chinese))

14 Elnagar G, Kazemi MA, Razzaghi M. The pseudospectral Legendre method for discretizing optimal control problems. IEEE Trans on Automatic Control, 1995, 40(10): 1793-1796

15 Fahroo F, Ross IM. Costate estimation by a Legendre pseudospectral method. Journal of Guidance,Control and Dynamics, 2001, 24(2):270-277

16 Ross IM, Fahroo F. Pseudospectral knotting methods for solving optimal control problem. Journal of Guidance,Control and Dynamics, 2004, 27(3): 397-405

17 Rao AV, Clarke KA. Performance optimization of a maneuvering re-entry vehicle using a legendre pseudospectral method. 2002 AIAA Atmospheric Flight Mechanics Conference, AIAA Paper 2002-4885, Monterey, CA August 5–8, 2002

18 Huntington GT, Rao AV. Optimal reconfiguration of spacecraft formations using the gauss pseudospectral method. Journal of Guidance, Control,and Dynamics, 2012, 31(3): 689-698

19 雍恩米, 唐国金, 陈磊. 基于Gauss 伪谱方法的高超声速飞行器再入轨迹快速优化. 宇航学报, 2008, 29(6): 1766-1772 (Yong Enmi, Tang Guojin, Chen Lei. Rapid trajectory optimization for hypersonic reentry vehicle via gauss pseudospectral method. Journal of Astronautics, 2008, 29(6): 1766-1772(in Chinese))

20 Li S, Duan GR. A pseudospectral method for trajectory optimization of free-floating space manipulator. Chinese Control Conference, 2012, 2395-2399

21 Duan GR, Li S. FFSM trajectory optimization via multiphase Gauss pseudospectral method. The 10th World Congress on Intelligent Control and Automation, 2012, 1615-1620

22 廖一寰, 李道奎, 唐国金. 基于混合规划策略的空间机械臂运动规划研究. 宇航学报, 2011, 32(1): 98-103 (Liao Yihuan, Li Daokui, Tang Guojin. Motion planning of space manipulator system based on a hybrid programming strategy. Journal of Astronautics, 2011, 32(1): 98-103(in Chinese))

23 Liao YH, Li DK, Tang GJ. Motion planning for vibration reducing of free-floating redundant manipulators based on hybrid optimization approach. Chinese Journal of Aeronautics, 2011, 24(4): 533-540

24 刘延柱, 潘振宽, 戈新生. 多体系统动力学(第二版). 北京: 高等教育出版社, 2014 (Liu Yanzhu, Pan Zhenkuan, Ge Xinsheng. Dynamics of Multibody Systems, (Second edition). Beijing: Higher Education Press, 2014(in Chinese))

25 Shuster MD. A survey of attitude representations. Journal of Astronautics Science, 1993, 41(4): 439-518

26 Hull DG. Optimal Eontrol Theory for Applications. Springer-Verlag, New York, 2003

27 戈新生. 多体航天器姿态运动建模和非完整运动控制. [博士论文]. 上海: 上海大学, 2004: 114-121 (Ge Xinsheng. Multibody spacecraft modelling of attitude motion and nonholonomic motion planning. [PhD Thesis]. Shanghai: Shanghai University, 2004: 114-121(in Chinese))

施引文献

资源附件(0)

访问统计