机器人轨迹的规划方法、装置及机器人与流程
本申请涉及机器人运动控制,尤其涉及一种机器人轨迹的规划方法、装置及机器人。
背景技术:
1、轨迹规划技术是决定机器人作业性能的核心环节之一。现有机器人轨迹规划技术通常追求两个主要目标,即时间最优和运动平滑。
2、时间最优轨迹旨在使机器人以最短的时间完成从起点到终点的运动过程。该目标能够有效缩短机器人的节拍时间,提高生产线的吞吐效率,尤其适用于点焊、搬运、码垛等对循环时间要求较高的应用场景。运动平滑轨迹则关注机器人运动过程中的加速度和加加速度变化情况,通过限制加速度的突变和加加速度的幅值来降低机械系统的冲击和抖动,从而延长机器人及其零部件的使用寿命,同时为高精度应用如精密装配、打磨抛光等提供稳定的运动基础。
3、然而,时间最优与运动平滑这两个目标在本质上存在一定的矛盾关系。时间最优轨迹要求机器人尽量以最大能力加速和减速,频繁在约束边界上运行,容易导致加速度和加加速度出现较大变化甚至突变。运动平滑轨迹则要求加速度连续变化且加加速度受限,这往往需要延长加减速过程的时间,从而在一定程度上牺牲了运动效率。两者之间的这种制约关系给轨迹规划算法的设计带来了挑战,现有方法在同时满足两个目标时仍存在诸多不足。
技术实现思路
1、本申请实施例提供了一种机器人轨迹的规划方法、机器人轨迹的规划装置及机器人,可以解决现有技术中轨迹规划方法难以在满足加加速度等高阶平滑约束的同时兼顾时间最优性与实时计算效率的问题。所述技术方案如下:
2、第一方面,本申请实施例提供了一种机器人轨迹的规划方法,所述方法包括:
3、获取离散路径点、运动学约束和平滑参数;
4、根据所述离散路径点和所述平滑参数,生成由线性插值段与局部平滑段交替拼接构成的以路径参数为自变量的分段路径函数;
5、根据所述分段路径函数的三阶连续性,计算所述分段路径函数关于所述路径参数的一阶导数向量、二阶导数向量和三阶导数向量;
6、根据各阶导数向量,将所述运动学约束转换至所述路径参数空间,获得各线性插值段和各局部平滑段对应的最大路径速度、最大路径加速度和最大路径加加速度,作为各路径段在所述路径参数空间内的约束;
7、根据所述分段路径函数中各路径段的长度和所述路径参数空间内的约束,执行前向速度递推和后向速度递推,并使相邻路径段端点处的速度连续,确定各路径段端点的最大可行速度;
8、设定线性插值段在起始端点和终止端点处的加速度为零,根据各路径段端点的最大可行速度,对线性插值段和局部平滑段分别进行时间参数化,得到各路径段的局部时间参数化函数;
9、将各所述局部时间参数化函数按时序组合,得到全局时间参数化函数,并根据所述全局时间参数化函数和所述分段路径函数,生成最终轨迹。
10、第二方面,本申请实施例提供一种计算机存储介质,所述计算机存储介质存储有多条指令,所述指令适于由处理器加载并执行上述的方法步骤。
11、第三方面,本申请实施例提供一种机器人轨迹的规划装置,可包括:处理器和存储器;其中,所述存储器存储有计算机程序,所述计算机程序适于由所述处理器加载并执行上述的方法步骤。
12、本申请一些实施例提供的技术方案带来的有益效果至少包括:
13、本申请通过构造三阶连续的分段路径函数,消除了路径在拐点处的曲率突变,降低了机械系统产生柔性冲击的可能。在路径生成阶段,分段路径函数中的路径段数量与离散路径点数量相关,假设离散路径点数量为n,无需对路径进行密集采样即可完成后续规划,有效减少了计算量。针对路径长度占比很小的局部平滑段采用匀速速度曲线进行时间参数化,使得前后向传播过程中各路径段端点的最大可行路径速度具有解析表达式,可快速求解,有效提高计算效率。通过前向速度递推和后向速度递推求取各路径段端点的最大可行速度,各端点速度取前向结果、后向结果与局部平滑段自身约束的最小值,确保整条轨迹在满足所有运动学约束的同时接近时间最优。本申请可以兼顾运动平滑与时间效率,有助于解决现有技术中两者难以协调的问题,且计算效率满足工业机器人实时在线规划的需求。
1.一种机器人轨迹的规划方法,其特征在于,包括:
2.根据权利要求1所述的方法,其特征在于,所述根据所述离散路径点和所述平滑参数,生成由线性插值段与局部平滑段交替拼接构成的以路径参数为自变量的分段路径函数,包括:
3.根据权利要求2所述的方法,其特征在于,所述过渡曲线为五阶贝塞尔曲线;
4.根据权利要求1所述的方法,其特征在于,所述根据所述各阶导数向量,将所述运动学约束转换至所述路径参数空间,获得各线性插值段和各局部平滑段对应的最大路径速度、最大路径加速度和最大路径加加速度,作为各路径段在所述路径参数空间内的约束,包括:
5.根据权利要求1所述的方法,其特征在于,所述根据所述分段路径函数中各路径段的长度和所述路径参数空间内的约束,执行前向速度递推和后向速度递推,并使相邻路径段端点处的速度连续,确定各路径段端点的最大可行速度,包括:
6.根据权利要求1所述的方法,其特征在于,所述线性插值段的时间参数化是基于双s型速度曲线执行的,所述局部平滑段的时间参数化是基于匀速速度曲线执行的。
7.根据权利要求6所述的方法,其特征在于,所述设定所述线性插值段在起始端点和终止端点处的加速度为零,根据所述各路径段端点的最大可行速度,对所述线性插值段和所述局部平滑段分别进行时间参数化,得到各路径段的局部时间参数化函数,包括:
8.根据权利要求1所述的方法,其特征在于,所述将各所述局部时间参数化函数按时序组合,得到全局时间参数化函数,并根据所述全局时间参数化函数和所述分段路径函数,生成最终轨迹,包括:
9.根据权利要求1所述的方法,其特征在于,在生成所述最终轨迹之后,所述方法还包括:
10.一种机器人轨迹的规划装置,其特征在于,包括:处理器和存储器;其中,所述存储器存储有计算机程序,所述计算机程序适于由所述处理器加载并执行如权利要求1至9任意一项所述的机器人轨迹的规划方法的步骤。
11.一种机器人,其特征在于,包括:如权利要求10所述的机器人轨迹的规划装置。
版权声明:本站专利文献数据主要来源于国家知识产权局等公开渠道,由 技术新讯 进行整理汇编。页面设计及数据汇编的著作权归本站所有。全部内容仅供个人学习、科研评估与技术交流参考,严禁用于任何商业用途(包括但不限于直接生产制造、技术转让、倒卖数据等)。
免责条款:专利技术具有时效性,本站不对资料的绝对准确性、完整性和可实施性提供任何明示或暗示的担保。因参考本站内容造成的直接或间接损失,本站不承担相关法律责任。若您认为本站内容有侵权问题,请及时提供权属证明与我们联系,本站将在核实后依法处理。反馈意见:yyfuon@163.com