可自重构星球车的多关节协调控制方法技术

本发明专利技术提供可自重构星球车的多关节协调控制方法，涉及星球车技术领域，该方法包括：获取车体状态数据，包括主动摇臂转动角度、主动摇臂转动引起的车轮轴距减小量、主动摇臂的角速度和车轮的滚动角速度；根据所述车体状态数据建立多关节运动约束模型，包括车体质心位置约束模型、多关节动作协调性约束模型和车体差速转向运动稳定性约束模型；根据所述多关节运动约束模型对所述可自重构星球车进行多关节运动控制。通过建立车体质心位置、多关节动作协调性和车体差速转向运动稳定性三个层面上的多关节运动约束模型，实现重构过程中对车体内部多关节的运动协调控制，从而实现可自重构轮式移动星球车的机械模态转换功能和多运动模式切换功能。模式切换功能。模式切换功能。

【技术实现步骤摘要】
可自重构星球车的多关节协调控制方法


[0001]本专利技术涉及星球车
，尤其涉及可自重构星球车的多关节协调控制方法。

技术介绍

[0002]随着星球探测任务的推进，星球车作为科学探测仪器的有效载体平台，在星球探测工程中起着举足轻重的作用，其中，轮式移动机器人凭借便于控制、移动灵活、模块化与拓展性强的优点广泛用作星球车的主体，在可自重构星球车执行探测任务的过程中，多关节的运动控制是提高星球车在变形和粗糙地形，特别是行星环境下探测能力的关键。
[0003]目前对可自重构星球车的研究集中在星球车构型的多样化，忽略了在控制模式切换策略中对星球车多关节运动协调策略的定义，不能在重构过程中避免车体内部多关节间的配合故障，从而导致星球车不具备多关节协调的机械模态转换和移动模式切换控制的复杂操作功能，影响其实际应用价值。

技术实现思路

[0004]本专利技术解决的问题是如何对可自重构星球车多关节运动进行协调控制，提高可自重构星球车的实际应用价值。
[0005]为解决上述问题，本专利技术提供可自重构星球车的多关节协调控制方法，包括如下步骤：
[0006]获取车体状态数据，所述车体状态数据包括主动摇臂转动角度、主动摇臂转动引起的车轮轴距减小量、主动摇臂的角速度和车轮的滚动角速度；
[0007]根据所述车体状态数据建立所述可自重构星球车的多关节运动约束模型，所述多关节运动约束模型包括车体质心位置约束模型、多关节动作协调性约束模型和车体差速转向运动稳定性约束模型；
[0008]根据所述多关节运动约束模型对所述可自重构星球车进行多关节运动控制。
[0009]可选地，所述根据所述车体状态数据建立所述可自重构星球车的多关节运动约束模型包括：
[0010]根据所述主动摇臂转动角度和所述主动摇臂转动引起的车轮轴距减小量建立车体质心位置约束模型，根据所述主动摇臂转动引起的车轮轴距减小量建立多关节动作协调性约束模型，根据所述主动摇臂的角速度和所述车轮的滚动角速度建立车体差速转向运动稳定性约束模型。
[0011]可选地，所述车体质心位置约束模型包括第一约束、第二约束和第三约束，其中，所述第一约束包括：
[0012]所述主动摇臂转动引起的车轮轴距减小量小于等于第一预设阈值，所述第一约束用于避免车轮相撞；
[0013]所述第二约束包括：
[0014]由主动摇臂转动引起的车体横滚角小于等于第二预设阈值，所述第二约束用于避
免车体产生异常横滚角度；
[0015]所述第三约束包括：
[0016]由主动摇臂转动引起的车体转向角小于等于第三预设阈值，所述第三约束用于避免车体转向角度偏差过大。
[0017]可选地，所述多关节动作协调性约束模型包括：
[0018]车轮前向速度差等于所述主动摇臂的角速度的第一预设倍数，所述多关节协动作调性约束模型用于避免车体侧翻。
[0019]可选地，所述车体差速转向运动稳定性约束模型包括第四约束、第五约束、第六约束和第七约束，其中，所述第四约束包括：
[0020]所述主动摇臂的角速度小于等于车体在悬架姿态调整之前的初始速度的第二预设倍数，所述第四约束用于避免车轮合并速度为零；
[0021]所述第五约束包括：
[0022]所述可自重构星球车的前向速度偏差小于第四预设阈值，所述第五约束用于避免车体前向速度失调；
[0023]所述第六约束包括：
[0024]所述可自重构星球车的车体转向角速度偏差小于第五预设阈值，所述第六约束用于避免车体转向角速度失调；
[0025]所述第七约束包括：
[0026]所述可自重构星球车的车体横滚角速度小于第六预设阈值，所述第七约束用于避免车体横滚角速度失调。
[0027]可选地，还包括车轮与地面接触的数量约束模型，所述车轮与地面接触的数量约束模型包括第八约束、第九约束和第十约束，其中所述第八约束包括：
[0028]车轮同时离地数量小于等于第七预设阈值；
[0029]所述第九约束包括：
[0030]单侧车轮离地数量小于等于第八预设阈值；
[0031]所述第十约束包括：
[0032]前轮和后轮至少有一个轮接触地面。
[0033]可选地，可自重构星球车的多关节协调控制方法还包括：
[0034]根据轮地接触点的可变位置和车体三维线速度建立车体运动学模型，根据车体属性建立车体动力学模型。
[0035]可选地，所述车体运动学模型包括考虑轮地接触点的动态移动运动学模型和具有竖直自由度的差速转向运动学模型。
[0036]可选地，所述考虑轮地接触点的动态移动运动学模型和所述具有竖直自由度的差速转向运动学模型的建立过程包括：
[0037]根据车体坐标系的偏置轮矩阵、悬架铰接关节的角速度、轮地接触点相对于车轮中心的线速度、车轮支撑臂铰接关节的角速度和所述车体三维线速度得到考虑轮地接触点的动态移动运动学模型；
[0038]根据所述主动摇臂的角速度和车体姿态角得到具有竖直自由度的差速转向运动学模型。
[0039]可选地，所述根据车体属性建立车体动力学模型包括：
[0040]根据关节角度、关节数量、主动摇臂的驱动力矩建立所述车体动力学模型。
[0041]相对于现有技术，本专利技术所述的可自重构星球车的多关节协调控制方法，通过获取车体状态数据并根据车体状态数据建立车体质心位置、多关节动作协调性和车体差速转向运动稳定性三个层面上的多关节运动约束模型，实现重构过程中对车体内部多关节的运动协调控制，保证车体运动安全性，从而实现可自重构轮式移动星球车的机械模态转换功能和多运动模式切换功能，提高可自重构轮式移动星球车的实际应用价值。
附图说明
[0042]图1为本专利技术实施例的可自重构星球车的多关节协调控制方法的控制流程图；
[0043]图2为本专利技术实施例的车轮抬离地面的情形示意图。
具体实施方式
[0044]为使本专利技术的上述目的、特征和优点能够更为明显易懂，下面结合附图对本专利技术的具体实施例做详细的说明。虽然附图中显示了本专利技术的某些实施例，然而应当理解的是，本专利技术可以通过各种形式来实现，而且不应该被解释为限于这里阐述的实施例，相反提供这些实施例是为了更加透彻和完整地理解本专利技术。应当理解的是，本专利技术的附图及实施例仅用于示例性作用，并非用于限制本专利技术的保护范围。
[0045]应当理解，本专利技术的方法实施方式中记载的各个步骤可以按照不同的顺序执行，和/或并行执行。此外，方法实施方式可以包括附加的步骤和/或省略执行示出的步骤。本专利技术的范围在此方面不受限制。
[0046]本文使用的术语“包括”及其变形是开放性包括，即“包括但不限于”。术语“基于”是“至少部分地基于”。术语“一个实施例”表示“至少一个实施例”；术语“另一实施例”表示“至少一个另外的实施例”；术语“一些实施例”表示“至少一些实施例”；术语“可选地”表示“可选的实施例”。其本文档来自技高网...

