一种主动悬架式星球车抬轮行走控制方法及系统技术方案

一种主动悬架式星球车抬轮行走控制方法及系统，首先，需要控制夹角调整机构运动，对星球车系统质心位置进行合理调整，以保证星球车能抬起目标车轮并且抬轮后整车稳定；其次，通过离合器机构将星球车主副摇臂锁死，使主副摇臂间无法相对转动；再次，控制夹角调整机构运动，实现目标车轮抬升，而夹角调整机构的相对运动角度由车轮抬升高度决定；最后，控制星球车其余未抬起车轮驱动机构运动，则可实现星球车抬轮后的行走。

A control method and system for raising wheels of active suspension planetary vehicle

【技术实现步骤摘要】
一种主动悬架式星球车抬轮行走控制方法及系统
本专利技术涉及一种主动悬架式星球车抬轮行走控制方法及系统，属于移动机器人
，用于星球车在轨车轮沉陷或故障情况下进行抬轮行走的控制。
技术介绍
能自主移动且搭载有效载荷的星球车是实现火星巡视探测的主要手段，火星表面存在风和尘暴，表面地形转换很快，部分沙地表面有一层硬的砂石壳，内部是软沙土，易造成星球车车轮无征兆的大量沉陷。美国的机遇号和勇气号星球车均由于发生沉陷无法脱离而导致任务失败，沉陷和脱困一直是困扰星球车的技术难点。传统的星球车均采用被动悬架式移动系统，星球车不具备构型调整和抬轮脱陷能力，中国正在开展火星探测任务研制，星球车将采用全新的主动悬架式移动系统，通过悬架的主动变形，可实现车体高度调整、抬轮行走等扩展功能，有效提升星球车沉陷脱困能力和障碍通过性能，如图1所示，专利“主动悬架式星球车移动机构”(CN105235468B)中对主动悬架式移动系统具体组成及总体功能进行了较详细介绍，“主动悬架式火星车主摇臂长短段张角调节机构”(CN105150789B)中对夹角调节机构组成及原理进行了介绍，但针对各功能实现的具体算法没有说明，本申请将在其基础上主要针对主动悬架式移动系统抬轮行走的具体控制算法进行说明，对星球车抬轮行走控制实现至关重要，现有文献均未见有相关内容。
技术实现思路
本专利技术的技术解决问题是：克服现有技术的不足，提供了一种主动悬架式星球车抬轮行走控制方法，应用于新型主动悬架式星球车抬轮行走控制，解决星球车车轮沉陷无法脱困以及车轮故障后影响正常运动的问题。本专利技术的技术解决方案是：一种主动悬架式星球车抬轮行走控制方法，主动悬架式星球车包括六套车轮驱动机构、六套车轮转向机构、两套夹角调整机构、两套离合器机构以及组成悬架的主副摇臂，其中车轮驱动机构和转向机构实现主动悬架式星球车的行走与转向，通过夹角调整机构和离合器机构配合实现抬轮行走功能；抬轮行走控制方法包括如下步骤：(1)对主动悬架式星球车进行抬升前轮行走控制；(2)对主动悬架式星球车进行抬升中轮行走控制；(3)对主动悬架式星球车进行抬升后轮行走控制。进一步的，主动悬架式星球车通过夹角调整机构进行车体离地高度调整，根据夹角调整机构中角度测量器件位置旋变所测量角度值，确定星球车车体高度，夹角调整机构转角α与车体离地高度H之间关系为其中，α为主摇臂前段和主摇臂后段间夹角，H为车厢底面距地高度，h1为夹角调整机构中心轴线距车厢底面高度，R为车轮半径，h2为主副摇臂铰接点与车轮轴线竖直距离，L1为主摇臂前段长度，L2为主摇臂后段长度。进一步的，所述对主动悬架式星球车进行抬升前轮行走控制，具体为：步骤101，将星球车系统质心调整至两中轮与地面接触点连线的后方；根据星球车构型关系，车体离地高度增加，系统质心向后方运动，星球车车体离地最大高度为Hmax，则可求取夹角调整机构对应角度αmax，控制夹角调整机构运动，目标角度αmax；步骤102，控制离合器啮合运动，使得主副摇臂锁死；离合器初始为啮开状态，主副摇臂间可自由转动，抬轮操作前，控制离合器进行啮合运动，离合器中配置有到位开关，当到位开关触发后离合器自动停止运动，主副摇臂间锁死，不能相对转动；步骤103，控制夹角调整机构运动，使得车体高度降低，前轮抬升；控制夹角调整机构运动，使车体距地高度降低，随着车体高度降低，前轮逐渐抬起，直至前车轮抬升到目标高度，夹角调整机构停止运动；步骤104，控制非抬升车轮驱动机构工作，实现前轮抬升行走。进一步的，步骤103中，夹角调整机构运动目标角度α1，根据抬轮前车体高度Hmax以及目标抬轮高度hqtai计算求取；星球车前轮抬升高度与夹角调整机构角度间关系通过下面方程组确定：hqtai＝W11H11＝AH11-O1C(1-1)AH11＝O1W3·sin∠O1W3D(1-2)O1C＝O1W11·sin∠O1W11C(1-6)∠O1W11C＝π-α1-∠O2O1B(1-7)将式(1-3)至(1-5)代入式(1-2)中得到AH11，将式(1-7)、(1-8)代入式(1-6)中得到O1C，将式(1-2)和式(1-6)结果代入式(1-1)，获得前轮抬升高度hqtai，同时，在已知W11H11和γ1时，可以反求α1；其中，W11H11为前轮抬升高度，AH11为夹角调整机构轴线与前轮抬升前车轮轴线间竖直距离，O1C为夹角调整机构轴线与前轮抬升后车轮轴线间竖直距离，O1W3为夹角调整机构中心与后轮中心间距离，∠O1W3D为夹角调整机构中心和后轮中心连线与水平地面间夹角，O1O2为主摇臂后段长度，O2W3为副摇臂长度，γ1为主摇臂后段与副摇臂前段间夹角，为副摇臂前段与后段间夹角，∠O1W3O2为夹角调整机构中心和后轮中心连线与副摇臂后段间夹角，O1W11为主摇臂前段长度，∠O1W11C为主摇臂前段与水平地面间夹角，α1为前轮抬升后夹角调整机构前段和后段间夹角，∠O2O1B为主摇臂后段与水平地面间夹角。进一步的，所述对主动悬架式星球车进行抬升中轮行走控制，具体为：步骤201，调整星球车车体高度，使得车体离地高度低于预设阈值，以保证中轮抬升过程星球车不会由于高度过高产生危险；根据星球车构型关系，抬升中轮前将星球车车体离地高度调整为Hmin，则求取夹角调整机构对应角度αmin，控制夹角调整机构运动，目标角度αmin；步骤202，控制离合器啮合运动，使得主副摇臂锁死；离合器初始为啮开状态，主副摇臂间可自由转动，抬轮操作前，控制离合器进行啮合运动，离合器中配置有到位开关，当到位开关触发后离合器自动停止运动，主副摇臂间锁死，不能相对转动；步骤203，控制夹角调整机构运动，使得车体高度增加，中轮抬升；控制夹角调整机构运动，使车体距地高度增加，随着车体高度增加，中轮逐渐抬起，直至车轮抬升到目标高度，夹角调整机构停止运动；夹角调整机构运动目标角度α3，可根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取；步骤204，控制非抬升车轮驱动机构以一定速度运动，实现前轮抬升行走。进一步的，步骤203中，夹角调整机构运动目标角度α3，根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取；星球车中轮抬升高度与夹角调整机构角度间关系通过下面方程组确定：hztai＝W21H21＝W1W21·sin∠W21W1H21(2-1)∠W1O1W21＝α3-∠O2O1W21(2-4)∠W21W1H21＝∠O1W1W3-∠O1W1W21(2-6)∠W1O1W3＝α3-∠W3O1O2(2-10)将式(2-2)至(2-12)代入式(2-1)，得到中轮抬升高度W21H21本文档来自技高网...

