中文核心期刊

中国科技核心期刊

中国科学引文数据库(CSCD)来源期刊

中国高校优秀科技期刊

中国宇航学会深空探测技术专业委员会会刊

高级检索

留言板

尊敬的读者、作者、审稿人, 关于本刊的投稿、审稿、编辑和出版的任何问题, 您可以本页添加留言。我们将尽快给您答复。谢谢您的支持!

姓名
邮箱
手机号码
标题
留言内容
验证码

小天体表面探测器弹跳运动与路径规划

王棒 徐瑞 李朝玉 高越

王棒, 徐瑞, 李朝玉, 高越. 小天体表面探测器弹跳运动与路径规划[J]. 深空探测学报(中英文), 2022, 9(4): 447-454. doi: 10.15982/j.issn.2096-9287.2022.20220042
引用本文: 王棒, 徐瑞, 李朝玉, 高越. 小天体表面探测器弹跳运动与路径规划[J]. 深空探测学报(中英文), 2022, 9(4): 447-454. doi: 10.15982/j.issn.2096-9287.2022.20220042
WANG Bang, XU Rui, LI Zhaoyu, GAO Yue. Bouncing Motion and Path Planning of Small Body Surface Rover[J]. Journal of Deep Space Exploration, 2022, 9(4): 447-454. doi: 10.15982/j.issn.2096-9287.2022.20220042
Citation: WANG Bang, XU Rui, LI Zhaoyu, GAO Yue. Bouncing Motion and Path Planning of Small Body Surface Rover[J]. Journal of Deep Space Exploration, 2022, 9(4): 447-454. doi: 10.15982/j.issn.2096-9287.2022.20220042

小天体表面探测器弹跳运动与路径规划

doi: 10.15982/j.issn.2096-9287.2022.20220042
基金项目: 基础科学研究资助项目(JCKY2018602B002);国家自然科学基金资助项目(61976020)
详细信息
    作者简介:

    王棒(1996– ),男,博士研究生,主要研究方向:小行星表面移动与深空探测任务规划。通讯地址:北京市海淀区中关村南大街5号 北京理工大学宇航学院22号信箱(100081)E-mail: wangbang85@163.com

    徐瑞(1975– ),男,教授,博士生导师,主要研究方向:航天器任务规划、自主导航、智能控制。本文通讯作者。通讯地址:北京市海淀区中关村南大街5号 北京理工大学宇航学院22号信箱(100081)E-mail:xurui@bit.edu.cn

  • ● The surface jumping mode is analyzed in weak gravitation. ● A single-step bouncing strategy is achieved on the small body surface combined with attitude control. ● A variable-step A* algorithm is proposed to achieve rover path planning. ● The new algorithm is significantly more efficient for complex obstacle terrain and better suited for surface bounce rover.
  • 中图分类号: V476.4

