中文核心期刊

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

中国高校优秀科技期刊

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

高级检索

留言板

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

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

火星车机构集成控制系统设计与实现

周东 徐晓伟 贾阳 郭坚 李珂 朱玛 张红军

周东, 徐晓伟, 贾阳, 郭坚, 李珂, 朱玛, 张红军. 火星车机构集成控制系统设计与实现[J]. 深空探测学报(中英文), 2020, 7(5): 450-457. doi: 10.15982/j.issn.2096-9287.2020.20200033
引用本文: 周东, 徐晓伟, 贾阳, 郭坚, 李珂, 朱玛, 张红军. 火星车机构集成控制系统设计与实现[J]. 深空探测学报(中英文), 2020, 7(5): 450-457. doi: 10.15982/j.issn.2096-9287.2020.20200033
ZHOU Dong, XU Xiaowei, JIA Yang, GUO Jian, LI Ke, ZHU Ma, ZHANG Hongjun. Design and Implementation of Integrated Control System for Mars Rover Mechanism[J]. Journal of Deep Space Exploration, 2020, 7(5): 450-457. doi: 10.15982/j.issn.2096-9287.2020.20200033
Citation: ZHOU Dong, XU Xiaowei, JIA Yang, GUO Jian, LI Ke, ZHU Ma, ZHANG Hongjun. Design and Implementation of Integrated Control System for Mars Rover Mechanism[J]. Journal of Deep Space Exploration, 2020, 7(5): 450-457. doi: 10.15982/j.issn.2096-9287.2020.20200033

火星车机构集成控制系统设计与实现

doi: 10.15982/j.issn.2096-9287.2020.20200033
基金项目: 国家中长期科技发展规划重大专项资助项目
详细信息
    作者简介:

    周东(1984– ),男,工程师,主要研究方向:航天器伺服机构控制系统设计。通讯地址:北京市海淀区友谊路104号(100094)电话:(010)68747018 E-mail:314484459@qq.com

    通讯作者:

    李珂(1982– ),男,高级工程师,主要研究方向:航天器电子信息系统设计、机构控制系统设计。本文通讯作者。通讯地址:北京市海淀区友谊路104号(100094)电话:(010)68747169 E-mail:like027@126.com

  • ● The strategy of hardware resource reuse and computing resource reuse is adopted to achieve the goal of integration. ● Autonomous management functions are realized for the motion planning,control operation,etc. ● The design requirements of fault-tolerant control are met through the functions of fault detection,emergency treatment and degraded control. ● The volume,weight and power consumption are reduced by 42%,36% and 35% respectively.
  • 中图分类号: TP241.2