【技术保护点】

【技术特征摘要】
1.可自重构星球车的多关节协调控制方法，其特征在于，包括：获取车体状态数据，所述车体状态数据包括主动摇臂转动角度、主动摇臂转动引起的车轮轴距减小量、主动摇臂的角速度和车轮的滚动角速度；根据所述车体状态数据建立所述可自重构星球车的多关节运动约束模型，所述多关节运动约束模型包括车体质心位置约束模型、多关节动作协调性约束模型和车体差速转向运动稳定性约束模型；根据所述多关节运动约束模型对所述可自重构星球车进行多关节运动控制。2.根据权利要求1所述的可自重构星球车的多关节协调控制方法，其特征在于，所述根据所述车体状态数据建立所述可自重构星球车的多关节运动约束模型包括：根据所述主动摇臂转动角度和所述主动摇臂转动引起的车轮轴距减小量建立车体质心位置约束模型，根据所述主动摇臂转动引起的车轮轴距减小量建立多关节动作协调性约束模型，根据所述主动摇臂的角速度和所述车轮的滚动角速度建立车体差速转向运动稳定性约束模型。3.根据权利要求2所述的可自重构星球车的多关节协调控制方法，其特征在于，所述车体质心位置约束模型包括第一约束、第二约束和第三约束，其中，所述第一约束包括：所述主动摇臂转动引起的车轮轴距减小量小于等于第一预设阈值，所述第一约束用于避免车轮相撞；所述第二约束包括：由主动摇臂转动引起的车体横滚角小于等于第二预设阈值，所述第二约束用于避免车体产生异常横滚角度；所述第三约束包括：由主动摇臂转动引起的车体转向角小于等于第三预设阈值，所述第三约束用于避免车体转向角度偏差过大。4.根据权利要求2所述的可自重构星球车的多关节协调控制方法，其特征在于，所述多关节动作协调性约束模型包括：车轮前向速度差等于所述主动摇臂的角速度的第一预设倍数，所述多关节动作协调性约束模型用于避免车体侧翻。5.根据权利要求2所述的可自重构星球车的多关节协调控制方法，其特征在于，所述车体差速转向运动稳定性约束模型包括第四约束、第五约束、第六约束和第七约束，其中，所述第四约束包括：所述主动摇臂的角速度小于等于车体在悬架姿态调整...

【专利技术属性】
技术研发人员：丁亮，齐华囡，高海波，杨怀广，李欣育，李楠，邓宗全，
申请(专利权)人：哈尔滨工业大学，
类型：发明
国别省市：