一种基于拖曳矩补偿的滚动姿态动态控制方法与流程

摘要: 本发明涉及机器人控制及车辆动力学,具体为一种基于拖曳矩补偿的滚动姿态动态控制方法。背景技术:1、自平衡两轮车因其占地面积小、机动性强等特点,在短途交通代步、物流...
一种基于拖曳矩补偿的滚动姿态动态控制方法与流程

本发明涉及机器人控制及车辆动力学,具体为一种基于拖曳矩补偿的滚动姿态动态控制方法。

背景技术:

1、自平衡两轮车因其占地面积小、机动性强等特点,在短途交通代步、物流巡检及室内服务机器人等领域得到了广泛应用。该类车辆在动力学上属于典型的侧向不稳定系统,即倒立摆系统,必须依靠主动控制维持车身平衡。常见的平衡控制策略是通过控制前轮转向产生离心力来抵消重力倾覆力矩,这种方式在车辆具备一定行驶速度时效果显著。然而,在低速或静止状态下,转向动作产生的离心力微乎其微,无法提供足够的回复力矩。为了解决零速平衡问题,现有的高性能自平衡两轮车通常会引入控制力矩陀螺(control momentgyroscope, cmg)模组,利用高速旋转转子的进动效应产生巨大的陀螺力矩来维持姿态稳定。

2、尽管“转向+控制力矩陀螺”的复合驱动方案在理论上拓宽了车辆的运行包络,但在实际工程应用中仍面临诸多严峻挑战。首先,现有控制策略往往基于简化的动力学模型设计,忽略了轮胎与地面接触时的复杂非线性特性。特别是对于配备宽断面轮胎的车辆,在转向过程中轮胎接地点会产生显著的滑动摩擦阻力,即轮胎拖曳矩。这种难以直接测量的非线性干扰在传统模型中常被忽略或视为高斯白噪声,导致控制器无法及时补偿,进而引起车身姿态的稳态误差或高频抖动。

3、此外,控制力矩陀螺作为一种动量交换装置,其输出力矩的能力受到框架角位置的严格限制。当框架角接近机械限位时,系统会陷入动量饱和状态;而当框架角接近90度时,系统会进入几何奇异区,导致输出力矩骤降为零。现有的pid控制或常规线性反馈控制缺乏对系统未来状态的预测能力,难以在维持平衡的同时主动规划框架角的回复路径,容易导致陀螺模组因长时间单向出力而失效,最终引发倒车事故。同时,如何根据车辆行驶速度的变化,在转向平衡机理与陀螺平衡机理之间实现平滑无缝的权重切换,也是现有技术中亟待解决的难题。单纯的阈值切换容易造成控制指令突变,影响行驶平顺性。

技术实现思路

1、针对现有技术的不足,本发明提供了一种基于拖曳矩补偿的滚动姿态动态控制方法,解决了自平衡两轮车因未建模的轮胎拖曳矩干扰无法精确补偿、控制力矩陀螺易陷入饱和或奇异状态以及全速域下转向与陀螺机构难以协同控制而导致的平衡稳定性差的问题。

2、为实现以上目的,本发明通过以下技术方案予以实现:本发明第一方面提供一种基于拖曳矩补偿的滚动姿态动态控制方法,该方法运行于自平衡两轮车的电子控制单元中。该方法首先获取自平衡两轮车的实时状态数据,所述数据涵盖了车身姿态(滚动角及角速度)、车辆运动状态(纵向行驶速度)以及执行机构状态(转向角及控制力矩陀螺框架角)。

3、针对车辆行驶过程中存在的难以直接测量的外部干扰,该方法引入了状态观测器机制。通过计算实时状态数据与预设动力学模型之间的残差,实时估算包含轮胎拖曳矩在内的广义干扰力矩。具体而言,该步骤将车身滚动角、行驶速度、转向角及框架角代入动力学方程,计算当前时刻已知的重力倾覆力矩、转向离心回正力矩、陀螺进动力矩及陀螺侧向耦合力矩,并将上述力矩的代数和定义为理论合外力矩。同时,结合实际测量的滚动角加速度与整车转动惯量计算实际惯性力矩。实际惯性力矩与理论合外力矩之间的差值,即反映了未被模型捕捉的外部干扰及模型不确定性。该差值经低通滤波处理后作为广义干扰力矩的估计值,为后续控制提供前馈补偿依据。