Design and Implementation of Integrated Control System for Mars Rover Mechanism

  • 摘要: 航天器伺服机构一般采取分散控制的方法,通过地面遥操作进行控制和监视。为实现整车移动、悬架调整、通信天线指向、太阳翼对日定向、桅杆转动等多种功能,火星车配备了众多的电机和传感器。传统设计方式无法满足火星车集成化、自主化、容错控制的要求。制定了火星车机构集成控制系统的整体架构,并开展了优化设计。采用硬件资源复用、计算资源复用等策略实现了集成化设计目标;从运动规划、控制运算等多方面实现了自主管理功能;通过故障检测与应急处置、降级运行等功能满足了容错控制的设计需求。通过火星车机构控制系统的应用,在满足多项约束的前提下各项指标达到了最优,同时验证了设计方法的正确性和合理性。对功能复杂、约束严格的探测器机构控制系统具有一定的参考价值。
    Highlights
    ● The strategy of hardware resource reuse and computing resource reuse is adopted to achieve the goal of integration. ● Autonomous management functions are realized for the motion planning,control operation,etc. ● The design requirements of fault-tolerant control are met through the functions of fault detection,emergency treatment and degraded control. ● The volume,weight and power consumption are reduced by 42%,36% and 35% respectively.
  • 图  1  火星车伺服机构简图

    Fig.  1  Diagram of Mars rover mechanism

    图  2  机构控制系统优化前的组成框图

    Fig.  2  Block diagram of mechanism control system before optimization

    图  3  集成控制系统优化后的组成框图

    Fig.  3  Block diagram of integrated control system after optimization

    图  4  硬件架构设计

    Fig.  4  The design of hardware architecture

    图  5  旋变励磁电路复用设计

    Fig.  5  Multiplex design of resolver excitation circuit

    图  6  组件侧旋变解算电路复用设计

    Fig.  6  Multiplex design of resolver circuit for mechanism

    图  7  驱动电路复用设计

    Fig.  7  Multiplex design of driver circuit

    图  8  软件架构设计

    Fig.  8  The design of software architecture

    图  9  电机闭环控制算法

    Fig.  9  Motor control algorithm

    图  10  电机无传感器开环运行

    Fig.  10  Motor sensorless open loop control

    图  11  火星车机构控制系统自主任务试验

    Fig.  11  Autonomous function test of mechanism control system

    表  1  基于关联性分析的故障分组

    Table  1  Fault grouping based on correlation analysis

    分组故障元件
    CPU故障CPU、存储器、通信接口等
    FPGA故障FPGA、配置芯片、通信接口等
    电机故障驱动芯片、电机绕组、隔离继电器等
    旋变故障励磁电路、隔离继电器、旋变绕组多路开关、解算芯片等
    到位开关上拉电阻、防反二极管、开关等
    热控故障热敏电阻、加热开关、加热片等
    下载: 导出CSV

    表  2  故障模式与故障检测对应关系

    Table  2  Relevance between fault mode and fault detection

    检测方法CPU
    故障
    FPGA
    故障
    电机
    故障
    旋变
    故障
    到位
    开关
    热控
    故障
    指令超限
    温度超限
    速度超限
    角度超限注①
    角度差超限注②
    运动超时
    通信监视
    过流保护
      注:①角度超限包括旋变角度超限和步数换算角度超限;角度差超限:检查机构角度和步数换算角度差值是否超限。
    下载: 导出CSV

    表  3  降级运行策略

    Table  3  Strategy of fault tolerance control

    分组降级运行策略
    电机故障使用电机备绕组或禁用故障组件
    旋变故障组件侧旋变:按照步数换算角度运行电机侧旋变,
    无传感器开环运行
    到位开关禁用到位开关,按照组件角度运行
    热控故障禁用自主温控,温度预估
    下载: 导出CSV

    表  4  火星车机构控制系统集成设计优化效果

    Table  4  Optimization effect of rover mechanism control system

    指标优化前优化后指标要求
    体积/mm310.1×1065.8×106≤7 × 106
    质量/kg6.54.1≤4.5
    功耗/W20.311.6≤ 15
    下载: 导出CSV
  • [1] 王大轶,符方舟,孟林智,等. 深空探测器自主控制技术综述[J]. 深空探测学报(中英文),2019,6(4):317-327. doi:  10.15982/j.issn.2095-7777.2019.04.002

    WANG D Y,FU F Z,MENG L Z,et al. Research of autonomous control technology for deep space probes[J]. Journal of Deep Space Exploration,2019,6(4):317-327. doi:  10.15982/j.issn.2095-7777.2019.04.002
    [2] 王琼,贾阳,陶灼,等. 火星移动智能体技术探讨[J]. 航天器工程,2015,24(4):27-32. doi:  10.3969/j.issn.1673-8748.2015.04.005

    WANG Q,JIA Y,TAO Z,et al. Discuss on Mars mobile agent technologies[J]. Spacecraft Engineering,2015,24(4):27-32. doi:  10.3969/j.issn.1673-8748.2015.04.005
    [3] 李丽娇,石然,严丹,等. 一种适用于星载太阳翼的驱动控制器设计[J]. 空间控制技术与应用,2018,44(6):22-31. doi:  10.3969/j.issn.1674-1579.2018.06.004

    LI L J,SHI R,YAN D,et al. Design of a drive controller for satellite-borne solar wing[J]. Aerospace Control and Applicant,2018,44(6):22-31. doi:  10.3969/j.issn.1674-1579.2018.06.004
    [4] 宋斌,齐永龙. 一种卫星通信天线伺服机构设计[J]. 国外电子测量技术,2014,33(2):49-52. doi:  10.3969/j.issn.1002-8978.2014.02.014

    SONG B,QI Y L. Design of satellite communication servo mechanism[J]. Foreign Electronic Measurement Technology,2014,33(2):49-52. doi:  10.3969/j.issn.1002-8978.2014.02.014
    [5] 刘宏,蒋再男,刘业超. 空间机械臂技术发展综述[J]. 载人航天,2015,21(5):435-443. doi:  10.3969/j.issn.1674-5825.2015.05.002

    LIU H,JIANG Z N,LIU Y C. Review of space manipulator technology[J]. Manned Spaceflight,2015,21(5):435-443. doi:  10.3969/j.issn.1674-5825.2015.05.002
    [6] 张旺军,申振荣,李群智,等. 月球巡视器的系统设计优化方法研究[J]. 航天器工程,2014,23(3):4-11. doi:  10.3969/j.issn.1673-8748.2014.03.002

    ZHANG W J,SHEN Z R,LI Q Z,et al. Study on system design and optimization method of lunar rover[J]. Spacecraft Engineering,2014,23(3):4-11. doi:  10.3969/j.issn.1673-8748.2014.03.002
    [7] 贾阳,张建利,李群智,等. 嫦娥三号巡视器遥操作系统设计与实现[J]. 中国科学技术科学,2014,44(5):470-482.

    JIA Y,ZHANG J L,LI Q Z,et al. Design and realization for teleoperation system of the Chang’e-3 rover[J]. Science China Technological Sciences,2014,44(5):470-482.
    [8] 申振荣,张伍,贾阳,等. 嫦娥三号巡视器及其技术特点分析[J]. 航天器工程,2015,24(5):8-13. doi:  10.3969/j.issn.1673-8748.2015.05.002

    SHEN Z R,ZHANG W,JIA Y,et al. System design and technical characteristics analysis of Chang’e-3 lunar rover[J]. Spacecraft Engineering,2015,24(5):8-13. doi:  10.3969/j.issn.1673-8748.2015.05.002
    [9] 邹大力,杨雷,曲广吉. 主动悬架星球车移动系统姿态控制研究[J]. 空间控制技术与应用,2008,34(3):12-16. doi:  10.3969/j.issn.1674-1579.2008.03.003

    ZOU D L,YANG L,QU G J. Research on the attitude control of active suspension rover[J]. Aerospace Control and Application,2008,34(3):12-16. doi:  10.3969/j.issn.1674-1579.2008.03.003
    [10] 陶灼,陈百超. 火星车在松软地面上的蠕动步态研究[J]. 航天器环境工程,2016,33(3):262-268. doi:  10.3969/j.issn.1673-1379.2016.03.006

    TAO Z,CHEN B C. The inching locomotion of a martian rover on loose soil[J]. Spacecraft Environment Engineering,2016,33(3):262-268. doi:  10.3969/j.issn.1673-1379.2016.03.006
    [11] 彭松,陈百超,张建利. 月面巡视器定向天线对地指向规划方法研究[J]. 航天器工程,2013,22(3):41-46. doi:  10.3969/j.issn.1673-8748.2013.03.007

    PENG S,CHEN B C,ZHANG J L. Research on the method of lunar rover antenna direction planning[J]. Spacecraft Engineering,2013,22(3):41-46. doi:  10.3969/j.issn.1673-8748.2013.03.007
    [12] 赵葵银,寻大勇,唐勇奇. 基于AD2S80A的永磁同步电动机高精度位置检测系统[J]. 低压电器,2006,9:25-27.

    ZHAO K Y,XUN D Y,TANG Y Q. High accuracy position measuring system based on AD2S80A for permanent magnet synchronous motor[J]. Low Voltage Application,2006,9:25-27.
    [13] 郑力,卢刚,李声晋. 基于AD2S80A的双路RDC测角系统及接口设计[J]. 微特电机,2009(8):12-18.

    ZHENG L,LU G,LI S J. Design of double channel angle measuring system based on AD2S80A and its interface circuit[J]. Small & Special Electrical Machines,2009(8):12-18.
    [14] 徐建萍,施未勋. 一种基于MSK4300的无刷直流电机伺服控制系统设计[J]. 自动化应用,2013(4):50-55.

    XU J P,SHI W X. A brushless DC motor servo control system based on MSK4300[J]. Automation Application,2013(4):50-55.
    [15] 林芳,王煜,付毅宾,等. 基于FPGA的星载步进电机控制电路设计[J]. 中国空间科学技术,2017,37(3):77-84.

    LIN F,WANG Y,FU Y B,et al. Design of stepper motor control circuit for satellite based on FPGA[J]. Chinese Space Science and Technology,2017,37(3):77-84.
    [16] 郭闯强,倪风雷,孙敬颞,等. 空间机械臂关节容错控制系统研究[J]. 电机与控制学报,2011,15(2):76-83.

    GUO C Q,NI F L,SUN J T,et al. Design of the faulttolerant control system for space robotic joint[J]. Electric Machines and Control,2011,15(2):76-83.
    [17] 李清,吴昊,冯立墨,等. 三余度机电伺服机构及其故障隔离与重构技术[J]. 微电机,2014,47(12):40-44.

    LI Q,WU H,FENG L M,et al. Technology of reconstitution and fault isolation for trebleredundancy of mechanical and electrical servo mechanism[J]. Micro Motors,2014,47(12):40-44.
  • [1] 黎彪, 张从发, 盛聪, 樊俊峰, 刘冬.  “天问一号”火星次表层雷达展开机构设计 . 深空探测学报(中英文), 2021, 8(2): 1-6. doi: 10.15982/j.issn.2096-9287.2021.20200089
    [2] 潘冬, 李德伦, 袁宝峰, 贾阳, 王瑞, 张泽洲.  火星车系统动力学建模与仿真分析 . 深空探测学报(中英文), 2020, 7(5): 437-444. doi: 10.15982/j.issn.2096-9287.2020.20200032
    [3] 张宝明, 朱岩, 王连国, 杨建峰, 周斌, 徐卫明, 孙树全, 蔡治国, 徐欣锋, 杜庆国.  中国首次火星探测任务火星车有效载荷定标试验 . 深空探测学报(中英文), 2020, 7(5): 481-488. doi: 10.15982/j.issn.2096-9287.2020.20200043
    [4] 裴福俊, 严鸿, 朱明君.  太阳敏感器辅助的分布式EKF-SLAM火星车自主导航方法 . 深空探测学报(中英文), 2020, 7(2): 191-196. doi: 10.15982/j.issn.2095-7777.2020.20171117001
    [5] 徐勇, 贾阳, 郭坚, 赵蕾, 朱剑冰, 王翠莲, 范延芳, 佟玲.  火星车图像压缩存储系统与关键算法设计 . 深空探测学报(中英文), 2020, 7(5): 458-465. doi: 10.15982/j.issn.2096-9287.2020.20200035
    [6] 鄢青青, 刘卫, 满剑锋, 朱玛, 周东, 刘学.  火星车转移坡道机构展开策略分析与验证 . 深空探测学报(中英文), 2020, 7(5): 445-449. doi: 10.15982/j.issn.2096-9287.2020.20200041
    [7] 马传令, 刘勇, 梁伟光, 张尧.  “嫦娥4号”中继星应急轨道控制策略设计与分析 . 深空探测学报(中英文), 2019, 6(3): 269-276. doi: 10.15982/j.issn.2095-7777.2019.03.011
    [8] 孔令高, 张爱兵, 田峥, 郑香脂, 王文静, 刘勇, 丁建京.  自主火星探测高集成离子与中性粒子分析仪 . 深空探测学报(中英文), 2019, 6(2): 142-149. doi: 10.15982/j.issn.2095-7777.2019.02.005
    [9] 王大轶, 符方舟, 孟林智, 李文博, 李茂登, 徐超, 葛东明.  深空探测器自主控制技术综述 . 深空探测学报(中英文), 2019, 6(4): 317-327. doi: 10.15982/j.issn.2095-7777.2019.04.002
    [10] 黄翔宇, 徐超, 胡荣海, 李茂登, 郭敏文, 胡锦昌.  火星精确定点着陆多信息融合自主导航与控制方法研究 . 深空探测学报(中英文), 2019, 6(4): 348-357. doi: 10.15982/j.issn.2095-7777.2019.04.006
    [11] 张永隆, 刘华缨, 曾祥远.  双星系统L1点悬停探测控制器设计与仿真 . 深空探测学报(中英文), 2018, 5(3): 276-280. doi: 10.15982/j.issn.2095-7777.2018.3.010
    [12] 赵琳, 杜爱民, 乔东海, 孙树全, 张莹, 区家明, 郭志芳, 李智, 冯晓, 顾少燃, 李峰.  火星车磁通门磁强计技术 . 深空探测学报(中英文), 2018, 5(5): 472-477. doi: 10.15982/j.issn.2095-7777.2018.05.010
    [13] 彭德云, 邹雪梅, 李亮.  月球背面探测任务多目标协同控制模式设计 . 深空探测学报(中英文), 2018, 5(6): 544-553. doi: 10.15982/j.issn.2095-7777.2018.06.007
    [14] 欧阳威, 张洪波, 郑伟.  环火星自主导航系统设计及参数优化研究 . 深空探测学报(中英文), 2017, 4(1): 43-50. doi: 10.15982/j.issn.2095-7777.2017.01.007
    [15] 朱岩, 白云飞, 王连国, 沈卫华, 张宝明, 王蔚, 周盛雨, 杜庆国, 陈春红.  中国首次火星探测工程有效载荷总体设计 . 深空探测学报(中英文), 2017, 4(6): 510-514,534. doi: 10.15982/j.issn.2095-7777.2017.06.002
    [16] 于正湜, 崔平远.  行星着陆自主导航与制导控制研究现状与趋势 . 深空探测学报(中英文), 2016, 3(4): 345-355. doi: 10.15982/j.issn.2095-7777.2016.04.006
    [17] 魏祥泉, 黄建明, 顾冬晴, 陈凤.  火星车自主导航与路径规划技术研究 . 深空探测学报(中英文), 2016, 3(3): 275-281. doi: 10.15982/j.issn.2095-7777.2016.03.012
    [18] 彭松, 贾阳, 陈百超.  火星车绝对定位方法选择 . 深空探测学报(中英文), 2016, 3(2): 140-144. doi: 10.15982/j.issn.2095-7777.2016.02.007
    [19] 吴超, 赵振华, 杨俊, 李世华, 郭雷.  基于约束预测控制的火星大气进入轨迹跟踪 . 深空探测学报(中英文), 2014, 1(2): 128-133.
    [20] 董元元, 崔祜涛, 田阳.  基于栅格地图的火星车路径规划方法 . 深空探测学报(中英文), 2014, 1(4): 289-293. doi: 10.15982/j.issn.2095-7777.2014.04.007
  • 加载中