【技术保护点】
1.一种主动悬架式星球车抬轮行走控制方法，其特征在于：主动悬架式星球车包括六套车轮驱动机构、六套车轮转向机构、两套夹角调整机构、两套离合器机构以及组成悬架的主副摇臂，其中车轮驱动机构和转向机构实现主动悬架式星球车的行走与转向，通过夹角调整机构和离合器机构配合实现抬轮行走功能；/n抬轮行走控制方法包括如下步骤：/n(1)对主动悬架式星球车进行抬升前轮行走控制；/n(2)对主动悬架式星球车进行抬升中轮行走控制；/n(3)对主动悬架式星球车进行抬升后轮行走控制。/n

【技术特征摘要】
1.一种主动悬架式星球车抬轮行走控制方法，其特征在于：主动悬架式星球车包括六套车轮驱动机构、六套车轮转向机构、两套夹角调整机构、两套离合器机构以及组成悬架的主副摇臂，其中车轮驱动机构和转向机构实现主动悬架式星球车的行走与转向，通过夹角调整机构和离合器机构配合实现抬轮行走功能；
抬轮行走控制方法包括如下步骤：
(1)对主动悬架式星球车进行抬升前轮行走控制；
(2)对主动悬架式星球车进行抬升中轮行走控制；
(3)对主动悬架式星球车进行抬升后轮行走控制。


2.根据权利要求1所述的一种主动悬架式星球车抬轮行走控制方法，其特征在于：主动悬架式星球车通过夹角调整机构进行车体离地高度调整，根据夹角调整机构中角度测量器件位置旋变所测量角度值，确定星球车车体高度，夹角调整机构转角α与车体离地高度H之间关系为



其中，α为主摇臂前段和主摇臂后段间夹角，H为车厢底面距地高度，h1为夹角调整机构中心轴线距车厢底面高度，R为车轮半径，h2为主副摇臂铰接点与车轮轴线竖直距离，L1为主摇臂前段长度，L2为主摇臂后段长度。


