[发明专利]控制机器人转动关节运动的方法和装置及机器人

说明书

本发明公开了一种控制机器人转动关节的方法，包括：接收用于控制机器人转动关节进行轨迹运动的轨迹参数集；对于每一个匀速运动速度，控制机器人转动关节进行与匀速运动速度对应的轨迹运动，并在轨迹运动的匀速运动阶段中读取机器人的驱动电机的驱动力矩作测量摩擦力矩；根据每一个匀速运动速度和该匀速运动速度对应的测量摩擦力矩，构建动态摩擦模型；当接收到控制机器人工作的请求时，根据动态摩擦模型修正由请求生成的驱动力矩，以根据修正后的驱动力矩转动关节进行运动。本发明还公开了一种控制机器人转动关节的装置和一种机器人。采用本发明实施例，能够减少机器人辨识摩擦力的误差，提高控制机器人转动关节的准确性。

技术领域

本发明涉及机器人控制技术领域，尤其涉及一种控制机器人转动关节运动的方法和装置及机器人。

背景技术

基于动力学的控制能够有效的提高机器人的控制性能，在使用基于动力学模型的控制算法时，首先要保证动力学模型的准确性，动力学模型的准确性依赖于几何参数和动力学参数，几何参数可以通过运动学标定获得，动力学参数要通过模型辨识的方法来估测。

通常的工业机器人动力学模型参数辨识方案，是采用整体辨识的方案，即构建动力学模型参数的最小集合，通过设计激励轨迹，测量得到机器人运动和力矩的数据，最后应用合适的估计算法来得到未知的动力学参数。然而进行辨识时测量的随机误差较大，会造成模型参数辨识的不准确，因此在整体参数辨识之前，将部分辨识的参数进行初步的确定，例如摩擦力的模型的参数，有助于提高模型参数辨识的准确性，尤其是在低速阶段，机器人的驱动电机的主要驱动力矩用于抵消关节的摩擦力矩，所以在进行机器人动力学模型参数辨识之前，先单独的对关节的摩擦模型参数进行辨识，对于提高辨识的准确性很有帮助。一般地，在进行关节的摩擦模型参数辨识时，采取三角波形的位置随时间变化的曲线来使得机器人以恒定速度运行，但是三角波形位置随时间变化曲线的速度随时间变化曲线为脉冲波形，则在机器人运动时会造成机器人的振动，会进而影响测量到的摩擦力矩的结果，造成关节的摩擦模型参数辨识的不准确，即构建成的摩擦模型不准确，进而影响了控制机器人转动关节来进行运动的准确性。

发明内容

本发明实施例提出的一种控制机器人转动关节运动的方法和装置以及机器人，能够减少机器人辨识摩擦力的误差，提高控制机器人转动关节的准确性。

本发明实施例第一方面提供了一种控制机器人转动关节的方法，包括：

接收用于控制机器人转动关节进行轨迹运动的轨迹参数集；所述轨迹参数集包括每一个轨迹运动的匀速运动阶段的匀速运动速度；

对于所述轨迹参数集的每一个匀速运动速度，控制所述机器人转动关节进行与所述匀速运动速度对应的轨迹运动，并在所述轨迹运动的匀速运动阶段中读取所述机器人的驱动电机的驱动力矩；所述驱动力矩用于作为所述机器人在以所述匀速运动速度进行瞬时运动的测量摩擦力矩；所述轨迹运动包括以第一加速度加速至所述匀速运动速度进行的加速运动和在所述加速运动之后以所述匀速运动速度进行的匀速运动；

根据所述轨迹参数集的每一个匀速运动速度和该匀速运动速度对应的测量摩擦力矩，构建摩擦力矩随速度变化的动态摩擦模型；

当接收到控制所述机器人工作的请求时，根据所述动态摩擦模型修正由所述请求生成的驱动力矩，以使所述机器人根据修正后的驱动力矩转动关节进行运动。

在第一方面的第一种可能的实现方式中，所述轨迹运动还包括以第二加速度从所述匀速运动速度减速至静止的减速运动。

结合第一方面的第一种可能的实现方式，在第二种可能的实现方式中，所述轨迹参数集还包括每一个轨迹运动的起始位置、终点位置和运动时长；所述第一加速度的大小与所述第二加速度的大小相同；

则，所述在所述轨迹运动的匀速运动阶段中读取所述机器人的驱动电机的驱动力矩，具体为：