Bouncing Motion and Path Planning of Small Body Surface Rover

  • 摘要: 针对传统轮式移动探测器难以适应小天体弱引力环境的问题,以立方体构型的跳跃式探测器为对象,分析了弱引力起跳模式,提出表面移动单步弹跳策略,以发挥其越障能力。同时针对这一特性提出变步长A*算法规划探测器表面移动路径,实现避障及越障巡视。仿真结果表明,探测器能够有效越过地形障碍,并且新算法减少了路径节点,对于高密度障碍地形计算效率更高。
    Highlights
    ● The surface jumping mode is analyzed in weak gravitation. ● A single-step bouncing strategy is achieved on the small body surface combined with attitude control. ● A variable-step A* algorithm is proposed to achieve rover path planning. ● The new algorithm is significantly more efficient for complex obstacle terrain and better suited for surface bounce rover.
  • 图  1  探测器起跳过程

    Fig.  1  Jump up process of probe

    图  2  绕轴转动俯视图

    Fig.  2  Top view of rotating around axis

    图  3  无法起跳

    Fig.  3  Unable to jump

    图  4  黏滞和滑动模式的起跳速度

    Fig.  4  Jump up speed in sticking and sliding mode

    图  5  法向接触力

    Fig.  5  Normal contact force

    图  6  探测器轨迹对比

    Fig.  6  Comparison of rover trajectories

    图  7  不同表面摩擦系数下探测器轨迹

    Fig.  7  Rover trajectories under different surface friction coefficients

    图  8  不同引力场下探测器轨迹

    Fig.  8  Rover trajectories under different gravitational fields

    图  9  飞轮力矩变化

    Fig.  9  Variation of flywheel torque

    图  10  姿态角变化

    Fig.  10  Variation of attitude angle

    图  11  不同障碍密度算法效率对比

    Fig.  11  Comparison of algorithm efficiency under different barrier density

    图  12  移动路径对比

    Fig.  12  Movement path comparison

  • [1] BEKEY I. Dealing with the threat to Earth from asteroids and comets[M]. [S. l.]: Publications and Public Relations, ISRO Headquarters, 2009.
    [2] 徐瑞, 朱圣英, 崔平远. 深空探测技术概论[M]. 北京: 高等教育出版社, 2021: 25-29.

    XU R, ZHU S Y, CUI P Y. Introduction to deep space exploration technology[M]. Beijing: Higher Education Press, 2021.
    [3] VEVERKA J,FARQUHAR B,ROBINSON M,et al. The landing of the NEAR-Shoemaker spacecraft on asteroid 433 Eros[J]. Nature,2001,413(6854):390-393. doi:  10.1038/35096507
    [4] DUNHAM D W,FARQUHAR R W,MCADAMS J V,et al. Implementation of the first asteroid landing[J]. Icarus,2002,159(2):433-438. doi:  10.1006/icar.2002.6911
    [5] YOSHIMITSU T, KUBOTA T, NAKATANI I. MINERVA rover which became a small artificial solar satellite [C]//The 20th Annual AIAA/USU Conference on Small Satellites. Utah, USA: AIAA, 2006.
    [6] ROLL R,WITTE L. ROSETTA lander Philae:touch-down reconstruction[J]. Planetary and Space Science,2016,125:12-19. doi:  10.1016/j.pss.2016.02.005
    [7] BOEHNHARDT H,BIBRING J P,APATHY I,et al. The Philae lander mission and science overview[J]. Philosophical Transactions of The Royal Society A Mathematical Physical and Engineering Sciences,2017,375(2097):20160248. doi:  10.1098/rsta.2016.0248
    [8] VAN W S,TSUDA Y,YOSHIKAWA K,et al. Prearrival deployment analysis of rovers on Hayabusa 2 asteroid explorer[J]. Journal of Spacecraft and Rockets,2018,55(4):797-817. doi:  10.2514/1.A34157
    [9] BIERHAYS E B,CLARK B C,HARRIS J W,et al. The OSIRIS-REx spacecraft and the Touch-and-Go Sample Acquisition Mechanism (TAGSAM)[J]. Space Science Reviews,2018,214(7):1-46.
    [10] RUDIN N,KOLVENBACH H,TSOUNIS V,et al. Cat-like jumping and landing of legged robots in low gravity using deep reinforcement learning[J]. IEEE Transactions on Robotics,2021,38(1):317-328.
    [11] PAVONE M, CASTILLO J C, NESNAS I, et al. Spacecraft/rover hybrids for the exploration of small Solar System bodies [C]//2013 IEEE Aerospace Conference. Montana, USA: IEEE, 2013.
    [12] WANG F,LI C,NIU S,et al. Design and analysis of a spherical robot with rolling and jumping modes for deep space exploration[J]. Machines,2022,10(2):126. doi:  10.3390/machines10020126
    [13] YOSHIMITSU T,KUBOTA T,NAKATANI I,et al. Micro-hopping robot for asteroid exploration[J]. Acta Astronautica,2003,52(2-6):441-446. doi:  10.1016/S0094-5765(02)00186-8
    [14] GAJAMOHAN M, MERZ M, THOMMEN I, et al. The Cubli: a cube that can jump up and balance[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Algarve, Portugal: IEEE, 2012.
    [15] 王飞. 小行星跳跃探测器着陆跳跃运动仿真分析[D]. 哈尔滨: 哈尔滨工业大学, 2014.

    WANG F. Research on simulation of the motion of landing and hopping of asteroid hopping probe[D]. Harbin: Harbin Institute of Technology, 2014.
    [16] 袁勤. 小行星探测器跳跃行走导航与控制策略研究[D]. 哈尔滨: 哈尔滨工业大学, 2015.

    YUAN Q. Research on navigation and control of the hopping motion of asteroid probe[D]. Harbin: Harbin Institute of Technology, 2015.
    [17] FENG R, ZHANG Y, LIU J, et al. Soft robotic perspective and concept for planetary small body exploration[EB/OL]. [2021-12-22](2022-5-6). https://www.liebertpub.com/doi/abs/10.1089/soro.2021.0054.
    [18] GRIMM C D,GRUNDMANN J T,HENDRIKSE J,et al. From idea to flight—a review of the Mobile Asteroid Surface Scout (MASCOT) development and a comparison to historical fast-paced space programs[J]. Progress in Aerospace Sciences,2019,104:20-39. doi:  10.1016/j.paerosci.2018.11.001
    [19] 李晓旭, 马兴录, 王先鹏. 移动机器人路径规划算法综述[J]. 计算机测量与控制, 2022, 30(7): 9-19.

    LI X X, MA X L, WANG X P. A survey of path planning algorithms for mobile robots[J]. Computer Measurement Control, 2022, 30(7): 9-19.
    [20] GUNAWAN S A, PRATAMA G N P, CAHYADI A I, et al. Smoothed a-star algorithm for nonholonomic mobile robot path planning[C]//2019 International Conference on Information and Communications Technology (ICOIACT). Yogyakarta, Indonesia: IEEE, 2019: 654-658.
    [21] ZHENG T, XU Y, ZHENG D. AGV path planning based on improved A-star algorithm[C]//2019 IEEE 3rd Advanced Information Management, Communicates, Electronic and Automation Control Conference (IMCEC). Chongqing, China: IEEE, 2019: 1534-1538.
    [22] 舒伟楠,赵建森,谢宗轩,等. 基于改进A*算法的水面无人艇路径规划[J]. 上海海事大学学报,2022,43(2):1-6.

    SHU W N,ZHAO J S,XIE Z X,et al. Path planning for unmanned surface vessels based on improved A* algorithm[J]. Journal of Shanghai Maritime University,2022,43(2):1-6.
    [23] HUNT K H,CROSSLEY F R E. Coefficient of restitution interpreted as damping in vibroimpact[J]. Journal of Applied Mechanics,1975,42(2):440. doi:  10.1115/1.3423596
    [24] MARGHITU D B. The impact of flexible links with solid lubrication[J]. Journal of Sound Vibration,1997,205(5):712-720. doi:  10.1006/jsvi.1997.1040
    [25] SHAN M,GUO J,GILL E. Contact dynamic models of space debris capturing using a net[J]. Acta Astronautica,2017,158:198-205.
  • [1] 尚海滨, 韦炳威, 卢榉承.  小天体引力场建模技术进展 . 深空探测学报(中英文), 2022, 9(4): 359-372. doi: 10.15982/j.issn.2096-9287.2022.20220074
    [2] 李立春, 李剑, 王镓, 于天一, 刘传凯, 李楠, 万文辉.  天体表面探测遥操作模拟验证系统设计与实现 . 深空探测学报(中英文), 2022, 9(1): 72-79. doi: 10.15982/j.issn.2096-9287.2022.20210133
    [3] 王光泽, 邵巍, 郗洪良, 姚文龙, 黄翔宇.  小天体表面纹理曲线精准匹配算法 . 深空探测学报(中英文), 2021, 8(3): 306-314. doi: 10.15982/j.issn.2096-9287.2021.20200096
    [4] 胡晓东, 张宽, 谢圆, 张辉, 卢皓, 刘传凯, 陈翔, 赵焕洲, 谢剑锋.  “嫦娥五号”月面采样机械臂路径规划 . 深空探测学报(中英文), 2021, 8(6): 564-571. doi: 10.15982/j.issn.2096-9287.2021.20210095
    [5] 王鹏, 武小宇, 张立华.  低成本多小天体并行交会技术 . 深空探测学报(中英文), 2019, 6(1): 73-81. doi: 10.15982/j.issn.2095-7777.2019.01.011
    [6] 朱立颖, 叶志玲, 李玉庆, 付中梁, 徐勇.  小天体探测自主绕飞智能规划建模 . 深空探测学报(中英文), 2019, 6(5): 463-469. doi: 10.15982/j.issn.2095-7777.2019.05.007
    [7] 于天一, 费江涛, 李立春, 程肖.  月面巡视器路径规划方法研究 . 深空探测学报(中英文), 2019, 6(4): 384-390. doi: 10.15982/j.issn.2095-7777.2019.04.011
    [8] 刘德赟, 赖小明, 王露斯, 刘晓庆, 赵曾, 张加波, 全齐全.  小天体表面采样技术综述 . 深空探测学报(中英文), 2018, 5(3): 246-261. doi: 10.15982/j.issn.2095-7777.2018.3.007
    [9] 于正湜, 朱圣英, 崔平远, 刘延杰.  小天体表面移动技术研究进展 . 深空探测学报(中英文), 2017, 4(4): 301-309. doi: 10.15982/j.issn.2095-7777.2017.04.001
    [10] 曾祥远, 李俊峰, 刘向东.  不规则小天体引力场内的广义甩摆轨道 . 深空探测学报(中英文), 2016, 3(1): 29-33. doi: 10.15982/j.issn.2095-7777.2016.01.004
    [11] 刘延杰, 朱圣英, 崔平远.  小天体安全着陆与表面探测控制方法研究 . 深空探测学报(中英文), 2016, 3(4): 370-376. doi: 10.15982/j.issn.2095-7777.2016.04.009
    [12] 魏祥泉, 黄建明, 顾冬晴, 陈凤.  火星车自主导航与路径规划技术研究 . 深空探测学报(中英文), 2016, 3(3): 275-281. doi: 10.15982/j.issn.2095-7777.2016.03.012
    [13] 胡海静, 朱圣英, 崔平远.  基于Lyapunov函数的小天体软着陆障碍规避控制方法 . 深空探测学报(中英文), 2015, 2(2): 149-154. doi: 10.15982/j.issn.2095-7777.2015.02.008
    [14] 郑艺裕, 崔祜涛, 王晓芳.  附着小天体的动态面鲁棒制导与控制方法 . 深空探测学报(中英文), 2015, 2(2): 155-161. doi: 10.15982/j.issn.2095-7777.2015.02.009
    [15] 江秀强, 陶婷, 杨威, 李爽.  附着小天体的最优制导控制方法 . 深空探测学报(中英文), 2015, 2(1): 53-60. doi: 10.15982/j.issn.2095-7777.2015.01.008
    [16] 魏若岩, 阮晓钢, 庞涛, OuattaraSIE, 武旋, 肖尧.  小天体软着陆中的地面特征区域提取与跟踪算法 . 深空探测学报(中英文), 2014, 1(4): 308-314. doi: 10.15982/j.issn.2095-7777.2014.04.011
    [17] 袁旭, 朱圣英, 乔栋, 崔平远.  小天体着陆动力学参数不确定性影响分析 . 深空探测学报(中英文), 2014, 1(2): 134-139.
    [18] 于洋, 宝音贺西.  小天体附近的轨道动力学研究综述 . 深空探测学报(中英文), 2014, 1(2): 93-104.
    [19] 王琼, 于登云, 贾阳.  Risk Theta*:一种基于地形危险度的任意航向路径规划算法 . 深空探测学报(中英文), 2014, 1(4): 269-274. doi: 10.15982/j.issn.2095-7777.2014.04.004
    [20] 董元元, 崔祜涛, 田阳.  基于栅格地图的火星车路径规划方法 . 深空探测学报(中英文), 2014, 1(4): 289-293. doi: 10.15982/j.issn.2095-7777.2014.04.007
  • 加载中
图(12)
计量
  • 文章访问数:  47
  • HTML全文浏览量:  2
  • PDF下载量:  4
  • 被引次数: 0
出版历程
  • 收稿日期:  2022-05-06
  • 修回日期:  2022-06-25
  • 网络出版日期:  2022-08-12
  • 刊出日期:  2022-09-30

小天体表面探测器弹跳运动与路径规划

doi: 10.15982/j.issn.2096-9287.2022.20220042
    基金项目:  基础科学研究资助项目(JCKY2018602B002);国家自然科学基金资助项目(61976020)
    作者简介:

    王棒(1996– ),男,博士研究生,主要研究方向:小行星表面移动与深空探测任务规划。通讯地址:北京市海淀区中关村南大街5号 北京理工大学宇航学院22号信箱(100081)E-mail: wangbang85@163.com

    徐瑞(1975– ),男,教授,博士生导师,主要研究方向:航天器任务规划、自主导航、智能控制。本文通讯作者。通讯地址:北京市海淀区中关村南大街5号 北京理工大学宇航学院22号信箱(100081)E-mail:xurui@bit.edu.cn

  • ● The surface jumping mode is analyzed in weak gravitation. ● A single-step bouncing strategy is achieved on the small body surface combined with attitude control. ● A variable-step A* algorithm is proposed to achieve rover path planning. ● The new algorithm is significantly more efficient for complex obstacle terrain and better suited for surface bounce rover.
  • 中图分类号: V476.4

摘要: 针对传统轮式移动探测器难以适应小天体弱引力环境的问题,以立方体构型的跳跃式探测器为对象,分析了弱引力起跳模式,提出表面移动单步弹跳策略,以发挥其越障能力。同时针对这一特性提出变步长A*算法规划探测器表面移动路径,实现避障及越障巡视。仿真结果表明,探测器能够有效越过地形障碍,并且新算法减少了路径节点,对于高密度障碍地形计算效率更高。

注释:
1)  ● The surface jumping mode is analyzed in weak gravitation. ● A single-step bouncing strategy is achieved on the small body surface combined with attitude control. ● A variable-step A* algorithm is proposed to achieve rover path planning. ● The new algorithm is significantly more efficient for complex obstacle terrain and better suited for surface bounce rover.