图(11) / 表 (4)
计量
  • 文章访问数:  361
  • HTML全文浏览量:  69
  • PDF下载量:  63
  • 被引次数: 0
出版历程
  • 收稿日期:  2020-06-15
  • 修回日期:  2020-08-02
  • 网络出版日期:  2021-01-18
  • 刊出日期:  2020-10-31

火星车机构集成控制系统设计与实现

doi: 10.15982/j.issn.2096-9287.2020.20200033
    基金项目:  国家中长期科技发展规划重大专项资助项目
    作者简介:

    周东(1984– ),男,工程师,主要研究方向:航天器伺服机构控制系统设计。通讯地址:北京市海淀区友谊路104号(100094)电话:(010)68747018 E-mail:314484459@qq.com

    通讯作者: 李珂(1982– ),男,高级工程师,主要研究方向:航天器电子信息系统设计、机构控制系统设计。本文通讯作者。通讯地址:北京市海淀区友谊路104号(100094)电话:(010)68747169 E-mail:like027@126.com
  • ● The strategy of hardware resource reuse and computing resource reuse is adopted to achieve the goal of integration. ● Autonomous management functions are realized for the motion planning,control operation,etc. ● The design requirements of fault-tolerant control are met through the functions of fault detection,emergency treatment and degraded control. ● The volume,weight and power consumption are reduced by 42%,36% and 35% respectively.
  • 中图分类号: TP241.2

