一种移动机器人双轮差速驱动模型及其运动控制方法与流程
本发明涉及一种方法,尤其是涉及一种移动机器人双轮差速驱动模型及其运动控制方法。
背景技术:
1、双轮差速驱动凭借结构简单、转向灵活、控制便捷等优势,广泛应用于各类小型移动机器人。现有技术中已公开基础差速运动关系式、连续运动微分方程,部分商用机器人及开源算法也具备基础离散迭代能力,能够在常规平地场景下实现基本的运动控制与位姿解算。该类模型通常以车轮线速度或机体合成速度作为控制输入,通过运动学方程计算机体线速度、角速度及瞬时回转半径,并在此基础上进行位姿迭代与路径跟踪。
2、然而,现有双轮差速运动建模理论与工程实现在燃机内部复杂流道巡检场景下仍存在诸多技术短板。首先,现有公开的建模理论中建模输入口径不统一,部分以车轮线速度作为输入,部分以机体合成速度为基础,并未形成统一以左右电机角速度作为底层标准控制输入的层级化建模规范;各类运动关系式零散独立,没有形成从电机输入到轮速解算、机体运动参数、瞬时回转半径到位姿迭代的完整递进建模链路,不利于嵌入式控制器标准化开发与工程移植适配。其次,传统差速运动学模型均基于理想平整地面、无滑移、无坡度、无弯道曲率约束假设建立,未考虑燃机内部流道固有特征,如通道狭窄连续弯折、内壁弧形曲面倾斜、磁吸履带与金属内壁存在附着微滑移、变径弯道约束实际转弯半径,直接套用通用理想模型会出现位姿解算偏移、直行跑偏、转弯半径失准、轨迹漂移等问题,无法满足燃机精细化检查的高精度要求。此外,现有研究多侧重连续运动微分方程推导,仅用于理论仿真;工程级离散迭代模型均为通用平地版本,未针对燃机流道倾角、弯道曲率、磁吸履带滑移做定制化适配修正,移植到燃机复杂受限流道后位姿累积误差大、轨迹跟踪精度大幅下降,缺乏可直接用于嵌入式系统周期迭代的成套专用建模方案。
技术实现思路
1、为了解决现有技术中存在的缺陷,本发明公开一种移动机器人双轮差速驱动模型,包括:
2、参数定义单元,用于定义建模基础参数,所述建模基础参数包括车轮半径、左右轮中心间距、左右电机角速度;
3、轮速解算单元,用于根据所述左右电机角速度和车轮半径解算左右轮线速度;
4、机体运动参数解算单元,用于根据左右轮线速度和左右轮中心间距计算机体中心合成线速度和机体偏航角速度;
5、瞬时回转半径计算单元,用于根据机体中心合成线速度和机体偏航角速度计算瞬时回转半径;
6、连续运动微分方程构建单元,用于建立全局坐标系下连续运动位姿微分方程;
7、工况修正单元,用于引入燃机流道工况修正项,所述工况修正项包括左右轮滑移修正系数、流道纵向倾斜角、弯道曲率约束系数,并输出实际线速度和实际偏航角速度;
8、离散递推单元,用于以控制采样周期对连续模型离散化,采用所述实际线速度和实际偏航角速度构建离散位姿递推模型。
9、本发明还公开一种移动机器人双轮差速驱动运动控制方法,其特征在于,采用上述的移动机器人双轮差速驱动模型,并包括以下步骤:
10、步骤s1,以左右电机角速度为唯一控制输入,建立逐级递推的双轮差速运动基础模型,所述基础模型包括轮速解算、机体运动参数求解、瞬时回转半径计算和连续运动位姿微分方程;
11、步骤s2,引入燃机流道工况修正项,构建实际运动参数修正模型,输出实际线速度和实际偏航角速度;
12、步骤s3,以嵌入式系统控制采样周期对连续模型离散化,采用所述实际线速度和实际偏航角速度构建离散位姿递推模型;
13、步骤s4,执行模型前馈逆解,根据期望目标线速度和期望目标角速度求解左右轮期望角速度;
14、步骤s5,执行速度闭环控制,基于电机编码器反馈的实际角速度与期望角速度的偏差进行pid调节;
15、步骤s6,执行姿态与轨迹闭环控制,基于惯性姿态传感器反馈的实际位姿与期望位姿的偏差实时修正差速配比;
16、步骤s7,执行滑移与扰动自适应补偿,采用递推最小二乘在线辨识左右履带滑移系数并动态更新工况修正项参数。
17、本发明还公开一种移动机器人双轮差速驱动运动控制系统,其特征在于,包括:
18、参数输入模块,用于获取左右电机角速度、车轮半径、左右轮中心间距、控制采样周期;
19、基础模型构建模块,用于根据所述左右电机角速度、车轮半径、左右轮中心间距逐级递推计算左右轮线速度、机体中心合成线速度、机体偏航角速度、瞬时转弯半径,并建立连续运动位姿微分方程;
20、工况修正模块,用于引入左右轮滑移修正系数、流道纵向倾斜角、弯道曲率约束系数,构建实际运动参数修正模型,输出实际线速度和实际偏航角速度;
21、离散递推模块,用于根据所述实际线速度、实际偏航角速度和控制采样周期执行离散位姿递推,输出离散位姿;
22、前馈逆解控制器,用于根据期望目标线速度和期望目标角速度求解左右轮期望角速度;
23、速度闭环控制器,用于接收电机编码器反馈的实际角速度与期望角速度的偏差,通过pid调节输出电机驱动量;
24、轨迹闭环控制器,用于接收惯性姿态传感器反馈的实际位姿与期望位姿的偏差,实时修正差速配比并输出至速度闭环控制器;
25、自适应辨识模块,用于采用递推最小二乘在线辨识左右履带滑移系数,并动态更新所述左右轮滑移修正系数、流道纵向倾斜角、弯道曲率约束系数反馈至工况修正模块。
26、有益效果:
27、1. 建立了标准化的双轮差速层级建模体系:本方案以左右电机角速度为唯一控制输入,按照“轮速解算→机体运动参数求解→瞬时回转半径计算→连续运动微分方程”的递进逻辑构建基础模型,填补了现有技术中缺少统一、完整递推建模链路的空白,可作为差速驱动移动机器人的通用建模基准,便于嵌入式控制器的标准化开发与工程移植。
28、2. 实现了燃机复杂流道工况的专用适配:在基础模型中引入左右轮滑移修正系数、流道纵向倾斜角及弯道曲率约束系数,分别针对磁吸履带与金属内壁间的微滑移、流道纵向倾斜导致的重力分力影响、弧形变径弯道对转弯半径的几何限制进行精确补偿,克服了传统理想模型无法适应燃机内部狭窄弯折、曲面变径、倾斜异形流道的缺陷,显著提升了位姿解算精度与运动平稳性。
29、3. 构建了可直接嵌入式迭代的离散位姿递推模型:基于连续模型与工况修正后的实际运动参数,以控制采样周期构建离散位姿递推公式,实现了与嵌入式系统时钟周期严格匹配的实时迭代计算,弥补了通用离散模型无法适配燃机复杂工况、位姿累积误差大的短板,兼顾了理论完整性与工程落地性。
30、4. 形成了多层嵌套的运动控制闭环架构:采用“前馈逆解+内环速度闭环+外环轨迹闭环+工况自适应”的四层控制结构,通过模型前馈逆解快速给定期望指令,速度闭环消除电机转速稳态误差,轨迹闭环基于位姿偏差实时修正差速配比,实现了直线自动纠偏与弯道平滑跟踪,有效抑制了直行跑偏、转弯半径失准、轨迹漂移等问题。
31、5. 具备滑移与扰动实时自适应补偿能力:利用递推最小二乘算法在线辨识左右履带滑移系数,并同步采集惯性传感器数据解算流道倾斜角与弯道曲率约束系数,动态更新运动模型中的修正参数,使控制模型能够自适应不同流道内壁材质、坡度及曲率变化,提高了系统在燃机复杂受限流道中的鲁棒性与控制精度。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com