一种兼顾平稳与精度的工业移动机器人速度规划方法与流程
本技术涉及自主移动机器人领域,特别涉及一种兼顾平稳与精度的工业移动机器人速度规划方法。
背景技术:
1、随着智能制造和智慧物流的快速发展,工业移动机器人(agv/amr)被广泛应用于自动化工厂与仓库中,承担重载搬运、精密零件运输及自动化对接等任务。在这些应用场景中,速度规划作为移动机器人导航系统的核心模块,直接决定了其运行效率、运输安全性以及末端停靠精度。
2、通常,移动机器人的控制流程是先生成一条几何路径,再由速度规划器根据机器人的动力学性能(如最大速度、加速度、加加速度)在该路径上分配时间戳。理想的速度规划方案不仅需要充分发挥底盘驱动电机的物理性能以提升效率,更需要确保在搬运高重心或易碎货物时,加速度变化足够平顺,以防止货物滑移或倾倒。同时,在进入充电桩或货架下方时,机器人必须具备极高的停准精度,避免末端冲击或位置超调。
3、尽管现有的速度规划算法(如传统 s 曲线、梯形剖面规划等)在一定程度上能满足移动机器人的运动需求,但在复杂的工业应用环境下仍存在以下显著缺点:
4、1、物理约束建模过于简化,忽略底盘几何特性:现有的主流算法往往将机器人简化为质点模型,仅限制中心点的线速度和加速度。这种做法忽略了底盘轴距、轮距等结构参数对驱动轮速的影响。在窄半径转弯等工况下,外侧驱动轮可能已经达到转速极限,而中心点计算值仍显示正常,导致电机因过载而丢步、报错或轨迹跟踪失败。
5、2、安全性与平滑度难以兼顾:传统算法在对限速剖面进行平滑处理(如高斯滤波或均值滤波)时,往往会因数学平滑效应抬高局部限速值,导致规划出的速度在某些位置超过了原始的安全物理上限。若为保证安全而简单降低全局限速,又会大幅牺牲运输效率。
6、3、时间域规划导致运动控制不连续 多数现有技术在时间域进行规划。当机器人速度大幅波动时,固定的采样时间间隔会导致空间上的位移步长极不均匀。这使得对加速度和加加速度(jerk)的抑制在空间分布上是不一致的,尤其在低速启动和减速段,容易产生明显的机械冲击。
7、4、末端停车阶段存在动力学突变:现有的减速控制策略(如线性减速)在到达终点瞬时,其加速度往往无法自然收敛至零。这种加速度的阶跃突变会产生明显的“停点震荡”或“点头”现象,导致末端对位精度下降,无法满足毫米级准停的需求。
8、5、数值积分累计偏差与点密度失衡:在将速度剖面转化为时间轨迹时,传统的欧拉积分法存在明显的累计误差,导致实际行驶距离与规划路径长度不符。此外,现有方法在处理低速区时,轨迹点密度往往过稀或过密,导致底层伺服驱动系统接收到的指令频率不稳定,进而引发电机震动或控制超调。。
技术实现思路
1、基于上述技术问题,本技术实施例提供了一种兼顾平稳与精度的工业移动机器人速度规划方法,包括:多维速度约束构建、空间域加速度闭环迭代、末端准停控制和轨迹时间化与密度调节;通过在空间域和速度平方域进行多维约束下的迭代优化,实现在复杂工业场景下的平稳运输与高精度准停控制;
2、所述多维速度约束构建为,为路径上每个采样点建立上限,为每个点计算允许的最大速度上限;
3、所述空间域加速度闭环迭代为,在满足速度约束的基础上,在空间域对速度曲线进行闭环优化,抑制过程中的加加速度变化;
4、所述末端准停控制为,在距离终点的预设范围内,进行准停控制,避免在停车瞬间因加速度不归零导致的机械冲击;
5、所述轨迹时间化与密度调节为,将规划好的空间剖面以全局稀疏化抽稀、末端局部细化补点的策略转化为 plc 或驱动器可执行的带时间戳指令流。
6、所述多维速度约束构建包括:
7、底盘动力学极限构建:根据底盘几何参数、路径曲率和驱动轮旋转极限,投影为中心点限速,外侧轮修正因子为:
8、
9、其中,为路径曲率,为轴距,为轮距,
10、将驱动轮极限 除以,得到中心点的实时速度上限:
11、
12、分段区域限速与过渡平滑:针对仓库内不同区域设置的限速,在限速切换点前后设定过渡长度,在过渡长度内使用平滑函数进行软过渡,从而在的基础上,得到每个点的原始限速值;
13、保守型剖面预处理:在每一个采样点处,以采样点为中心,半径为窗口,计算所有原始限速值的算术平均值:
14、
15、取和的最小值作为最终约束速度:
16、。
17、所述空间域加速度闭环迭代包括,在满足速度约束的基础上,在空间域对速度曲线进行闭环优化,抑制过程中的加加速度变化,具体为:
18、前向加速传递:从起点开始,依据最大加速度限制,
19、
20、其中,是采样点i处加速度,是采样点i+1处速度,是采样点i处速度,
21、后向减速传递:从终点反向递推,依据最大减速度限约束前一点的速度,
22、
23、其中,是采样点i处减速度,
24、双向加加速度约束传播:通过多次往复检查相邻点的加速度差值,从而检测加加速度是否超过上限,其中,加加速度的计算公式为:
25、
26、其中可近似认为,其中是相邻两点间的平均速度,则可进一步推导出:
27、
28、若计算出的超过阈值,则强制压低该处的速度上限,满足加加速度限制,进而更新速度上限:
29、
30、
31、加速度域闭环优化迭代:从当前速度进行微分计算加速度:
32、
33、随后对加速度执行平滑滤波,从平滑后的加速度序列积分得到候选速度序列:
34、
35、引入欠松弛因子,将新生成的平滑速度与上一轮速度加权融合,通过多次闭环迭代逐步收敛至最优平滑曲线:
36、。
37、所述末端准停控制为,在距离终点的预设范围内,切换至精密停车逻辑,避免在停车瞬间因加速度不归零导致的机械冲击,包括:
38、定义归一化位移,其中为平滑段总长,为当前点位置,为平滑段起始位置;
39、构建多项式,其中:
40、
41、多项式需要执行下述约束进行求解:
42、起点位置速度匹配:
43、终点位置速度清零:
44、起点位置加速度匹配:
45、终点位置加速度清零:
46、起点位置相关项匹配:
47、终点位置 jerk 相关项清零:
48、满足上述关系可求解得到:
49、
50、
51、
52、
53、
54、
55、其中,、、、、、为五次多项式各项系数,为起点处速度,为起点处加速度,代表起点处,代表终点处。
56、所述轨迹时间化与密度调节中,所述的末端局部细化补点为,针对接近终点的减速段,检测相邻点间的弧长差,若弧长差超过预设阈值,则基于样条曲线和速度剖面进行二阶插值补点,确保机器人低速准停阶段的控制指令平顺且连续。
57、所述轨迹时间化与密度调节中,所述的全局稀疏化抽稀为,在整段轨迹中,根据配置的最小输出间距对轨迹点进行初次筛选,确保在高速段不输出冗余点。
58、所述轨迹时间化与密度调节中还包括,,采用四阶龙格库塔法进行数值积分,以消除由于速度大幅度变化导致的累计位移偏。
59、相比于现有技术,本发明通过底盘几何参数将中心点限速精确投影至驱动轮极限,既压榨了电机性能提升效率,又绝对保证不超载。
60、本发明引入“只减不增”的保守平滑算法,确保在提升速度连续性的同时,绝不突破任何预设的安全阈值。
61、本发明基于空间域的闭环迭代优化,使加加速度的抑制不再受线速度变化影响,实现了极致的运输平稳性。
62、本发明在速度平方域应用五次 hermite 插值,强制终点加速度与加加速度为零,实现了动力学连续性,消除了停车瞬间的物理冲击。
63、本发明采用四阶龙格库塔法配合自适应点密度调节,在降低控制器算力负担的同时,消除了累计位移偏差,保证了末端控制指令的平顺稳定。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com