English Abstract

王棒, 徐瑞, 李朝玉, 高越. 小天体表面探测器弹跳运动与路径规划[J]. 深空探测学报(中英文), 2022, 9(4): 447-454. doi: 10.15982/j.issn.2096-9287.2022.20220042
引用本文: 王棒, 徐瑞, 李朝玉, 高越. 小天体表面探测器弹跳运动与路径规划[J]. 深空探测学报(中英文), 2022, 9(4): 447-454. doi: 10.15982/j.issn.2096-9287.2022.20220042
WANG Bang, XU Rui, LI Zhaoyu, GAO Yue. Bouncing Motion and Path Planning of Small Body Surface Rover[J]. Journal of Deep Space Exploration, 2022, 9(4): 447-454. doi: 10.15982/j.issn.2096-9287.2022.20220042
Citation: WANG Bang, XU Rui, LI Zhaoyu, GAO Yue. Bouncing Motion and Path Planning of Small Body Surface Rover[J]. Journal of Deep Space Exploration, 2022, 9(4): 447-454. doi: 10.15982/j.issn.2096-9287.2022.20220042
    • 近地小天体(Near-Earth Objects,NEO)包括近地小行星(Near-Earth Asteroids,NEA)和近地彗星(Near-Earth Comets,NEC),其轨道近日点小于1.3 AU[1]。实施小天体表面探测可加深对空间环境的认知,促进太阳系起源演化的研究;获取表面物化属性及形貌有助于推测该类天体的形成与演化;其内部蕴含的矿产资源可为探测器提供燃料、能源方面的支持;同时还可验证深空探测关键技术,因此实施小天体表面探测具有重要的科学与工程意义,对空间科学、行星科学、材料科学等领域的发展均有着促进作用。

      以美国国家航空航天局(National Aeronautics and Space Administration,NASA)、日本宇宙航空研究开发机构(Japan Aerospace Exploration Agency,JAXA)和欧洲航天局(European Space Agency,ESA)为代表的航天机构已经实施了多项小天体探测任务。在这些任务中,有些探测器已经与小天体表面进行了接触或者向其投放了小型探测装置[2]。2001年,“近地小行星交会”(Near Earth Asteroid Rendezvous-shoemaker,NEAR)探测器以约1.5~1.8 m/s的速度成功着陆在小行星Eros 433上,实现了首次小行星表面着陆[3-4],在停止工作前一段时间收集了表面物质成份数据。2005年,Hayabusa探测器与小行星Itokawa 25143 实现了交会着陆,利用星上搭载的载荷对表面进行了近距离观测、现场物质分析及表面物质采集等任务,但其携带的小型着陆器“智慧女神”(Minerva)部署失败,并未着陆至表面[5]。2014年,“罗塞塔号”(Rosetta)探测器成为首个进入彗星轨道的探测器,而后释放“菲莱号”(Philae)着陆器,由于预设的锚定方案未能正常执行,导致Philae在彗星表面发生弹跳,落在裂缝阴影区中,最终因能源无法得到补充而停止工作[6-7]。2018年,“隼鸟2号”(Hayabusa 2)探测器采集了表面以及表面以下物质样本并成功向“龙宫”(Ryugu)小行星表面部署了小型漫游车[8],其获取的数据为小行星研究提供了科学依据。2020年,OSIRIS-REx探测器使用TAGSAM设备采集了小行星“贝努”(Bennu)表面的风化层颗粒[9],其采样头和机械手之间的万向头为小行星的复杂地形提供了自适应能力。

      相较于飞越探测和环绕探测,表面探测无疑能够获得更准确的信息,而且采用表面探测器代替宇航员进行着陆探测及取样分析也将会大大降低探测成本和探测风险。因此,探测器表面移动成为小天体探测的关键技术之一。但小天体引力微弱,表面多碎石、沟槽,这些特性使探测器的行走与控制极其复杂,传统的轮式行进方式适用性较差。针对这一问题,研究人员提出将跳跃移动应用于小天体探测。相较于轮式移动,跳跃探测器结构简单,地形适应性好,并且越障能力强,有足够的移动性来完成探测任务。

      国内外对跳跃行走这一方式已经开展了很多研究。针对小天体表面探测领域,根据外形可将跳跃探测器主要区分为腿式、球式以及立方体式。Nikita等[10]研究的四足机器人仅采用四肢进行姿态控制,可实现微重力环境下的受控跳跃和着陆。用于火卫一和类似天体的刺猬机器人不但能进行跳跃运动,还能进行翻滚运动[11]。Wang等[12]提出了一种可进行滚动和跳跃的多模运动球形机器人并验证了其在微重力环境下的适应性。微型跳跃探测机器人Minerva通过内部飞轮产生的旋转力矩使机器人跳跃[13]。Gajamohan等[14]基于倒立摆模型的单自由度系统研究了立方体外形跳跃探测器Cubli。王飞等[15-16]研究了跳跃探测器控制策略并分析了不同参数对跳跃运动的影响。可展开立方体[17]通过起跳和着陆时的变形可有效抑制反弹。Hayabusa 2携带的MASCOT探测器通过内部的质量摆实现了小天体表面的跳跃移动[18]。面向小天体表面探测任务,当前跳跃机器人的研究更多偏向于立方体式,相较于腿式和球式,立方体式探测器具有结构简单,易于控制以及表面稳定性好等优点。

      良好的路径规划可以有效减少跳跃机器人的移动路径以及同小天体表面的碰撞次数。方法可分为传统规划算法、智能规划算法以及基于采样的规划算法3类[19]。传统规划算法中A*算法具有计算方式简单,规划路径短的优点,国内外学者对其改进算法做了广泛研究,Gunawan等[20]提出平滑A*算法提高了路径可跟踪性。Zheng等[21]针对AGV进行了A*算法优化,加入角度代价评估函数提高了计算效率。舒伟楠等[22]通过改进评价函数减少了遍历的节点总数,并且对冗余节点进行平滑处理。目前对A*算法的改进主要集中于路径平滑,拐点减少及搜索效率等方面,同时算法规划对象多为可以在行进过程中连续实现方向速度改变的物体,并且需要在此过程中进行障碍规避。而跳跃探测器单次跳跃运动方向与距离由起跳初始速度决定,其路径为可跨越障碍的连续线段,当前方法难以满足需求。

      基于以上研究,本文以内部飞轮驱动的立方体跳跃探测器为对象,分析弱引力下的起跳过程,并给出了起跳模式。以姿态控制与表面碰撞相结合的方式设计单步跳跃策略。最后结合探测器的越障能力,提出变步长A*算法,实现了跳跃探测器的表面移动路径规划。

    • 将探测器抽象为一个质量分布均匀的刚性立方体,在质心处安装三轴正交的飞轮。探测器初始静止在小天体表面上,内部飞轮旋转产生力矩,当力矩足够大时,表面对探测器的等效支持力将作用于顶点,探测器将绕该顶点发生转动。此时重力相对于该顶点的力矩将逐渐减小,质心的法向和切向速度逐渐增加,同时表面对探测器的支持力在逐渐减小,当支持力减到0时,探测器将跳起。跳起后在空中作抛物线运动,此时可以控制飞轮力矩以使探测器获得期望姿态。如图1所示。

      图  1  探测器起跳过程

      Figure 1.  Jump up process of probe

    • 根据上述描述,探测器的起跳过程可描述为刚体的定轴转动,根据起跳力矩的不同,转轴的描述方程也不相同。如图2所示,起跳顶点为A,起跳速度垂直于转动轴。

      图  2  绕轴转动俯视图

      Figure 2.  Top view of rotating around axis

      设质心初始坐标为$ \left( { - l, - l,l} \right) $,起跳力矩为$ \left( {{T_x},{T_y},{T_z}} \right) $,旋转轴的单位矢量为${\boldsymbol a} = \left( {{x_a},{y_a},{z_a}} \right)$,则绕轴转动的坐标转换矩阵为

      $$ {\boldsymbol{R}} = \left[ {\begin{array}{*{20}{c}} {dx_a^2 + c}&{d{x_a}{y_a} + {z_a}c}&{d{x_a}{z_a} - {y_a}s} \\ {d{x_a}{y_a} - {z_a}c}&{dy_a^2 + c}&{d{y_a}{z_a} + {x_a}s} \\ {d{x_a}{z_a} + {y_a}s}&{d{y_a}{z_a} - {x_a}s}&{dz_a^2 + c} \end{array}} \right] $$ (1)
      $$ \left[ {\begin{array}{*{20}{c}} {{x_a}} \\ {{y_a}} \\ {{z_a}} \end{array}} \right] = \left[ {\begin{array}{*{20}{c}} {\cos \theta } \\ { - \sin \theta } \\ 0 \end{array}} \right] $$ (2)

      其中:$c = \cos \alpha $$s = \sin \alpha $$d = 1 - \cos \alpha \;\; \theta =$${\rm{arctan}} (| {T_y} /$${T_x} |)$$\alpha $为探测器绕轴转动的角度。

      由此可得起跳动力学方程

      $$ {I_{\rm A}}\ddot \alpha = T - mg\sqrt {{{\left| x \right|}^2} + {{\left| y \right|}^2}} $$ (3)
      $$ m{\left[ {\ddot x{\text{ }}\ddot y{\text{ }}\ddot z} \right]^{\text{T}}} = {\left[ {{F_{{\rm t}x}}{\text{ }}{F_{{\rm t}y}}{\text{ }}{F_{\rm n}} - mg} \right]^{\text{T}}} $$ (4)
      $$ {\left[ {x{\text{ }}y{\text{ }}z} \right]^{\text{T}}} = {\boldsymbol{R}}{\left[ { - l{\text{ }} - l{\text{ }}l} \right]^{\text{T}}} $$ (5)

      其中:$T$为合力矩;${I_{\rm A}}$为绕旋转轴的转动惯量。

    • 在探测器绕轴转动$ t = 0 $时刻,应有$ \alpha = \dot \alpha = 0 $,并且$ \ddot \alpha > 0 $。由此可得绕轴转动所需最小力矩为

      $$ T > \sqrt {\text{2}} mgl $$ (6)

      探测器从转动至离开表面起跳,存在黏滞和滑动两种状态,记静摩擦系数为$ {\mu _0} $,动摩擦系数为$ \mu $,在黏滞状态下有

      $$ \left| {{F_{\rm t}}} \right| \leqslant {F_{\rm n}}{\mu _0} $$ (7)

      若不满足式(6),则说明起跳过程出现滑动,此时有

      $$ {F_{\rm t}} = - {F_{\rm n}}\mu {\rm sgn} \left( {{{\boldsymbol v}_{\rm t}}} \right) $$ (8)

      其中:vt表示切向速度矢量。

      黏滞状态下若力矩不足,探测器只能绕轴转动而无法起跳,如图3所示。

      图  3  无法起跳

      Figure 3.  Unable to jump

      结合式(3)~(5)可得

      $$ \ddot \alpha = \frac{{T - mg\sqrt {{{\left| x \right|}^2} + {{\left| y \right|}^2}} }}{{{I_A}}} $$ (9)
      $$ \ddot z = l\ddot \alpha \left[ {\left( {{x_a} - {y_a}} \right){\rm c} - {\rm s} } \right] + l{\dot \alpha ^2}\left[ {\left( {{y_a} - {x_a}} \right){\rm s} - {\rm c} } \right] $$ (10)
      $$ {F_{\rm n}} = m\ddot z + mg $$ (11)

      因此,要使探测器能以黏滞状态起跳,其力矩必须使${F_{\rm n}}$$ 0 < \alpha < \arctan \left( {1/\sin \theta } \right) $范围内存在零点。

      分析探测器在小天体表面的黏滞及滑动起跳过程,探测器质心速度变化如图4所示。黏滞起跳模式所需时间明显更长,并且起跳的法向速度也更小,不利于探测器的越障性能。而滑动起跳模式有足够的法向速度,以该速度能越过较大障碍区域,在空中的时间足够完成姿态调整。根据以上模式分析,探测器应当以滑动状态起跳为佳。

      图  4  黏滞和滑动模式的起跳速度

      Figure 4.  Jump up speed in sticking and sliding mode

    • 考虑到小天体表面风化层的存在,探测器与表面碰撞有一定持续时间。因此,将这一过程等效为有摩擦的非完全弹性碰撞问题,引入非线性阻尼模型,采用连续接触力方法描述碰撞过程中的受力、作用时间等因素[23-25]

      图5所示,碰撞时法向接触力表示为

      图  5  法向接触力

      Figure 5.  Normal contact force

      $$ {{{F}}_{\text n}} = k{\delta ^{3/2}} + c{\delta ^{3/2}}\dot \delta \left( {\delta \geqslant 0} \right) $$ (12)
      $$ c = \frac{{3k\left( {1 - {e^2}} \right)}}{{4{v_{z0}}}} $$ (13)

      其中:$k$为接触刚度系数;$\delta $为侵入深度;$c$为阻尼系数;$e$为恢复系数;${v_{z0}}$为接触瞬间的法向速度。

      碰撞过程非瞬时,探测器在碰撞时可能会产生切向位移,其运动受摩擦力影响,基于理想表面假设,采用库仑摩擦力模型计算切向摩擦力为

      $$ {{\boldsymbol{F}}_{\rm t}} = - \mu {F_{\rm n}}\frac{{{{\boldsymbol{v}}_{\rm t}}}}{{\left| {{{\boldsymbol{v}}_{\rm t}}} \right|}} $$ (14)
    • 跳跃探测器采用飞轮作为执行机构,根据欧拉方程可得

      $$ \frac{{{{{\rm d}_{\rm I}}}{\boldsymbol{H}}}}{{{\rm d}t}} = \frac{{{{\rm d}_{\rm B}}{\boldsymbol{H}}}}{{{\rm d}t}} + {\boldsymbol{\omega }} \times {\boldsymbol{H}} = {\boldsymbol{T}} $$ (15)

      其中:下标“I”和“B”分别代表惯性坐标系和本体坐标系。

      由欧拉方程求得在系统质心坐标系下多刚体姿态动力学方程为

      $$ {\boldsymbol{I\dot \omega + }}{{\boldsymbol{\omega }}\times}{\boldsymbol{I\omega + }}{\boldsymbol{\omega }} \times {\boldsymbol{U}}{{\boldsymbol{J}}_{\rm w}}{{\boldsymbol{\varOmega }}_{\rm w}}{\boldsymbol{ + U}}{{\boldsymbol{J}}_{\rm w}}{{\boldsymbol{\dot \varOmega }}_{\rm w}}= {{\boldsymbol{T}}_{\rm b}} $$ (16)

      其中,$ {\boldsymbol{\omega }} $为探测器角速度矢量列阵;${{\boldsymbol{\varOmega }}_{\rm w}}$为飞轮转速列阵;$ {\boldsymbol{U}} $为飞轮安装矩阵;$ {\boldsymbol{I}} $为探测器转动惯量;${{\boldsymbol{J}}_{\rm w}}$为飞轮转动惯量组成的对角阵;${{\boldsymbol{T}}_{\rm b}}$为外力矩在质心坐标系下的分量列阵。

      由式(14)可得探测器角加速度矢量如下

      $$ {\boldsymbol{\dot \omega }} = {\boldsymbol{I}}_{\rm B}^{ - 1}\left[ {{{\boldsymbol{T}}_{\rm b}} + {{\boldsymbol{T}}_{\rm c}} - {\boldsymbol{\omega }} \times \left( {{{\boldsymbol{I}}_{\rm B}}{\boldsymbol{\omega }} + {\boldsymbol{U}}{{\boldsymbol{J}}_{\rm w}}{{\boldsymbol{\varOmega }}_{\rm w}}} \right)} \right] $$ (17)

      采用四元数表示姿态,四元数微分方程表示成矩阵形式为

      $$ \left[ \begin{gathered} {{\dot q}_0} \\ {{\dot q}_1} \\ {{\dot q}_2} \\ {{\dot q}_3} \\ \end{gathered} \right] = \frac{1}{2}\left[ \begin{gathered} {q_0}\;\;\; - {q_1}\;\;\; - {q_2}\;\;\; - {q_3} \\ {q_1}\;\;\;\;\;{q_0}\;\;\;\; - {q_3}\;\;\;\;\;{q_2} \\ {q_2}\;\;\;\;\;{q_3}\;\;\;\;\;{q_0}\;\;\;\; - {q_1} \\ {q_3}\;\;\; - {q_2}\;\;\;\;{q_1}\;\;\;\;\;\;\;{q_0} \\ \end{gathered} \right]\left[ \begin{gathered} 0 \\ {\omega _x} \\ {\omega _y} \\ {\omega _z} \\ \end{gathered} \right] $$ (18)
    • 为准确到达目标地点,需要合理控制飞轮的输入力矩,而且当探测器起跳后或与表面碰撞后,具有一定的角速度,在做抛体运动的同时自身也会旋转,若不进行控制,与表面接触时的姿态及碰撞后运动方向难以预测。因此探测器起跳后施加姿态控制,使其以期望的目标姿态落向表面。

      设探测器当前姿态四元数为$ {\boldsymbol{Q}} $,目标姿态四元数为${{\boldsymbol{Q}}_{\rm f}}$,误差四元数为${{\boldsymbol{Q}}_{\rm e}}$,则有

      $$ \left[ \begin{gathered} {q_{{\rm e}0}} \\ {q_{{\rm e}1}} \\ {q_{{\rm e}2}} \\ {q_{{\rm e}3}} \\ \end{gathered} \right] = \left[ {\begin{array}{*{20}{c}} {{q_0}}&{{q_1}}&{{q_2}}&{{q_3}} \\ { - {q_1}}&{{q_0}}&{{q_3}}&{ - {q_2}} \\ { - {q_2}}&{ - {q_3}}&{{q_0}}&{{q_1}} \\ { - {q_3}}&{{q_2}}&{ - {q_1}}&{{q_0}} \end{array}} \right]\left[ \begin{gathered} {q_{{\rm f}0}} \\ {q_{{\rm f}1}} \\ {q_{{\rm f}2}} \\ {q_{{\rm f}3}} \\ \end{gathered} \right] $$ (19)

      满足约束$q_{{\rm e}0}^2 + q_{{\rm e}1}^2 + q_{{\rm e}2}^2 + q_{{\rm e}3}^2 = 1$

      设当前姿态角速度为$ {\boldsymbol{\omega }} $,目标角速度为${{\boldsymbol{\omega }}_{\rm f}}$,则定义误差角速度为

      $$ {{\boldsymbol{\omega }}_{\rm e}} = {\boldsymbol{\omega }} - {{\boldsymbol{\omega }}_{\rm f}} $$ (20)

      本文采用PID控制,控制律如下

      $$ {{\boldsymbol{T}}_{\boldsymbol{{\rm c}}}} = - {k_{\rm p}}{{\boldsymbol{q}}_{\boldsymbol{{\rm e}}}}{\rm sgn} \left( {{q_{{\rm e}0}}} \right) - {k_{\rm i}}\int {{{\boldsymbol{q}}_{\boldsymbol{{\rm e}}}}{\rm d}t} - {k_{\rm d}}{{\boldsymbol{\omega }}_{\boldsymbol{{\rm e}}}} $$ (21)

      其中:${k_{\rm p}}$${k_{\rm i}}$${k_{\rm d}}$分别为比例、积分和微分系数。

    • 探测器在与小天体表面碰撞过程中速度逐渐衰减,每次弹跳高度降低,其越障能力有所减弱。为保证探测器在一次起跳回合中具有足够的越障能力,提出表面移动单步弹跳策略,即每次起跳在切向方向只移动一步。该策略的实施具有两个前提:

      1)起跳后第一次与表面碰撞过程中将切向速度降为0;

      2)在碰撞过程中尽量减小外力矩干扰,以保证质心速度沿法向变化。

      对于前提1,切向速度由${v_{xy}}$减至0的耗时小于碰撞时间即可,也即碰撞时速度满足

      $$ \left| {\frac{{{v_{xy}}}}{{\mu {F_{\rm n}}}}} \right| \leqslant \left| {\frac{{v_z^ + - v_z^ - }}{{{F_{\rm n}} - mg}}} \right| $$ (22)

      其中:${v}_z^ + 、{v}_z^ -$分别表示碰撞前后的法向速度。

      对于前提2,以质心和顶点连线垂直于小天体表面的姿态进行碰撞,从而消除支持力对质心产生的力矩。图6显示了是否满足式(22)速度条件的探测器轨迹。满足速度条件时,探测器第一次与表面碰撞即将切向速度降为0,而后满足前提2的碰撞姿态在落点处弹跳,直至停止运动。

      图  6  探测器轨迹对比

      Figure 6.  Comparison of rover trajectories

      为验证该策略在不同场景下的适用性,针对小行星表面不同粗糙程度进行研究,在相同起跳力矩下探测器依然可以实现单步弹跳,如图7所示。此外,根据小天体尺寸将其分为百m级、km级、10 km级3类,其对应的引力加速度量级为${10^{ - 3}}\; {\text{m/}}{{\text{s}}^{\text{2}}}$${10^{ - 4}}\;{\text{m/}}{{\text{s}}^{\text{2}}}$${10^{ - 5}}\;{\text{m/}}{{\text{s}}^{\text{2}}}$,根据不同的引力大小相应改变起跳力矩,由图8结果可以证明在不同引力场的小天体上单步弹跳策略同样可以很好地实现。

      图  7  不同表面摩擦系数下探测器轨迹

      Figure 7.  Rover trajectories under different surface friction coefficients

      图  8  不同引力场下探测器轨迹

      Figure 8.  Rover trajectories under different gravitational fields

      图9图10显示了单步弹跳的探测器姿态角和控制力矩变化。由于碰撞时间很短,外力矩作用时间有限,探测器在短时间内即可调整至目标姿态。

      图  9  飞轮力矩变化

      Figure 9.  Variation of flywheel torque

      图  10  姿态角变化

      Figure 10.  Variation of attitude angle

    • 对于目前大多数使用路径规划的对象来说,其运动路径都是时刻连续可控的,能在任意时刻对其方向和速度进行改变,而且这些对象更多的是进行避障运动。跳跃探测器最大优势在于其能够直接越过部分表面障碍,本文在传统A*算法的基础上进行了改进,结合越障能力,以单步跳跃的最小和最大距离定义搜索步长范围(Smin, Smax),提出适用于跳跃探测器的变步长A*算法(S-A*),算法流程如下:

      1)创建OPEN表和CLOSED表,将起点A加入OPEN表;

      2)查看以A为中心、以(Smin,Smax)为半径的n个点,将其中可到达的点加入OPEN表,将这些点称为A的子点,同时将A从OPEN表移除,加入到CLOSED表中;

      3)从上一步加入OPEN表的点中选出评价函数值最小的点A1,评价函数为

      $$ F\left( n \right) = G\left( n \right) + H\left( n \right) $$ (23)

      其中:$ G\left( n \right) $表示从起点A移动到相应子点的代价;$ H\left( n \right) $表示从指定点移动到目标点B的预计代价。

      4)对A1进行第2步操作,将其能够到达的子点加入到OPEN表中,若子点已存在OPEN表中,则检查经由A1点到达该子点是否有更小的$ G\left( n \right) $值,若有则将该点设置为A1的子点,重新计算评价函数值,获得A1的最优子点A2;

      5)对A2进行相同操作,直到目标点B成为最优子点;

      6)从目标点B反向沿着各节点的父节点前进即可获得最终路径。

      图11展示了不同障碍密度条件下的算法效果。当障碍密度较小时,S-A*相较于A*进行了很多无效搜索,此时效率较低。障碍较多时,变步长策略降低了所需拓展节点数,明显提高了计算效率。若障碍密度过高,则传统方法可能出现无法找到路径的情况。结果表明S-A*算法更适用于小天体表面的复杂地形。

      图  11  不同障碍密度算法效率对比

      Figure 11.  Comparison of algorithm efficiency under different barrier density

      图12(a)展示了探测器运动路径及算法改进前后的探测器移动路径对比,利用探测器的越障能力,改进后路径更短。但同时S-A*计算效率受到地图栅格化精度(1 m划分的栅格数)的影响,精度提高,路径规划求解时间显著增加,如图12(b)所示,D为障碍密度。因此,该方法对于高精度、高实时性的任务需求具有一定的局限性。

      图  12  移动路径对比

      Figure 12.  Movement path comparison

    • 为获取制定小天体防御策略的基础数据,针对小天体表面巡视探测,以立方体构型的小天体表面弹跳探测器为对象,分析了起跳模式,结果表明以滑动模式起跳具有更好的移动性。在起跳后结合姿态控制提出了单步弹跳策略,保证在每个起跳回合探测器的越障性能最佳。针对探测器特点提出变步长A*算法,在生成越障路径的同时提高了小天体复杂表面下的算法效率,仿真结果说明了该方法的有效性。

参考文献 (25)

目录

    /

    返回文章
    返回