[发明专利]一种机器人电机动态调速规则及其在线求解方法及系统

说明书

本发明涉及一种机器人电机动态调速规则及其在线求解方法及系统，包括以下步骤：S10、以存储轨迹插补数据dn，S20、实时获取当前的调整倍率rate；S30、判断调整倍率rate是否发生改变，若发生变化，对缓存的轨迹插补数据进行修正并判断电机是否处于换向节点；S40、在当前插补周期下，令插补目标值Jtarget＝d0并下发至电机，重新执行步骤S20；S50、此时电机并未进行换向，计算当前插补目标值Jtarget；S60、判断插补目标值Jtarget是否在[d0,d1]区间内，如果在区间内，则向缓存头部获取新插补数据d2并进行更新发送至电机端，如果不在则直接将，插补目标值Jtarget发送至电机端，并返回步骤S10直至轨迹插补数据dn全部修正结束。本发明可以实现对复杂轨迹速度的实时调整。

技术领域

本发明涉及机器人技术领域，尤其涉及一种机器人电机动态调速规则及其在线求解方法。

背景技术

机器人运动过程中平顺性与快速性是衡量其运动控制能力的重要指标。在现有机器人控制中，当需要以不同的速度执行示教轨迹时，一般通过修改示教轨迹的设定速度来改变轨迹的运行速度。而对于工序轨迹繁多的复杂作业而言，每次变更轨迹速度时，操作人员都需要重新修改每条轨迹的速度设定值，这就显得非常繁琐，同时容易出错，极大的影响了工作效率和机器人作业质量。

专利申请号为201210224099的中国发明专利公开了一种进给速度实时修调方法，该方法每次调速时都需要重新检测当前点的加减速状态，根据不同的公式对后续的速度曲线进行重新规划，逻辑复杂且计算量大，且该专利主要针对的是数控机床加工领域中的进给速度调节。而在机器人控制领域中，其运动轨迹通常采用S型速度规划或者更高阶的速度规划方法，若采用重新规划则求解过程复杂，计算量较大，无法高效执行机器人电机的动态调速。

发明内容

本发明所要解决的技术问题在于提供一种机器人电机动态调速规则及其在线求解方法，以解决每次变更轨迹速度时，操作人员都需要重新修改每条轨迹的速度设定值而导致过程繁琐的问题。

本发明通过以下技术手段实现解决上述技术问题的：

一种机器人电机动态调速规则及其在线求解方法，包括以下步骤：

S10、建立缓存区，以存储轨迹插补数据dn，其中n为自然数；

S20、实时获取当前的调整倍率rate；

S30、判断调整倍率rate是否发生改变，若发生变化，对缓存的轨迹插补数据进行修正并判断电机是否处于换向节点，若是，执行步骤S40，若否，执行步骤S50；

S40、在当前插补周期下，令插补目标值Jtarget＝d0并下发至电机，重新执行步骤S20；若当前插补周期处于换向后的第一个插补周期，则进行步骤S50；

S50、此时电机并未进行换向，计算当前插补目标值Jtarget；

S60、判断插补目标值Jtarget是否在[d0,d1]区间内，如果在区间内，则向缓存头部获取新插补数据d2并进行更新发送至电机端，如果不在则直接将，插补目标值Jtarget发送至电机端，并返回步骤S10直至轨迹插补数据dn全部修正结束。

通过实时获取当前的调整倍率rate并判断其是否发生变化，通过在当前插补周期下，令插补目标值Jtarget＝d0并下发至电机，若当前插补周期处于换向后的第一个插补周期，计算当前插补目标值Jtarget，并判断插补目标值Jtarget是否在[d0,d1]区间内，如果在区间内，则向缓存头部获取新插补数据d2并进行更新发送至电机端，依次类推实现将存储的存储轨迹插补数据dn进行全部修正，从而实现对复杂轨迹速度的实时调整。

作为本发明进一步的方案：所述步骤S1包括：

S11、获取每次缓存的头部轨迹插补数据d0，初始化插补目标值Jtarget＝d0，并获取下一个轨迹插补数据d1进行存储；