适用于复杂地形的割草机器人平稳行走控制方法及系统与流程
本发明涉及移动机器人运动控制,特别是指适用于复杂地形的割草机器人平稳行走控制方法及系统。
背景技术:
1、移动机器人运动控制技术领域涵盖了环境感知路径规划运动学逆解以及执行机构调节等核心要素,系统性地整合了地形探测障碍物扫描惯性导航定位与驱动电机指令下发等硬件操作流程,依靠底层硬件物理量与上层规划指令的直接交互运作驱动移动平台在非结构化场景下进行位置变换与机械姿态调整;其中,传统适用于复杂地形的割草机器人平稳行走控制方法是指针对割草机器人在坡地坑洼草坪或湿滑泥地等非平坦表面行进时发生的机身位姿偏移以及车轮牵引力丢失事项,依靠在底盘前部增加物理配重块降低设备重心,利用倾角传感器实时采集机身的俯仰角与侧倾角数值,并在角度偏离设定安全阈值时由主控芯片直接向电机驱动回路发送脉冲信号切断割草刀盘电机供电并启用电磁制动器抱死底盘行走轮,或者利用霍尔编码器读取左右驱动轮的实际转速脉冲数值,将左右轮脉冲差值输入比例积分微分控制器中,直接通过增减电机驱动芯片的输入电压占空比来改变左右两侧行走轮的输入电流幅值。
2、现有技术依靠静态物理配重块降低重心的运作模式难以动态适应非平坦表面导致的频繁位姿偏移现象,依赖固定倾角阈值直接实施切断供电与电磁抱死操作极易引发运行中断与硬件冲击,同时仅基于车轮脉冲差值通过比例调节电压占空比的回路干预机制存在控制维度单一缺陷,面对复杂坡地极易出现单侧牵引力流失与动态补偿滞后情况,导致设备行走轨迹严重跑偏与整体空间姿态失去平稳状态。
技术实现思路
1、为了解决现有技术存在的技术问题,本发明实施例提供了适用于复杂地形的割草机器人平稳行走控制方法,包括以下步骤:
2、s1:采集割草机器人底盘左前与右前距离传感器前侧垂直距离尺度,同步获取后侧垂直距离尺度,分析左侧与右侧驱动轮电机内部编码器转速脉冲频次,计算电机驱动电路左侧与右侧实时相电流幅度,建立基础运行监测矩阵;
3、s2:调用所述基础运行监测矩阵,分别计算左侧、右侧垂直高度相减产生左纵变化量和右纵变化量,分析纵向变化量中位换算得出全局俯仰位移量,计算前横变化量和后横变化量,分析横向变化量中位换算得出全局侧倾位移量,生成空间姿态偏移分量;
4、s3:根据所述空间姿态偏移分量,计算相电流相减产生电流变动量,分析转速脉冲相减产生转速变动量,引入阻尼量纲转换系数,计算同步越界情形电流与转速变动比例并结合所述转换系数得出阻尼量,调整未越界情形阻尼量至原点状态,建立动态阻力调整记录;
5、s4:调用所述动态阻力调整记录,计算侧倾补偿和打滑补偿量,对各项补偿进行空间映射换算后相加得出质心偏移量,比较配重滑块实时位置坐标,获取横向质心纠偏指令;
6、s5:采用所述横向质心纠偏指令,计算基础扭矩和动态扭矩,将基础扭矩和动态扭矩相加得出总扭矩,基于前述转速变动量生成转速变动标记并进行判断,筛选正向标记锁定右侧驱动轮,筛选负向标记锁定左侧驱动轮,生成动力修正信号。
7、作为本发明的进一步方案,所述基础运行监测矩阵包括底盘离地间隙数据、轮毂转子运动参数、电驱负荷特征值,所述空间姿态偏移分量包括机体纵摇角度值、底盘横滚倾角值、三维位姿畸变参数,所述动态阻力调整记录包括牵引力衰减系数、摩擦阻尼补偿阈值、扭矩干预日志,所述横向质心纠偏指令包括配重模块位移靶向值、重心侧向平移向量、平衡配平致动电信号,所述动力修正信号包括驱动轴输出功率增量、单侧轮毂制动控制字、非对称驱动使能状态。
8、作为本发明的进一步方案,s1的具体步骤为:
9、s101:采集割草机器人底盘左前与右前距离传感器前侧垂直距离尺度,同步获取后侧垂直距离尺度,提取前侧与后侧垂直距离尺度内置数值特征参量,按照各个传感器所在节点空间坐标分布规则对数值特征参量依次执行序列化拼接操作,得到底盘多向空间间隙向量;
10、s102:调用所述底盘多向空间间隙向量,提取左侧与右侧驱动轮电机内部转速脉冲频次,读取转速脉冲频次对应时间戳参量,在时间轴维度提取相同时间戳对应转速脉冲频次以及底盘多向空间间隙向量,执行数据对齐合并操作,获取轮组运动特征序列;
11、s103:基于所述轮组运动特征序列,计算电机驱动电路左侧与右侧实时相电流幅度,提取实时相电流幅度内嵌数值参量,将数值参量与轮组运动特征序列内部数据项按对应索引排布,构建二维网格数据结构,针对二维网格数据结构各个行项提取关联参量,对关联参量实施线性组合操作,建立基础运行监测矩阵。
12、作为本发明的进一步方案,s2的具体步骤为:
13、s201:提取所述基础运行监测矩阵内部左侧垂直高度参量以及右侧垂直高度参量,针对左侧垂直高度参量以及右侧垂直高度参量对应执行相减差值运算,获取左纵变化量参量以及右纵变化量参量,将左纵变化量参量以及右纵变化量参量依据底层时间戳执行序列化对齐操作,得到双侧纵向位移偏差量;
14、s202:基于所述双侧纵向位移偏差量,提取内部各项数值参量执行中位分布运算转换得出全局俯仰位移量,同步采集底层前横向跨度参数以及后横向跨度参数,针对前横向跨度参数以及后横向跨度参数执行差值计算获取横向变化量集合,将全局俯仰位移量与横向变化量集合按照多维空间坐标映射节点执行关联融合,生成位姿横纵演变量;
15、s203:针对所述位姿横纵演变量,提取内置横向变化量集合关联参数,针对横向变化量集合关联参数实施序列中值解析换算得出全局侧倾位移参量,将全局侧倾位移参量与位姿横纵演变量内部全局俯仰位移量执行矩阵拼接计算,构建多自由度空间特征张量,对多自由度空间特征张量内部数值域执行归一化调整,得到空间姿态偏移分量。
16、作为本发明的进一步方案,s3的具体步骤为:
17、s301:根据所述空间姿态偏移分量,提取驱动电路关联实时相电流参量序列以及转速脉冲参量序列,针对相电流参量序列内部相邻时序节点数值执行相减差值运算获取电流变动量,针对转速脉冲参量序列内部节点数值实施相减差值计算得出转速变动量,将电流变动量与转速变动量依照底层时间戳序列节点实施拼接整合排列,建立机电参数波动集合;
18、s302:调用所述机电参数波动集合,提取内部各项电流变动量以及转速变动量参量,将各项电流变动量以及转速变动量参量分别与电流及转速分别对应的电流越界基准值和转速越界基准值实施数值比对操作,筛选双端超越状态越界基准值对应同步越界情形参量,针对同步越界情形参量对应电流变动量与转速变动量执行比例除法换算得出对应阻尼系数参数数值,得到同步越界阻尼量;
19、s303:针对所述同步越界阻尼量,在前期比对操作环节提取未超越状态越界基准值对应未越界情形阻尼参量,将未越界情形阻尼参量内部各项数值强制重置清零调整至初始原点状态特征量,提取上述原点状态特征量与同步越界阻尼量依照底层时间序列索引节点实施级联整合拼装,生成动态阻力调整记录。
20、作为本发明的进一步方案,提取电流及转速分别对应的电流越界基准值和转速越界基准值关联的电流越界阈值以及转速越界阈值;
21、判定各项电流变动量的绝对数值大于电流越界阈值,且判定处于同一底层时间戳序列节点的转速变动量参量的绝对数值大于转速越界阈值,将处于同一底层时间戳序列节点的各项电流变动量与转速变动量参量合并为双端超越状态越界基准值对应同步越界情形参量。
22、作为本发明的进一步方案,s4的具体步骤为:
23、s401:调用所述动态阻力调整记录,提取各项阻力特征参量,针对阻力特征参量执行特征映射换算获取侧倾补偿数值,同步提取底层转速差值参量,结合阻力特征参量与转速差值参量实施乘法计算得出打滑补偿量,将侧倾补偿数值与打滑补偿量依据空间坐标系节点执行序列化拼接排列,生成多维运动补偿分量;
24、s402:基于所述多维运动补偿分量,提取内置侧倾补偿数值与打滑补偿量,对侧倾补偿数值与打滑补偿量实施空间距离映射转换后执行累加计算,获取空间位置偏移数值,将空间位置偏移数值与基准平衡点坐标参量实施差值运算,依据差值运算所得偏差量提取底层质心位移向量,对各项质心位移向量实施序列对齐整合与拼接融合,建立质心偏移参量;
25、s403:针对所述质心偏移参量,采集配重滑块关联实时位置坐标数据,将实时位置坐标数据与质心偏移参量映射至底层坐标系实施空间距离比较计算,根据距离比较运算结果获取偏差距离参量,提取偏差距离参量内部横向维度向量特征,对横向维度向量特征施加逆向变换操作,转换为底层控制信号数据流并执行阵列编码排布,获取横向质心纠偏指令。
26、作为本发明的进一步方案,将空间位置偏移数值与基准平衡点坐标参量实施差值运算,依据差值运算所得偏差量提取底层质心位移向量的过程具体为:
27、针对空间位置偏移数值内部各项提取数值与基准平衡点坐标参量内部对应的基准数值执行相减操作,生成偏差量;
28、提取偏差量内部的横向特征偏差数值与纵向特征偏差数值,将横向特征偏差数值与纵向特征偏差数值合并排列,生成二维平移矩阵参数,将二维平移矩阵参数设定为底层质心位移向量。
29、作为本发明的进一步方案,s5的具体步骤为:
30、s501:调用所述横向质心纠偏指令,提取牵引特征参量,针对牵引特征参量实施矩阵换算获取基础扭矩数值,同步提取阻力特征参量,结合阻力特征参量与牵引特征参量执行加权换算得出动态扭矩数值,对基础扭矩数值与动态扭矩数值依照时间戳实施对齐与数值累加计算得出总扭矩参量,建立综合扭矩数据阵列;
31、s502:基于所述综合扭矩数据阵列,提取底层轮组转速脉冲方向符号参量,将方向符号参量与预设零点参量实施比对操作,依据比对差值正负属性设定布尔值参数,将布尔值参数与综合扭矩数据阵列总扭矩参量执行序列绑定关联,构建状态标识序列,针对状态标识序列内置项实施分类重组排布,获取转速变动标记集合;
32、s503:针对所述转速变动标记集合,提取内置布尔值参数进行逻辑判定,筛选布尔值参数内正向标记参量提取对应总扭矩参量赋予右侧驱动轮硬件控制地址,同步筛选负向标记参量提取关联总扭矩参量映射至左侧驱动轮硬件控制地址,对硬件控制地址输入指令进行电平编码转换操作,生成动力修正信号。
33、适用于复杂地形的割草机器人平稳行走控制系统,包括:
34、运行参量监测模块,采集割草机器人底盘左前与右前距离传感器前侧垂直距离尺度,同步获取后侧垂直距离尺度,分析左侧与右侧驱动轮电机内部编码器转速脉冲频次,计算电机驱动电路左侧与右侧实时相电流幅度,建立基础运行监测矩阵;
35、空间姿态解算模块,调用所述基础运行监测矩阵,分别计算左侧、右侧垂直高度相减产生左纵变化量和右纵变化量,分析纵向变化量中位换算得出全局俯仰位移量,计算前横变化量和后横变化量,分析横向变化量中位换算得出全局侧倾位移量,生成空间姿态偏移分量;
36、动态阻力映射模块,根据所述空间姿态偏移分量,计算相电流相减产生电流变动量,分析转速脉冲相减产生转速变动量,引入阻尼量纲转换系数,计算同步越界情形电流与转速变动比例并结合所述转换系数得出阻尼量,调整未越界情形阻尼量至原点状态,建立动态阻力调整记录;
37、质心偏移纠正模块,调用所述动态阻力调整记录,计算侧倾补偿和打滑补偿量,对各项补偿进行空间映射换算后相加得出质心偏移量,比较配重滑块实时位置坐标,获取横向质心纠偏指令;
38、扭矩重构控制模块,采用所述横向质心纠偏指令,计算基础扭矩和动态扭矩,将基础扭矩和动态扭矩相加得出总扭矩,基于前述转速变动量生成转速变动标记并进行判断,筛选正向标记锁定右侧驱动轮,筛选负向标记锁定左侧驱动轮,生成动力修正信号。
39、与现有技术相比,本发明的优点和积极效果在于:
40、本发明中,通过同步采集多维度垂直距离尺度与底层机电运行特征构建基础监测矩阵,将离散高度变量融合转换为全局空间姿态偏移分量进行闭环跟踪,结合电流与转速的双重变动比例建立动态阻力调节映射以替代生硬断电干涉,进一步获取横向质心纠偏向量执行配重坐标靶向平移从而消除物理重心失衡,同步生成包含基础与动态属性的非对称扭矩补偿参数,精准锁定两侧驱动轮施加异构动力修正信号,彻底规避复杂地形下的牵引力单侧流失与补偿延迟情况,保障设备在崎岖表面维持稳定贴合行驶与轨迹精准延续。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com