一种基于模型预测控制的四足机器人抗扰动运动控制方法及系统与流程
本发明涉及智能控制,特别是指一种基于模型预测控制的四足机器人抗扰动运动控制方法及系统。
背景技术:
1、四足机器人凭借其离散落足点和高机动性,在复杂非结构化环境中展现出广泛的应用潜力。为实现稳定的动态运动,基于模型预测控制(modelpredictivecontrol,mpc)的方法已成为主流方案。该类方法通常采用简化的单刚体动力学模型,通过在线滚动优化求解最终足底反力,从而驱动机器人质心轨迹和机身姿态跟踪期望指令。
2、然而,现有的基于mpc的四足机器人在应对突发外部扰动时,仍存在一个关键的局限性:其运动控制架构高度依赖预设的固定接触时序。具体而言,现有mpc方法在预测时域内,各条腿处于支撑相或摆动相的起止时间是按照事先规定的步态严格锁定的,控制器并不具备根据实际突发接触事件在线重构接触序列的能力。当机器人受到剧烈侧向撞击、足端瞬间打滑或意外踩空等不可预知扰动时,实际足-地接触状态会瞬间发生突变,例如原本处于摆动相的腿被迫提前触地,或原本承受载荷的支撑腿突然失去抓地力而腾空。然而,由于mpc滚动优化中的接触序列约束并未同步更新,预测模型内部仍假定各腿维持原定步态不变。这一缺陷直接导致优化求解出的地面反力分配与真实物理约束严重失配:控制器可能持续对已打滑离地的支撑腿规划出法向支撑力,而对受扰动后强行着地的摆动腿未能及时生成有效的稳定反力;这种接触序列层面的错位,会引发机身姿态的失控性偏离,使控制性能急剧恶化,严重时直接导致机器人倾覆;该缺陷显著削弱了四足机器人在高动态扰动环境下的抗干扰能力与运动鲁棒性,亟须加以解决。
技术实现思路
1、本发明提供了一种基于模型预测控制的四足机器人抗扰动运动控制方法及系统,避免了失控性偏离和倾覆风险。
2、为解决上述技术问题,本发明的技术方案如下:
3、第一方面,一种基于模型预测控制的四足机器人抗扰动运动控制方法,所述方法包括:
4、步骤1,根据实时采集的四足机器人运动状态信息和足端三维力信号,得到各足端的实际触地情况;
5、步骤2,根据各足端的实际触地情况与当前预设步态相位进行比对,识别出异常触地事件,异常触地事件为摆动腿提前着地或支撑腿意外离地;
6、步骤3,根据识别出的异常触地事件,对模型预测控制器滚动优化时域内的接触序列约束进行在线重构,得到重构后的接触序列,重构后的接触序列与扰动后的实际足地接触状态保持一致;
7、步骤4,根据重构后的接触序列,从运动状态信息中提取当前所有被标记为支撑相的足端位置,将足端位置投影至水平面,并通过平面凸包算法得到由这些投影点围成的支撑凸多边形;
8、步骤5,以支撑凸多边形作为地面反力合力作用点的稳定域约束,以重构后的接触序列作为单刚体动力学模型的时变约束,构建并求解有限时域最终控制问题,得到在满足合力作用点位于支撑凸多边形内部条件下的各支撑腿最终足底反力;
9、步骤6,根据最终足底反力和腿部运动学逆解,得到关节驱动力矩,以对四足机器人进行运动控制。
10、第二方面,一种基于模型预测控制的四足机器人抗扰动运动控制系统,包括:
11、信息采集模块,用于实时采集四足机器人运动状态信息和足端三维力信号;
12、触地判断与异常识别模块,用于根据足端三维力信号得到各足端的实际触地情况,并与当前预设步态相位进行比对,识别出异常触地事件,异常触地事件为摆动腿提前着地或支撑腿意外离地;
13、接触序列重构模块,用于根据识别出的异常触地事件,对模型预测控制器滚动优化时域内的接触序列约束进行在线重构,得到与扰动后实际足地接触状态保持一致的重构后的接触序列;
14、支撑域计算模块,用于根据重构后的接触序列,从运动状态信息中提取当前所有被标记为支撑相的足端位置,投影至水平面,并通过平面凸包算法生成支撑凸多边形;
15、模型预测优化求解模块,用于以支撑凸多边形作为地面反力合力作用点的稳定域约束,以重构后的接触序列作为单刚体动力学模型的时变约束,构建并求解有限时域最终控制问题,输出满足合力作用点位于支撑凸多边形内部条件下的各支撑腿最终足底反力;
16、力矩映射与执行模块,用于根据最终足底反力和腿部运动学逆解,得到关节驱动力矩,对四足机器人进行运动控制。
17、本发明的上述方案至少包括以下有益效果:
18、通过异常触地事件识别与接触序列在线重构机制,使控制器能够在预测模型内部实时同步真实的足-地接触约束,消除了因接触序列错配引发的力分配失配问题,从而在遭遇侧向撞击、足端打滑或意外踩空等突发扰动时,依然能够维持机身姿态的稳定,有效避免了失控性偏离和倾覆风险。
19、通过将重构后的接触序列与支撑凸多边形几何算法相结合,使地面反力合力作用点的稳定域约束能够随接触状态的变化而在线更新;当支撑腿因扰动发生意外变化时,支撑凸多边形同步重构,为后续优化问题提供了准确且符合实际物理状态的稳定边界,保证了优化的可行性和解的合理性。
20、通过将动态更新的接触序列约束与支撑凸多边形稳定域约束统一纳入单刚体动力学模型的有限时域优化框架中,在每一控制周期均以最新的约束条件重新构建优化问题并滚动求解,避免了向已离地或打滑的支撑腿规划无效反力、或对提前着地腿未能及时规划有效反力的情形,从而提升了控制指令的物理可执行性。
1.一种基于模型预测控制的四足机器人抗扰动运动控制方法,其特征在于,所述方法包括:
2.根据权利要求1所述的基于模型预测控制的四足机器人抗扰动运动控制方法,其特征在于,所述运动状态信息包括在世界坐标系下表示的机身姿态四元数、机身角速度、质心三维位置、质心三维速度,以及各腿髋关节与膝关节的关节角度和关节角速度;
3.根据权利要求2所述的方法,其特征在于,所述识别出异常触地事件具体包括:
4.根据权利要求3所述的方法,其特征在于,所述在线重构具体包括:
5.根据权利要求4所述的方法,其特征在于,所述支撑凸多边形包括:
6.根据权利要求5所述的方法,其特征在于,所述构建并求解有限时域最终控制问题具体包括:
7.根据权利要求6所述的方法,其特征在于,所述将合力作用点限制在支撑凸多边形内部的约束,具体通过以下方式实现:
8.根据权利要求7所述的方法,其特征在于,所述模型预测控制器在每个控制周期执行以下闭环操作:
9.根据权利要求8所述的方法,其特征在于,对四足机器人进行运动控制,具体包括:
10.一种基于模型预测控制的四足机器人抗扰动运动控制系统,该系统实现如权利要求1至9中任一项所述的方法,其特征在于,包括:
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com