-
“嫦娥五号”表层采样装置为二连杆机械臂配置采样器的形式,机械臂具有肩部偏航、肩部俯仰、肘部俯仰和腕部俯仰4个自由度。为满足采样任务对视觉监视及测量的需求,采样器上安装了单目位姿测量相机(近摄像机),在臂杆B上安装了单目视觉监视相机(远摄像机)[5],表取采样机械臂状态如图1所示。
图 1“嫦娥五号”采样机械臂及表取采样过程示意图
Figure 1.The schematic diagram of the manipulator surface sampling for Chang’E-5
表层采样装置随探测器着陆月面后处于收拢压紧状态,采样前机械臂由收拢压紧状态运动至展开状态,做好采样前的准备工作,表层采样包括采样、放样、抓罐和放罐等步骤[7]。
1)采样。机械臂关节做回转运动,驱动采样器到达采样点实施样品采集。
2)放样。样品采集完成后,机械臂将获取的样品转移并倾泄至安装于着陆器顶面的一次密封容器中。
3)抓罐。经多次采样、放样过程后,控制机械臂到达指定位置,驱动采样器抓取一次密封容器,将一次密封容器提取出来,转移至二次密封容器上。
4)放罐。调整机械臂位置,驱动采样器将一次密封容器释放至二次密封容器内,表层采样工作结束。
地面实验结果表明,在采样深度0.02 m的情况下,不同密实度月壤单次采样量最大为150 g[5]。为确保在有限时间内达到工程采样量目标,表层采样程序设计单次采样与放样过程实施耗时约1.3 h,抓罐与放罐过程实施耗时约1.6 h。
-
根据表层采样装置状态和采样实施流程,采样工作模式图2所示。
1)环境感知。主要完成采样区地形分析并选择采样点。
2)采样规划。包括任务规划和机械臂运动规划,任务规划根据测控、能源、热控等约束条件规划采样过程中的平台、载荷、机械臂和采样器动作序列;机械臂运动规划完成机械臂避障运动策略的制定,包括路径中间点、运动轨迹、机械臂控制参数等。
3)规划验证。对任务规划和机械臂运动规划结果进行仿真或物理验证。
4)控制实施。各系统对现场生成的指令共同完成校核并会签后,实施上行发令控制,并通过遥测和图像等下行数据对控制效果进行监视与判读。
5)步骤1 ~ 4为一次完整的采样、放样过程,完成样品采集后,实施一次密封容器抓取、转移、释放至二次密封容器中。
由于机械臂柔性较大,其末端位置偏差受月球重力、落月姿态和机械臂构型影响,在毫米级控制精度的要求下,难以实现一次控制到位。需要在关键控制点处进行机械臂末端位置精调操作(如表1所示)。在图2所示的控制实施过程中,可能需要增加多次机械臂精调操作,而每次精调操作过程又是一次“感知–规划–验证–实施”的循环过程(如图3所示)。
表 1精调操作
Table 1.Fine-tuning operations
序号 精调名称 实施阶段 1 采样精调 机械臂末端运动至规划采样精调初始点后 2 放样精调 机械臂末端运动至规划放样精调初始点后 3 抓罐精调 机械臂末端运动至一次密封容器夹持精调初始点后 4 放罐精调 机械臂末端运动至一次密封容器释放精调初始点后 按照上述工作模式地面开展了多次月面表层采样试验,结果表明单次采样与放样过程平均耗时不少于2 h,远超表层采样程序设计状态。
因此,在月面工作有限的时间内实现目标样品量的采集,必须对工作模式进行优化设计,提升在轨采样实施效率。
-
“嫦娥五号”采样器属于大尺度月面采样器,月表地形复杂,存在凹坑、石块、倾斜面等多类地形,若采样点选择不当,采样过程中会发生采样器非采样部位与地形发生碰撞的风险,危及采样器的安全关乎任务的成败[10]。
表层采样前需要获取采样区域的地形数据,分析后选择合适的可采样点。“嫦娥五号”利用安装在着陆器外侧的双目立体监视相机获取表层采样区图像,并辅助实施采样监视[11]。获取表层采样区立体图像后,可进行采样区精细三维地形重构(图4),生成三维地形产品[月面数字高程图(Digital Elevation Map,DEM)和正射影像图 (Digital Orthophoto Map,DOM)][12]用于后续采样区分析与采样点选择。
采样区感知对表层采样实施意义重大,双目立体相机发生故障的情况下,可使用机械臂采样器上安装的近摄像机对采样区进行序列成像,并结合近摄像机成像位姿信息进行采样区三维地形重构[11]。为提高工作效率和确保机械臂运动安全,地面提前准备多个近摄像机对地面序列成像策略,在轨根据落月姿态和其它图像等数据选择一组成像策略,通过一次序列成像获取原双目立体相机的覆盖范围图像。
-
在图2的采样工作模式中,每次采样前都需要进行采样区感知,并根据感知结果确定下一个采样点。采样区感知、分析和采样点确定等工作均有不可忽略的时间消耗,考虑采样区域不变且每次铲挖月表后对地形影响不大,在着陆后且实施表层采样前增加采样点规划,即综合考虑科学探测需求、采样区地形特征、机械臂运动能力等信息,根据落月后的采样区感知信息一次性确定多个备选采样点及其使用排序。
进行采样点选择首先需要进行采样区分析,以采样区三维地形产品为输入(包括DEM和DOM),对采样区内各点的采样适宜程度进行量化评估,为采样点的选择提供支撑。已有工作对于地形的量化采样适宜度进行了研究[10,13],综合相关研究成果和任务特点,制定了量化评价指标体系(如表2所示)。
上述指标体系中,采样器采样角度需要综合坡度、坡向等指标计算;安全性综合采样装置与本体距离、采样装置与地面距离等指标计算。因此,将平坦性、采样器采样角度、可达性、安全性作为采样点选择及排序的依据,各量化指标按照图5方法进行综合分析。
表 2评价指标
Table 2.Evaluation inde
序号 指标名称 评价内容 1 坡度 反映了地形陡峭的程度 2 坡向 反映斜坡面对的方向 3 平坦性 局部地形的平坦程度 4 采样器采样角度 末端采样器采样时的姿态角,
采样器铲挖时尽量由下向上5 可达性 采样器是否可达 6 采样装置与本体距离 机械臂采样构型下,采样装置与探测器
本体的最近距离和干涉关系7 采样装置与地面距离 机械臂采样构型下,
采样装置与地面的最近距离和干涉关系8 安全性 采样装置在地面点处的采样构型是否安全 可达性取值范围为0(不可达)或1(可达);平坦性、采样器角度、安全性指标值域均归一化[0,1],取值越大表示优先级越高。可采样点必须可达,因此可达性对于采样点选取可“一票否决”。平坦性和采样器角度取值越高表示地形越有利于采集到更多的样品,也表征了单次采样的操作效率;安全性取值越高表示采样过程越安全,表征了采样的安全性。一般情况下采取操作效率和安全性并重原则设置权值,如权值α设为0.25、权值β设为0.25、γ设为0.5。具体实施时可根据现场情况调整权重参数,如采样区内所有采样点安全性取值都较低,可增加安全性权重。
采样实施过程中,可以在同一个采样点处实施多次采样,但如果实施多次(比如3次)采样均未采集到样品,则需按照采样点优先级排序,更换至下一个采样点实施采样。
-
采样任务规划是综合测控资源、月面环境、机械臂运动策略等多种约束,对表层采样合理规划,计算生成各类规划结果、控制序列及注入数据,从而实现对表层采样、载荷工作及探测器平台的有效操控。
遥操作任务规划一般将单一事件(如机械臂运动、相机开关机等)作为规划对象,多事件序列规划时需反复验证一致性(如采样过程中涉及机械臂、采样器、相机、平台等多类单一事件),规划过程复杂[12]。为提升规划实施的工作效率,需实现复杂任务场景的快速规划。
考虑表层采样过程中,采样、放样、抓罐和放罐等各阶段标称流程和部分应急处置流程较为明确,可融入专家先验知识将规划对象从单一事件转为作业明确定义的事件序列,即作业层规划。在作业层中可对所包含的事件序列统一配置,能够确保各事件之间的匹配性和完备性,较好地解决以往各事件的独立配置,但需反复验证一致性的问题。作业层通过作业选项实现作业各分支的选择,只需通过简单选择作业选项就可完成待规划的事件序列,再通过行为时态规划计算完成对该事件序列的合理安排,并利用事件内部的指令展开完成最终的指令序列生成,从而实现高效快速任务规划,基于作业模式的实时规划如图6所示。
基于作业模式的任务规划可以解决快速规划问题,但现场规划生成的结果还需各系统复核会签。为进一步提升在轨工作效率,任务前对各类作业模式进行细致分析,针对事件间逻辑关系相对确定且平台约束相对宽松的作业模式,采用降维规划模式,将部分规划约束和内容固定甚至忽略,生成可实施的控制数据,任务中根据现场的实际情况对控制数据微小调整。如不考虑测控网的使用情况,任务前生成并会签控制序列和注入数据,任务中根据实际测控网情况现场安排实施。基于作业模式的降维规划本质是一种预先规划方法,通过尽量固化识别出明确状态,减少规划过程和会签过程的耗时提升在轨工作效率(如图6中基于作业模式的降维规划所示)。基于作业模式的降维任务规划需要任务前优化设计作业模式:一是作业模式要有较强的任务适应性,能够尽量覆盖任务中各类场景,避免在任务中实时规划;二是作业模式中的事件粒度要合理设计,所有作业模式包含事件过少则现场需频繁实施更换计划操作、影响效率,事件过多则事先需准备大量的作业模式、且降低了对非预期工况的适应能力。因此,需按照正常与应急工况均覆盖、粗细粒度事件相结合的原则进行作业模式设计。
-
机械臂运动控制规划面向具体操作任务,规划得到起始点到目标点之间的无碰撞且满足任务要求的运动路径,并确定机械臂运动控制参数。
一般情况下机械臂运动规划首先建立机械臂规划的地图空间模型,该模型包括探测器本体、地形环境和其它环境因素;其次,采用避障规划算法在地图空间内搜索一条安全无碰撞运动路径。
“嫦娥五号”机械臂地图空间模型中除月表地形环境不能提前确定,其它因素均可在任务前明确。根据采样实施流程,除采样过程与地形环境紧密相关,其它放样、抓罐和放罐等机械臂大范围转移运动路径均可提前确定。为提升在轨工作效率,在考虑极度复杂地形的情况下,任务前可以设计机械臂运动的基准点,建立安全空间模型。基准点是机械臂运动路径中间点,每次采样、放样及抓罐、放罐等过程机械臂末端均需依次经过相应的基准点。各基准点之间均有提前设计好的路径互相到达。基准点根据其确定方法可分为3类,如表3所示。
表 3机械臂基准点类别
Table 3.Category of manipulator reference points
序号 类别 说明 1 位置固定的点 与地形无关且对末端到位精度没有较高要求的点,如采样、放样、一级密封容器转移过程的中间点,以及放样精调、抓罐精调、放罐精调的起始点等 2 基于采样区地形确定的点 与地形有关的点,比如采样精调起始点定义为采样点上方相对距离固定的点,当采样点确定后采样精调起始点随即确定 3 精调到位点 对末端到位精度有较高要求的点,需要精调到达,比如采样点、放样点、抓罐点、放罐点等 图7给出了标称工况下采样与放样过程中基准点设置情况,其中蓝色的点表示位置固定的点,红色的点表示基于采样区地形确定的点,绿色的点表示精调到位的点,各点之间的有向边表示可达关系。
当有机械臂临时运动规划需求时,可基于基准点建立的安全空间进行路径规划。可将机械臂由当前位置规划控制至距离最近的基准点,并根据基准点之间的可达路径完成规划控制工作。
Control Technology for Unmanned Sampling of Lunar Surface
-
摘要:针对“嫦娥五号”月面表层无人采样任务过程中机械臂精确控制难度大、器地协同工作复杂导致常规遥操作工作模式难以在有限时间内完成任务的问题,提出了月面表层无人采样高效控制方法和新的工作模式。通过建立采样区量化评价指标体系实现采样点规划、采用预先规划方法进行任务规划和机械臂运动控制规划、在线学习机械臂末端精调路径与多视角融合图像测量分析精调控制量、基于状态自动发令与实时管控工作进度等技术,实现了环境感知、任务规划与验证、机械臂末端精调规划、控制实施等环节提高工作效率。“嫦娥五号”月面表层采样任务在轨实施情况表明控制方法和新的工作模式能够极大提升采样工作效率,为未来火星和小行星采样工程项目奠定了基础。Abstract:Aiming at the difficulty of accurate controlling the robotic arm, and the complexity of probe - ground cooperation for the Chang’E-5 unmanned lunar surface sampling mission in a finite time period, a new control method and teleoperation mode which improves the efficiency of environmental perception, task planning and verification, fine-turning planning of manipulator end, and control implementation are proposed in this paper. Many technologies are applied into this method, such as establishing quantitative evaluation index system of sampling area to realize sampling points planning, using preplanning methods to complete mission planning and mechanical arm motion control planning, online learning to bring about the fine-tuning path in the manipulator end and analyzing fine-tuning using multi-view fusion images, automatic command based on state and controlling work progress real-time. The implementation results of Chang’E-5 lunar surface sampling mission in orbit indicate that new control method and teleoperation mode can greatly improve the sampling efficiency. It lays a foundation for the Mars and asteroid sample return mission in the future.Highlights
● An efficient control method and teleoperation mode for unmanned lunar surface sampling is proposed. ● A quantitative evaluation index system of sampling area and sampling point planning technique is established to improve the efficiency of environmental perception. ● Planning technology based on dimension reduction sampling mission is applied to the efficiency of task planning. ● The paper put forward a mechanic arm planning technology based on the safety space parts in order to improve the motion planning efficiency. ● The proposed fine-tuning and motion planning control of the long flexible manipulator realizes the millimeter-level precise control of the position of the manipulator. -
表 1精调操作
Table 1Fine-tuning operations
序号 精调名称 实施阶段 1 采样精调 机械臂末端运动至规划采样精调初始点后 2 放样精调 机械臂末端运动至规划放样精调初始点后 3 抓罐精调 机械臂末端运动至一次密封容器夹持精调初始点后 4 放罐精调 机械臂末端运动至一次密封容器释放精调初始点后 表 2评价指标
Table 2Evaluation inde
序号 指标名称 评价内容 1 坡度 反映了地形陡峭的程度 2 坡向 反映斜坡面对的方向 3 平坦性 局部地形的平坦程度 4 采样器采样角度 末端采样器采样时的姿态角,
采样器铲挖时尽量由下向上5 可达性 采样器是否可达 6 采样装置与本体距离 机械臂采样构型下,采样装置与探测器
本体的最近距离和干涉关系7 采样装置与地面距离 机械臂采样构型下,
采样装置与地面的最近距离和干涉关系8 安全性 采样装置在地面点处的采样构型是否安全 表 3机械臂基准点类别
Table 3Category of manipulator reference points
序号 类别 说明 1 位置固定的点 与地形无关且对末端到位精度没有较高要求的点,如采样、放样、一级密封容器转移过程的中间点,以及放样精调、抓罐精调、放罐精调的起始点等 2 基于采样区地形确定的点 与地形有关的点,比如采样精调起始点定义为采样点上方相对距离固定的点,当采样点确定后采样精调起始点随即确定 3 精调到位点 对末端到位精度有较高要求的点,需要精调到达,比如采样点、放样点、抓罐点、放罐点等 -
[1] 王琼,侯军,刘然,等. 我国首次月面采样返回任务综述[J]. 中国航天,2021(3):34-39.doi:10.3969/j.issn.1002-7742.2021.03.007WANG Q,HOU J,LIU R,et al. Summary of China’s first lunar surface sampling return mission[J]. Aerospace China,2021(3):34-39.doi:10.3969/j.issn.1002-7742.2021.03.007 [2] 彭兢,黄昊,向开恒,等. 月球无人采样返回人物概念设想[J]. 航天器工程,2010,19(5):99-104.doi:10.3969/j.issn.1673-8748.2010.05.017PENG J,HUANG H,XIANG K H,et al. Conception design of a lunar robotic sampling and return mission[J]. Spacecraft Engineering,2010,19(5):99-104.doi:10.3969/j.issn.1673-8748.2010.05.017 [3] 赵志晖,邓湘金,郑燕红,等. 地外天体采样任务的地面遥操作系统架构设想[J]. 航天器工程,2016,25(5):74-79.doi:10.3969/j.issn.1673-8748.2016.05.012ZHAO Z H,DENG X J,ZHENG Y H,et al. A thought of telemanipulation system structure for sampling mission on extraterrestrial celestial bodies[J]. Spacecraft Engineering,2016,25(5):74-79.doi:10.3969/j.issn.1673-8748.2016.05.012 [4] 吴伟仁,周建亮,王保丰,等. 嫦娥三号“玉兔号”巡视器遥操作中的关键技术[J]. 中国科学:信息科学,2014,44(4):425-440.doi:10.1360/N112013-00231WU W R,ZHOU J L,WANG B F,et al. Key technologies in the teleoperation of Chang’E-3 “Jade Rabbit” rover[J]. Scientia Sinica Informationis,2014,44(4):425-440.doi:10.1360/N112013-00231 [5] 马如奇,姜清水,刘宾,等. 月球采样机械臂系统设计及试验验证[J]. 宇航学报,2018,39(12):5-12.MA R Q,JIANG Q S,LIU B,et al. Design and verification of a lunar sampling manipulator system[J]. Journal of Astronautics,2018,39(12):5-12. [6] 唐玲,梁常春,王耀兵,等. 基于柔性补偿的行星表面采样机械臂控制策略研究[J]. 机械工程学报,2017,53(11):97-103.doi:10.3901/JME.2017.11.097TANG L,LIANG C C,WANG Y B,et al. Research on flexible compensation control strategy for planetary surface sampling manipulator[J]. Journal of Mechanical Engineering,2017,53(11):97-103.doi:10.3901/JME.2017.11.097 [7] 郑燕红,邓湘金,彭兢,等. 基于人工势场法的月球表层采样装置避障规划[J]. 中国空间科学技术,2015(6):66-74.ZHENG Y H,DENG X J,PENG J,et al. Lunar surface sampling device collision avoidance planning based on artifical potential filed method[J]. Chinese Space Science and Technology,2015(6):66-74. [8] 叶培建,孟林智,马继楠,等. 深空探测人工智能技术应用与发展建议[J]. 深空探测学报,2019,6(4):303-316.YE P J,MENG L Z,MA J N,et al. Suggestions on artifical intelligence technology application and development in deep space exploration[J]. Journal of Deep Space Exploration,2019,6(4):303-316. [9] 郑燕红,邓湘金,姚猛,等. 月球表层采样样品智能确认方法[J]. 宇航学报,2020,41(8):1094-1104.ZHENG Y H,DENG X J,YAO M,et al. An Intelligent approach for identification of lunar surface sampling soil[J]. Journal of Astronautics,2020,41(8):1094-1104. [10] 郑燕红,姚猛,金晟毅,等. 月面复杂地形表层采样可采点确定方法[J]. 中国空间科学技术,2019,39(2):41-48.ZHENG Y H,YAO M,JIN S Y,et al. Lunar surface sampling point selection for uneven terrain[J]. Chinese Space Science and Technology[J],2019,39(2):41-48. [11] 郑燕红,邓湘金,金晟毅,等. 嫦娥五号表去采样臂载相机成像位姿与覆盖研究[J]. 航空学报,2021,43(2):325-338.ZHENG Y H,DENG X J,JIN S Y,et al. Research on imaging posture and coverage of Chang’E-5 surface sampling manipulator cameras[J]. Acta Aeronautica et Astronautica Sinica,2021,43(2):325-338. [12] 周建亮, 吴风雷, 高薇. 月面遥操作技术[M]. 北京: 国防工业出版社, 2017: 22-60, 62-82. [13] WANG J, MA C L, ZHANG Z N, et al. Lunar surface sampling feasibility evaluation method for Chang’E-5 mission[C]//The International Archives of the Photogrammetry, Remote Sensing and Spatial Information Sciences. Enschede, Netherlands: [s. n.], 2019. [14] 姚猛,郑燕红,赵志辉,等. 一种月表采样器合理铲挖深度的研究[J]. 航天器工程,2017,26(3):50-56.doi:10.3969/j.issn.1673-8748.2017.03.008YAO M,ZHENG Y H,ZHAO Z H,et al. Research on reasonable excavation depth for lunar regolith sampler[J]. Spacecraft Engineering,2017,26(3):50-56.doi:10.3969/j.issn.1673-8748.2017.03.008 [15] 麻永平, 周建亮, 李剑. 绕月探测飞行控制[M]. 北京: 国防工业出版社, 2008. [16] 弗莱明, 科佩尔蒙. 挣值项目管理(第3版)[M]. 张斌, 陈洁, 译. 北京: 电子工业出版社, 2007.