4、在控制律计算层面,本发明构建离散时间的预测模型。该模型将上述估算的广义干扰力矩作为已知的前馈输入,并描述了车身滚动角、车身滚动角速度及当前框架角随转向角速度指令和框架角速度指令的演化关系。为了解决控制力矩陀螺输出力矩与框架角之间的非线性几何关系,该方法对非线性几何约束项进行线性化处理,获得随当前框架角实时变化的系统状态矩阵和输入控制矩阵,并采用零阶保持器法将其转化为离散时间的状态空间方程。

5、本发明采用模型预测控制框架,构建包含动量管理目标的代价函数。该代价函数不仅包含针对车身滚动角跟踪误差的惩罚项以确保平衡,还特别设置了针对当前框架角偏离零位的惩罚项。通过最小化该动量管理代价项,驱动控制力矩陀螺模组在维持车身平衡的过程中,利用系统的零动态特性逐渐将框架角恢复至零位,从而防止框架角达到机械限位而丧失控制能力。

6、在求解最优控制序列时,该方法利用二次规划求解器在满足车辆物理约束的前提下对代价函数进行求解。所述物理约束包括限制车身滚动角处于安全范围的状态约束、限制当前框架角处于线性工作区范围(避免接近90度奇异点)的奇异规避约束,以及限制控制指令幅值不超过电机响应能力的输入约束。求解器输出未来有限时域内的最优控制增量序列,控制系统根据该序列生成针对转向驱动机构的目标转向角位置指令和针对控制力矩陀螺模组的目标框架角速度指令,并下发执行。

7、进一步地,为了实现从静止到高速行驶的全速域稳定控制,本发明提出了一种基于车辆纵向行驶速度的自适应权重调度策略。在代价函数中,针对转向角速度指令的惩罚权重及针对框架角速度指令的惩罚权重被设定为车辆纵向行驶速度的函数。当车辆处于低速或静止状态时,转向产生的离心回正力矩较小,系统设定较大的转向惩罚权重及较小的框架惩罚权重,从而抑制转向动作并优先调用控制力矩陀螺进行平衡;当车辆处于高速行驶状态时,转向离心效应显著,系统设定较小的转向惩罚权重及较大的框架惩罚权重,从而抑制控制力矩陀螺的动作并优先利用转向调节姿态。该策略有效解决了单一执行机构在不同速度区间效能不匹配的问题。

8、此外,本发明还集成了多级安全冗余机制。系统实时监测二次规划求解器的求解状态及传感器数据的一致性。当监测到求解器超时或无可行解时,系统自动切换至备用pid控制器,直接利用滚动角偏差计算维持平衡所需的控制量,实现软性接管。当监测到车身滚动角绝对值超过物理恢复极限等极端情况时,系统触发机械支撑装置弹出,并同时控制行驶及进动电机停止,实现硬性保护。

9、本发明提供了一种基于拖曳矩补偿的滚动姿态动态控制方法。具备以下有益效果:

10、1、本发明通过建立状态观测器并实时计算系统状态数据与预设动力学模型之间的残差,能够精确估算包含轮胎拖曳矩在内的广义干扰力矩,并将其作为前馈量引入预测模型,这一机制有效解决了传统控制方法在复杂路面或轮胎非线性特性影响下因无法感知外部扰动而导致的稳态误差问题,在无需增加额外高成本扭矩传感器的前提下,提升了自平衡两轮车对地面不平度及气动干扰的抗扰动能力和平衡精度。

11、2、本发明在模型预测控制的代价函数中引入了动量管理目标,并设置了奇异规避的物理约束,该设计能够在维持车身姿态稳定的同时,利用系统的零动态特性驱动控制力矩陀螺框架角自动趋向零位,有效防止了控制力矩陀螺因长时间单向输出力矩而进入饱和状态或奇异位形,这保证了执行机构始终保留有充足的动量行程以应对突发的大幅扰动,从而提高了系统的持续作业能力和安全性。

12、3、本发明采用了基于车辆纵向行驶速度的自适应权重调度策略,能够根据车速变化动态调整转向机构与控制力矩陀螺的控制权重,在低速或静止阶段优先利用控制力矩陀螺实现零速平衡,避免了低速大幅转向引起的前轮摆动;在高速阶段优先利用转向离心力矩进行平衡,降低了控制力矩陀螺的能耗,这种全速域的协同控制策略实现了两种执行机构优势互补,确保了车辆从静止站立到高速巡航全过程的平稳过渡与高效能耗管理。