摘要: 航天器伺服机构一般采取分散控制的方法,通过地面遥操作进行控制和监视。为实现整车移动、悬架调整、通信天线指向、太阳翼对日定向、桅杆转动等多种功能,火星车配备了众多的电机和传感器。传统设计方式无法满足火星车集成化、自主化、容错控制的要求。制定了火星车机构集成控制系统的整体架构,并开展了优化设计。采用硬件资源复用、计算资源复用等策略实现了集成化设计目标;从运动规划、控制运算等多方面实现了自主管理功能;通过故障检测与应急处置、降级运行等功能满足了容错控制的设计需求。通过火星车机构控制系统的应用,在满足多项约束的前提下各项指标达到了最优,同时验证了设计方法的正确性和合理性。对功能复杂、约束严格的探测器机构控制系统具有一定的参考价值。

注释:
1)  ● The strategy of hardware resource reuse and computing resource reuse is adopted to achieve the goal of integration. ● Autonomous management functions are realized for the motion planning,control operation,etc. ● The design requirements of fault-tolerant control are met through the functions of fault detection,emergency treatment and degraded control. ● The volume,weight and power consumption are reduced by 42%,36% and 35% respectively.

English Abstract

周东, 徐晓伟, 贾阳, 郭坚, 李珂, 朱玛, 张红军. 火星车机构集成控制系统设计与实现[J]. 深空探测学报(中英文), 2020, 7(5): 450-457. doi: 10.15982/j.issn.2096-9287.2020.20200033
引用本文: 周东, 徐晓伟, 贾阳, 郭坚, 李珂, 朱玛, 张红军. 火星车机构集成控制系统设计与实现[J]. 深空探测学报(中英文), 2020, 7(5): 450-457. doi: 10.15982/j.issn.2096-9287.2020.20200033
ZHOU Dong, XU Xiaowei, JIA Yang, GUO Jian, LI Ke, ZHU Ma, ZHANG Hongjun. Design and Implementation of Integrated Control System for Mars Rover Mechanism[J]. Journal of Deep Space Exploration, 2020, 7(5): 450-457. doi: 10.15982/j.issn.2096-9287.2020.20200033
Citation: ZHOU Dong, XU Xiaowei, JIA Yang, GUO Jian, LI Ke, ZHU Ma, ZHANG Hongjun. Design and Implementation of Integrated Control System for Mars Rover Mechanism[J]. Journal of Deep Space Exploration, 2020, 7(5): 450-457. doi: 10.15982/j.issn.2096-9287.2020.20200033
    • 火星车作为典型的深空探测器,其机构控制系统需要具有集成化、自主管理、容错控制等特性。火星车配备多种伺服机构,实现整车移动、悬架调整、通信天线指向、太阳翼对日定向、桅杆转动等功能[1-2],机构控制系统所需完成的功能均包括运动规划、电机驱动控制、传感器解算、故障检测及应急处置等功能。其中移动装置包括驱动机构、转向机构、悬架调整机构等,采用直流无刷电机;天线、太阳翼、桅杆机构采用步进电机。角度传感器均采用旋转变压器。

      在以往航天器机构控制系统中,机构组件数量较小,机构控制器分别设置在多个相关分系统中。每个控制器中均设置电源变换、规划运算、控制运算、驱动电路、传感器采集等部件[3-5]。按照传统方式设计火星车机构控制系统,存在较多冗余资源,无法满足火星车集成化、轻量化的设计要求[6]

      另外,在近地航天器或月球车中,通信延时不长,如地月单程通信时延仅为1 s左右。机构控制系统的任务规划、状态监控、故障检测及应急处置主要通过地面遥操作实现[7-8]。而在火星探测任务中,最远地火距离时单程通信时延长达几十min。火星车需要在无人干预情况下完成自主任务规划、自主故障检测及处置、降级运行等功能。这些都对火星车的自主特性提出了更高的要求[1]

      与以往研究相比,本研究针对火星车多样的控制需求,开展了任务分析,制定了机构控制系统的整体架构,从集成化、自主管理、故障检测与降级运行等方面开展了优化设计。创新性地将火星车上所有机构的控制功能集中在一台控制器上实现。采用多种资源复用方法达到了显著的集成化、轻量化效果。同时提出并实现了运动规划、控制运算、故障检测及应急处置、降级运行等策略,满足了火星车机构控制系统高度自主、容错控制的任务需求。

    • 火星车配备多种伺服机构,在巡视区域内开展探测活动,并将探测数据传回。如图1所示,火星车配备了移动装置、定向天线、太阳翼、桅杆4类机构,实现的具体功能包括:整车移动、悬架调整、通信天线指向、太阳翼指向、桅杆转动等。

      图  1  火星车伺服机构简图

      Figure 1.  Diagram of Mars rover mechanism

      1)移动装置。实现火星车在着陆平台和火星表面的姿态调整、移动、脱离危险状况等功能。采用主副摇臂式主动悬架和一体化减振车轮及六轮独立驱动、独立转向的方式。标称运动模式完成直线行走、转向行走、蟹行等功能。主动悬架模式完成车体升降、车轮升降、蠕动等功能。移动装置配备驱动、转向、夹角、离合、差动等5类伺服机构组件[9-11]

      2)定向天线。实现火星车X频段通信的二维指向调节功能。可实现对地低速应急数据传输、对环绕器中速数据传输。当环绕器位于近火弧段时,由于其方位角和高度角快速变化,要求定向天线具备连续位置或速度跟踪能力。定向天线配备展开机构、双轴驱动机构组件。由于遥远的地火距离,火星车采用了高增益、窄波束的定向天线[10],要求转轴执行偏差不超过0.4°。

      3)太阳翼。火星车配备了A、B两组太阳翼,其中A组太阳翼配备了两套驱动轴,用于A组太阳翼的重复收展。B组太阳翼使用铰链驱动展开、配备两组到位开关用于监视状态。

      4)桅杆。在感知和探测等模式中为导航地形相机提供支撑、运动、指向定位等功能。桅杆机构配备了展开轴、偏航轴、俯仰轴3种组件。

    • 考虑到各类机构的功能特点和产品继承性,定向天线、太阳翼、桅杆机构选用步进电机,各组件由步进电机、谐波减速器、角度传感器及到位开关组成。移动装置选用直流无刷电机,各组件由直流无刷电机、电机角度传感器、谐波减速器、组件角度传感器及到位开关组成。控制系统需要完成的功能如下:

      1)状态采集。机构控制系统的控制目标为运动速度或角度,因此需要采集运动相关状态,比如电流、速度、角度、到位情况。其中电机速度可通过电机转子角度做微分运算获得。

      2)电机驱动。天线、太阳翼、桅杆所选用的步进电机采用两相双四拍、恒流斩波驱动方式,移动装置所选用的直流无刷电机需要实现速度闭环控制,转向机构、夹角机构还需要实现角度闭环控制。

      3)零位和极性处理。各类机构安装过程中,角度传感器与火星车坐标系的零位和极性很难达到一致,需要进行零位修正和极性修正。同时电机旋转极性一般定义为面向电机逆时针转动为正转,而机构组件安装到火星车上后,可能与整车旋转坐标系的极性不一致,同样需要对电机旋转极性进行转换。

      4)运动范围变换。各机构组件运动角度范围差异性较大,大部分组件的运动角度均不超过$ \pm $180°。太阳翼机构组件采用了非标准角度范围,需要对角度范围进行扩展。另外,为保证定向天线的指向精度,角度传感器使用了两对级旋转变压器,运动角度更是超过了两对级旋转变压器能表达的范围$ \pm 9 $0°,需要软件辅助进行二义性转换,实现角度范围的扩展。

      5)运动规划。在底层控制完成速度或位置控制后,上层需要完成运动规划相关功能,包括:直线行走、转向行走、悬架调整、天线跟踪、太阳翼指向、桅杆转动等功能。

      6)故障检测与紧急处置。为保证系统安全性,应在机构运动过程中实时监测运动范围、工作电流、通信状态、工作温度等状态。故障发生时,及时将机构置于安全状态。所设计的故障检测方法和处置策略应覆盖机构控制系统各部件的故障模式。

      7)降级运行。火星车在发射、奔火、EDL和火面探测各阶段均要承受恶劣环境的影响,机构控制系统中各组件均存在失效的可能。在局部失效的情况下,机构控制系统应能够基于剩余正常部件实现降级运行,实现一定的容错控制能力。

      8)通用化要求。为达到系统优化的目的,通过分析各机构性能要求及工作模式,在保证机构伺服驱动功能的前提下进行通用化设计。所有步进电机组件选用相同的细分驱动模式、步距角和旋转变压器励磁频率,移动装置的机构组件采取相同的控制算法、驱动电路和旋转变压器励磁频率。在通用化的基础上,制定硬件资源、计算资源的分时复用策略,提高资源利用率。

    • 图2所示,在以往航天器中,每类机构组件均需要配置相应的控制器。每个控制器中均设置电源变换、控制运算、驱动电路、传感器采集等部件。传统的设计方式存在较多冗余资源,无法满足火星车集成轻量化的要求。同时一般通过遥操作的方式发送运动指令并进行状态监视[8],无法满足火星车机构控制系统的自主化、容错控制的需求。因此需要在集成化、自主管理、故障检测与降级运行等各方面进行系统优化。

      图  2  机构控制系统优化前的组成框图

      Figure 2.  Block diagram of mechanism control system before optimization

      图3为经过优化后火星车机构集成控制系统组成框图,主要由控制器、驱动器、采集电路、复用电路等部件组成,数管计算机为控制系统提供二次电源,并提供部分计算资源。

      图  3  集成控制系统优化后的组成框图

      Figure 3.  Block diagram of integrated control system after optimization

      所采取的主要优化措施如下:

      1)供电资源优化。机构控制系统放置到数管计算机的机箱中,与数管计算机共用二次电源,可减少DC/DC变换器、滤波器的使用量,同时能在一定程度上减少电源变换损耗。

      2)计算资源优化。梳理集成控制系统各项功能中实时性要求。将高实时性功能、时序控制功能放置到电机控制器中实现,如角度传感器采集、AD采集、电机闭环控制等功能。实时性要求较低的功能,通过数管软件完成,实现计算资源的共享,比如:零位和极性处理、自主运动规划、故障检测等。

      3)热控功能优化。机构温度统一由数管计算机通用资源进行采集,并在数管计算机中实现自主热控,实现各类机构温度调节。

      4)电机侧旋变解算复用。移动装置电机侧角度传感器全部采用旋转变压器,数量较多,对硬件资源消耗较大。根据飞行程序梳理各类机构工作时段,采取继电器分时段接通的策略。如通过飞行程序中可知,移动装置的转向机构和夹角机构不同时动作。在标称移动模式接入转向机构旋变,在悬架调整模式接入夹角机构旋变,减少旋变解算芯片数量。

      5)电机驱动器复用。方法4同样适用于电机驱动器。各时段需要同时工作的组件数量的最大值,即为需要设置的电机驱动器数量,如天线、太阳翼、桅杆不同时工作。控制系统中仅设置3套驱动器,分时切换,可以完成8套机构组件的驱动功能。

      6)组件侧旋变解算复用。机构组件输出端的旋变,角度变化率较小,可采用多路开关分时接通的策略,通过同一个旋变解算芯片同时实现多路旋变的解算。如转向机构组件输出端的6路旋变信号,通过多路开关分时接入旋变解算芯片,一套解算芯片实现6路旋变的角度解算。

      7)系统备份。移动装置6套车轮具有系统备份功能。单一车轮失效后,可将故障轮抬起,其他车轮组合仍能够完整实现火星车移动的功能。因此对车轮上的驱动、转向组件仅设置单份的电机驱动器。

      8)故障检测及应急处置。梳理各部件的故障模式,制定相应的故障检测与应急处置策略。将其中实时性要求较高的部分通过电机控制器实现,实时性要求较低的部分通过数管计算机软件兼顾。故障触发后,将机构置于安全状态,等待进一步地面分析。

      9)降级运行。当发生不可恢复的故障后,支持降级容错运行。除了采取常规的主备份策略外,还需要设计旋转变压器、到位开关、绕组故障后的容错运行策略。

    • 根据集成化、通用化的设计原则,开展机构控制系统硬件设计。图4为集成控制系统硬件架构,主要由遥测采集、驱动电路、数管CPU、控制FPGA组成。

      1)计算资源优化

      机构控制系统中的计算资源通过“CPU+FPGA”的方式实现。宇航CPU中一般具有浮点运算、EDAC校验功能,通过C语言编程实现,适合于浮点运算及复杂流程控制。但由于抗辐照工艺的限制,宇航CPU工作频率远低于商业CPU,一般不高于100 MHz,软件中每条代码的执行均要经过取指、译码、执行、存储等过程。火星车要同时完成多达十几路电机的控制,因此宇航CPU并不太适合于这种高实时的并行运算。而FPGA具有大规模可编程通用逻辑资源,所有逻辑单元均可同时执行,更适合于实现并行计算、定点运算、时序控制等功能。

      图  4  硬件架构设计

      Figure 4.  The design of hardware architecture

      所以将实时性要求较低的功能通过数管计算机CPU完成,实现计算资源的共享,比如:零位和极性处理、自主运动规划、故障检测等;将高实时性控制算法、并行运算、时序控制等功能通过FPGA实施,实现火星车全部电机的独立运动控制。

      2)旋变励磁电路复用

      旋转变压器解算功能由励磁电路、解算电路组成。励磁电路产生正弦波,作为旋转变压器的激励信号,同时励磁信号传递到解算电路,作为解算电路II型跟踪伺服环路的参考信号[12-13]

      励磁电路尺寸较大,传统方法中需要在主备控制器中为每只旋变各配置一套励磁电路。本系统中采用旋变集中励磁的方法,励磁信号经功率放大后,同时驱动多路旋转变压器的励磁绕组。旋变励磁电路复用方法如图5所示。采用复用方法后,主备控制器励磁电路所占面积、重量和功耗显著减少。由于公共点的存在,任意旋变励磁绕组异常时,可能发生故障扩散,导致该励磁电路所连接的全部旋变失效。因此需要在保证信号质量的前提下,采取限流措施。保证在单个旋变故障情况下,其它旋变能够正常工作。

      图  5  旋变励磁电路复用设计

      Figure 5.  Multiplex design of resolver excitation circuit

      3)旋变解算芯片复用

      宇航用旋变解算芯片封装尺寸较大。传统方法中需要在主备控制器中为每只旋变各配置一只解算芯片,将占用可观的尺寸、重量、功耗。复用方法主要分为组件侧旋变解算复用和电机侧旋变解算复用。

      组件侧旋变采用多路开关进行分时采集,通过一片解算芯片完成多路旋变信号的解算功能。FPGA中设置定时器,将各路旋变按顺序循环接入到旋变解算芯片中。多路开关通道切换间隔时间$ t $的下限取决于解算芯片最大角度差情况下的跟踪响应时间,上限取决于机构角度变化率和采集精度。

      为防止外部线路故障对电路的影响,在信号输入端采取限流措施,并通过运算放大器将信号增强后送入旋变解算芯片。组件侧旋变解算电路复用设计如图6所示。

      图  6  组件侧旋变解算电路复用设计

      Figure 6.  Multiplex design of resolver circuit for mechanism

      由于跟踪速率的差异,多路开关选通的方式并不适用于电机侧旋变。电机侧旋变主要采取继电器选通的方式。根据不同的运动模式,通过继电器分阶段接通特定分组的电机侧旋变,电机运动期间继电器保持接通状态,从而实现一组旋变解算芯片服务多组旋变的功能。

      采用上述2种旋变解算芯片复用方法后,主备控制器旋变解算芯片数量显著减少。

      4)驱动电路复用

      直流无刷电机的驱动电路采用三相六桥式驱动芯片实现[14],步进电机的驱动电路采用H桥式驱动芯片实现[15]。根据不同的运动模式,通过继电器分阶段接入特定分组的电机绕组,电机运动期间继电器保持接通状态,从而实现一组驱动芯片服务多组电机的功能。如:设置3套步进电机驱动芯片,可以分阶段完成天线、太阳翼、桅杆的8套组件的驱动。如图7所示,为保证系统安全性,为驱动芯片的数字电源、功率电源均设置保护措施。如果驱动芯片自身故障或外部线路故障造成短路,驱动芯片电源信号将自动保护,其它驱动芯片仍可以正常工作。

      图  7  驱动电路复用设计

      Figure 7.  Multiplex design of driver circuit

      5)其它

      利用数管计算机实现温度采集、加热功率输出和自主温控算法。机构工作温度通过热敏电阻采集,加热功能采用加热片实现。

      到位开关为无源金属触点式。为避免外界异常造成电路损伤,采集电路中设置防反二极管、限流电阻、滤波电容进行保护。

    • 根据集成化、自主化的设计原则,开展机构控制系统的软件设计。软件整体架构如图8所示。

      图  8  软件架构设计

      Figure 8.  The design of software architecture

      将控制系统软件按照功能特点划分为4层:运动规划层主要根据飞行程序或地面指令完成各类机构的运动规划和协同动作;中间变换层主要实现范围变换、极性处理、零位处理、换算角度等运算功能,还包括整车坐标系浮点角度与控制系统定点运算之间的转换功能;控制运算层主要完成机构组件的角度闭环控制、速度闭环控制,同时还需完成速度运算、电机步数累计等功能;采样与驱动层主要完成涉及底层时序的传感器信息采集、电机驱动PWM斩波信号生成等功能。

      运动规划层、中间变换层主要涉及复杂流程控制和浮点运算;控制运算层、采样驱动层主要涉及强实时计算和时序波形生成。因此根据前述宇航用CPU和FPGA的各自优势,运动规划层和中间变换层的功能统一由数管计算机实现,控制运算层和采取驱动层的功能统一由FPGA实现。

      1)运动规划层

      运动规划层根据各类机构动力学特性、指向目标特性,进行加减速控制、指向跟踪、多机构协同控制。其中车体移动功能包括直行、转向、行进间转向、蟹行等功能,悬架调整功能包括车体抬升、车体下降、抬轮、离合啮开、离合啮合等功能。天线跟踪主要包括自主展开、对地指向、对轨道器指向,跟踪模式包括角速度跟踪、角位置跟踪。桅杆转向主要包括:自主展开、偏航指向、俯仰指向等功能。

      2)中间变换层

      中间变换层主要实现范围变换、极性处理、零位处理、换算角度运算等功能。零位处理主要修正角度传感器安装误差。极性处理分为角度传感器极性、电机驱动极性。角度范围主要实现非标准角度范围的扩展,以及通信天线角度二义性处理。换算角度运算是通过电机步数换算得到机构角度。

      3)控制运算层

      控制运算层主要分为步进电机控制算法和直流无刷电机控制算法。步进电机的控制算法采取开环控制、角度到位停机的策略。

      直流无刷电机采取双闭环嵌套控制算法,如图9所示。位置环的给定值为期望角度。传感器所采集的机构角度作为位置闭环的反馈信号。位置环主要包括死区控制、比例超限控制等控制环节。速度环的给定值来自于指令或位置环的补偿值,电机角度经过差分运算得到实际速度,作为速度变换的反馈信号,电机角度还用于PWM斩波换相控制。速度环还包括比例积分控制器、驱动放大环节。

      图  9  电机闭环控制算法

      Figure 9.  Motor control algorithm

      4)采样和驱动层

      采样和驱动层完成的功能包括:根据旋变解算芯片接口要求,生成解算芯片采集时序,获取电机侧旋变角度、机构侧旋变角度;根据模数转换器AD芯片时序要求,生成采集启动信号、通道选择信号,并接收转换结果,主要用于电机工作电流的采集;根据直流无刷电机绕组驱动时序要求生成PWM斩波信号,控制驱动芯片内功率开关的开通、关断和死区控制。

    • 故障检测与诊断是实现火星车安全运行、故障容错的基础。必须适时准确地检测出故障信息,并采取应急处理措施,将机构系统置于安全状态。在发生局部故障的情况下,将故障区域隔离,实现容错运行[16-17]

    • 机构控制系统由运动规划、运算控制、传感器、驱动电路、伺服机构等部件组成,各部件均由众多元器件组成,每个元器件具有自身的失效模式。对每个元器件进行故障检测的代价过高。根据各类元器件耦合程度进行功能分组,对各分组进行故障检测设计。机构控制系统具体分组情况如表1所示。

      表 1  基于关联性分析的故障分组

      Table 1.  Fault grouping based on correlation analysis

      分组故障元件
      CPU故障CPU、存储器、通信接口等
      FPGA故障FPGA、配置芯片、通信接口等
      电机故障驱动芯片、电机绕组、隔离继电器等
      旋变故障励磁电路、隔离继电器、旋变绕组多路开关、解算芯片等
      到位开关上拉电阻、防反二极管、开关等
      热控故障热敏电阻、加热开关、加热片等

      在硬件电路中设置限流或过流保护电路,将故障限定在局部区域;在软件中设置故障检测功能,故障发生后,及时将伺服机构置于零速或停机等安全状态。机构控制系统中制定多种故障检测方法,与分组故障模式的对应关系如表2所示。

      表 2  故障模式与故障检测对应关系

      Table 2.  Relevance between fault mode and fault detection

      检测方法CPU
      故障
      FPGA
      故障
      电机
      故障
      旋变
      故障
      到位
      开关
      热控
      故障
      指令超限
      温度超限
      速度超限
      角度超限注①
      角度差超限注②
      运动超时
      通信监视
      过流保护
        注:①角度超限包括旋变角度超限和步数换算角度超限;角度差超限:检查机构角度和步数换算角度差值是否超限。
    • 当发生不可恢复的故障后,将局部故障隔离,并实施降级容错运行,除了采取常规的主备份策略外,还制定了旋转变压器、到位开关、电机、热控故障后的容错运行策略。表3为火星车机构控制系统采取主要降级运行策略。

      表 3  降级运行策略

      Table 3.  Strategy of fault tolerance control

      分组降级运行策略
      电机故障使用电机备绕组或禁用故障组件
      旋变故障组件侧旋变:按照步数换算角度运行电机侧旋变,
      无传感器开环运行
      到位开关禁用到位开关,按照组件角度运行
      热控故障禁用自主温控,温度预估

      其中组件侧旋变故障情况下,CPU运动规划的输出值为电机步数,FPGA根据期望步数执行位置环保持功能。步数累计值传递到CPU,进行步数换算角度的运算。

      电机侧旋变故障情况下的,降级运行策略为:不使用故障旋变的反馈角度$ {\theta }_{\rm m} $,将给定速度$ {V}_{{\rm{cmd}}} $进行积分,获得电机转子旋转的理论角度$ {\theta }_{{\rm{calc}}} $,用于速度计算和PWM斩波换相。电机无传感器开环运行原理框图如图10所示。

      图  10  电机无传感器开环运行

      Figure 10.  Motor sensorless open loop control

    • 根据集成化、通用化的思路,从硬件资源、计算资源两方面制定了多项优化措施,经过工程实施,火星车机构控制系统的体积、重量和功耗分别降低了42%、36%、35%,关键指标均优于整车指标要求。主要关键指标的优化效果见表4

      表 4  火星车机构控制系统集成设计优化效果

      Table 4.  Optimization effect of rover mechanism control system

      指标优化前优化后指标要求
      体积/mm310.1×1065.8×106≤7 × 106
      质量/kg6.54.1≤4.5
      功耗/W20.311.6≤ 15

      为验证机构控制系统的可行性和有效性,开展了火星车内场试验、外场试验及高低温循环试验,对行进功能、转向功能、悬架调整功能、天线跟踪功能、太阳翼收展功能、桅杆指向等自主任务进行了验证试验。各阶段试验验证中机构控制系统均满足设计要求。图11为火星车机构控制系统自主任务试验场景。

      图  11  火星车机构控制系统自主任务试验

      Figure 11.  Autonomous function test of mechanism control system

      同时,针对故障检测与降级运行制定了相应的验证策略,模拟故障所需的触发条件,在整车环境中完成了全部故障模式和降级运行模式的验证。

    • 火星车作为典型的深空探测器,机构控制系统需要具有集成轻量化、自主管理、容错控制等特性。火星车配备多种伺服机构,实现整车移动、悬架调整、通信天线指向、太阳翼对日定向、桅杆转动等功能,机构控制系统需要完成运动规划、驱动控制、传感器解算、故障检测及应急处置等功能。传统设计方式中,各类机构分散控制,通过地面遥操作进行控制和监视,无法满足火星车集成化、自主化、容错控制的需求。

      本文针对火星车多样的控制需求,开展了任务分析,制定了机构控制系统的整体架构,从集成化、自主管理、故障检测与降级运行等方面开展了优化设计。将火星车上所有的机构控制功能集中在一台控制器上实现。采用多种资源复用方法达到了显著的集成化、轻量化效果。同时提出并实现了运动规划、控制运算、故障检测及应急处置、降级运行等策略,满足了火星车机构控制系统高度自主、容错控制的任务需求。在满足多项约束的前提下,各项指标达到了最优,验证了设计方法的正确性和合理性。对功能复杂、约束严格的探测器机构控制系统具有一定的参考价值。

参考文献 (17)

目录

    /

    返回文章
    返回