3.根据权利要求2所述的一种主动悬架式星球车抬轮行走控制方法，其特征在于：所述对主动悬架式星球车进行抬升前轮行走控制，具体为：
步骤101，将星球车系统质心调整至两中轮与地面接触点连线的后方；
根据星球车构型关系，车体离地高度增加，系统质心向后方运动，星球车车体离地最大高度为Hmax，则可求取夹角调整机构对应角度αmax，控制夹角调整机构运动，目标角度αmax；
步骤102，控制离合器啮合运动，使得主副摇臂锁死；
离合器初始为啮开状态，主副摇臂间可自由转动，抬轮操作前，控制离合器进行啮合运动，离合器中配置有到位开关，当到位开关触发后离合器自动停止运动，主副摇臂间锁死，不能相对转动；
步骤103，控制夹角调整机构运动，使得车体高度降低，前轮抬升；
控制夹角调整机构运动，使车体距地高度降低，随着车体高度降低，前轮逐渐抬起，直至前车轮抬升到目标高度，夹角调整机构停止运动；
步骤104，控制非抬升车轮驱动机构工作，实现前轮抬升行走。


4.根据权利要求3所述的一种主动悬架式星球车抬轮行走控制方法，其特征在于：步骤103中，夹角调整机构运动目标角度α1，根据抬轮前车体高度Hmax以及目标抬轮高度hqtai计算求取；
星球车前轮抬升高度与夹角调整机构角度间关系通过下面方程组确定：
hqtai＝W11H11＝AH11-O1C(1-1)
AH11＝O1W3·sin∠O1W3D(1-2)









O1C＝O1W11·sin∠O1W11C(1-6)
∠O1W11C＝π-α1-∠O2O1B(1-7)



将式(1-3)至(1-5)代入式(1-2)中得到AH11，将式(1-7)、(1-8)代入式(1-6)中得到O1C，将式(1-2)和式(1-6)结果代入式(1-1)，获得前轮抬升高度hqtai，同时，在已知W11H11和γ1时，可以反求α1；
其中，W11H11为前轮抬升高度，AH11为夹角调整机构轴线与前轮抬升前车轮轴线间竖直距离，O1C为夹角调整机构轴线与前轮抬升后车轮轴线间竖直距离，O1W3为夹角调整机构中心与后轮中心间距离，∠O1W3D为夹角调整机构中心和后轮中心连线与水平地面间夹角，O1O2为主摇臂后段长度，O2W3为副摇臂长度，γ1为主摇臂后段与副摇臂前段间夹角，为副摇臂前段与后段间夹角，∠O1W3O2为夹角调整机构中心和后轮中心连线与副摇臂后段间夹角，O1W11为主摇臂前段长度，∠O1W11C为主摇臂前段与水平地面间夹角，α1为前轮抬升后夹角调整机构前段和后段间夹角，∠O2O1B为主摇臂后段与水平地面间夹角。


5.根据权利要求2所述的一种主动悬架式星球车抬轮行走控制方法，其特征在于：所述对主动悬架式星球车进行抬升中轮行走控制，具体为：
步骤201，调整星球车车体高度，使得车体离地高度低于预设阈值，以保证中轮抬升过程星球车不会由于高度过高产生危险；
根据星球车构型关系，抬升中轮前将星球车车体离地高度调整为Hmin，则求取夹角调整机构对应角度αmin，控制夹角调整机构运动，目标角度αmin；
步骤202，控制离合器啮合运动，使得主副摇臂锁死；
离合器初始为啮开状态，主副摇臂间可自由转动，抬轮操作前，控制离合器进行啮合运动，离合器中配置有到位开关，当到位开关触发后离合器自动停止运动，主副摇臂间锁死，不能相对转动；
步骤203，控制夹角调整机构运动，使得车体高度增加，中轮抬升；
控制夹角调整机构运动，使车体距地高度增加，随着车体高度增加，中轮逐渐抬起，直至车轮抬升到目标高度，夹角调整机构停止运动；夹角调整机构运动目标角度α3，可根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取；
步骤204，控制非抬升车轮驱动机构以一定速度运动，实现前轮抬升行走。


6.根据权利要求5所述的一种主动悬架式星球车抬轮行走控制方法，其特征在于：步骤203中，夹角调整机构运动目标角度α3，根据抬轮前车体高度Hmin以及目标抬轮高度hztai计算求取；
星球车中轮抬升高度与夹角调整机构角度间关系通过下面方程组确定：
hztai＝W21H21＝W1W21·sin∠W21W1H21(2-1)






∠W1O1W21＝α3-∠O2O1W21(2-4)



∠W21W1H21＝∠O1W1...

【专利技术属性】
技术研发人员：潘冬，袁宝峰，刘雅芳，王瑞，贾阳，陈百超，李德伦，陈磊，梁常春，刘鑫，
申请(专利权)人：北京空间飞行器总体设计部，
类型：发明
国别省市：北京;11