[发明专利]机械臂速度控制方法、装置、计算机设备及存储介质

说明书

本发明涉及机械臂控制领域，公开了一种机械臂速度控制方法、装置、计算机设备及存储介质，该方法包括：获取当前时刻机器人末端法兰的实际位置，并根据所述机械臂的路径规划，获取下一时刻所述机械臂的末端法兰的期望位置；根据所述实际位置和所述期望位置以及预设的轨迹跟踪模型计算得到当前时刻所述机械臂的控制速度；对所述控制速度进行雅克比逆变换，得到相应的电机输出力，并根据所述电机输出力进行相应控制。可以通过速度控制的方式控制机械臂的运动，提高了控制速度以及实时性，并减少控制误差。

技术领域

本发明涉及机械臂控制领域，尤其涉及一种机械臂速度控制方法、装置、计算机设备及存储介质。

背景技术

在实际口腔种植机械臂项目临床过程中，机械臂涉及一般以位置控制为主，控制机械臂位置移动，以达到机械臂主动跟随病人移动，从而达到诸如随动钻孔，随动跟随目标点等功能。对于传统的pid控制，需要进行多个参数的人为整定，在调参过程中，会因为参数选择不合适，从而引起控制器的跟踪误差变大，照成控制效果不稳定；且一般的位置响应过慢，实时性较差，在实际临床过程中可能产生不良后果。

发明内容

第一方面，本申请提供一种机械臂速度控制方法，包括：

获取当前时刻机器人末端法兰的实际位置，并根据所述机械臂的路径规划，获取下一时刻所述机械臂的末端法兰的期望位置；

根据所述实际位置和所述期望位置以及预设的轨迹跟踪模型计算得到当前时刻所述机械臂的控制速度；

对所述控制速度进行雅克比逆变换，得到相应的电机输出力，并根据所述电机输出力进行相应控制。

进一步的，所述轨迹跟踪模型的建立方法包括：

获取所述机械臂的状态参数，建立跟踪误差方程，并根据所述状态参数，建立所述机械臂的运动方程；

根据李雅普诺夫稳定性判定条件，确定使得所述运动方程在所述跟踪误差方程收敛在0时的稳定条件，根据所述稳定条件，确定所述轨迹跟踪模型。

进一步的，所述获取所述机械臂的状态参数，包括：

确定所述状态参数是否有确切值；

若所述状态参数有确切值，则直接根据所述状态参数建立所述机械臂的运动方程；

若所述状态参数没有确切值，则建立所述状态参数的估计方程关系式，根据所述估计方程关系式，对所述状态参数进行参数化估计。

进一步的，所述估计方程关系式为：

式中，为估计误差，a为所述状态参数，为估计的状态参数，为所述估计误差对时间的导，为所述状态参数对时间的导数，为所述估计的状态参数对时间的导数。

进一步的，所述轨迹跟踪模型表达式为：

式中，u表示所述控制速度，为所述期望位置关于时间的导数，x为当前的位置，e为跟踪误差，K为通过整定得到的调节收敛速度的速度收敛参数。

进一步的，所述速度收敛参数的整定方法包括：

按照从小到大的顺序，将待整定的速度收敛参数输入所述跟踪模型中，并实时记录各个速度收敛参数对应的跟踪误差；

选取出使所述跟踪误差能够位于预设误差范围内的速度收敛参数区间作为整定后的速度收敛参数。

进一步的，所述获取当前时刻机器人末端法兰的实际位置，并根据所述机械臂的路径规划，获取下一时刻所述机械臂的末端法兰的期望位置，包括：