CN111216120B - 一种关节摩擦力力矩补偿方法、装置及机器人 - Google Patents

一种关节摩擦力力矩补偿方法、装置及机器人 Download PDF

Info

Publication number
CN111216120B
CN111216120B CN201911107603.0A CN201911107603A CN111216120B CN 111216120 B CN111216120 B CN 111216120B CN 201911107603 A CN201911107603 A CN 201911107603A CN 111216120 B CN111216120 B CN 111216120B
Authority
CN
China
Prior art keywords
joint
compensated
compensation
angular velocity
friction
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN201911107603.0A
Other languages
English (en)
Other versions
CN111216120A (zh
Inventor
夏一蕃
娄威
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Aubo Beijing Intelligent Technology Co ltd
Original Assignee
Aubo Beijing Intelligent Technology Co ltd
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Aubo Beijing Intelligent Technology Co ltd filed Critical Aubo Beijing Intelligent Technology Co ltd
Priority to CN201911107603.0A priority Critical patent/CN111216120B/zh
Publication of CN111216120A publication Critical patent/CN111216120A/zh
Application granted granted Critical
Publication of CN111216120B publication Critical patent/CN111216120B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • B—PERFORMING OPERATIONS; TRANSPORTING
    • B25—HAND TOOLS; PORTABLE POWER-DRIVEN TOOLS; MANIPULATORS
    • B25J—MANIPULATORS; CHAMBERS PROVIDED WITH MANIPULATION DEVICES
    • B25J9/00—Programme-controlled manipulators
    • B25J9/16—Programme controls
    • B25J9/1628—Programme controls characterised by the control loop
    • B25J9/1641—Programme controls characterised by the control loop compensation for backlash, friction, compliance, elasticity in the joints

Landscapes

  • Engineering & Computer Science (AREA)
  • Robotics (AREA)
  • Mechanical Engineering (AREA)
  • Manipulator (AREA)

Abstract

本发明实施例提供了一种关节摩擦力力矩补偿方法、装置及机器人，其中，该方法包括：获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。可以使得该待补偿关节在不同的运动速度时，可以采用不同的补偿电流对该待补偿关节进行摩擦力力矩补偿，从而避免采用相同的补偿电流对不同运动速度的待补偿关节进行摩擦力力矩补偿，提高对关节进行摩擦力力矩补偿的准确度，进而提高对机器人的操作灵活性。

Description

一种关节摩擦力力矩补偿方法、装置及机器人
技术领域
本发明涉及机器人技术领域，特别是涉及一种关节摩擦力力矩补偿方法、装置及机器人。
背景技术
机器人的广泛应用，为工业生产带来了极大的便利，在工业生产中应用机器人时，通常会先采用机器人示教技术对机器人进行拖动示教，以使得机器人能够在复杂的工作场景下完成工作任务，有效的提高工作质量以及工作效率。
在拖动示教的过程中，由于机器人的机械臂受到重力影响，以及连接该机械臂的关节受到摩擦力的影响，使得对机器人的拖动比较困难，因此，需要对机器人关节进行重力力矩和摩擦力力矩补偿，以使得操作者能够轻松的拖动机器人进行拖动示教。
然而，在现有技术中，并未考虑关节运动速度对关节摩擦力力矩的影响，例如，关节运动速度越高，关节的温度越高，关节处的润滑油等流体的粘度越小等对关节摩擦力力矩的补偿都会有较大影响。因此，如何在关节在不同运动速度时进行更准确的摩擦力力矩补偿，成为亟待解决的问题。
发明内容
本发明实施例的目的在于提供一种关节摩擦力力矩补偿方法、装置及机器人，以实现在关节处于不同运动速度时，采用不同的摩擦力力矩对关节进行摩擦力力矩补偿，提高对关节进行摩擦力力矩补偿的准确度。具体技术方案如下：
第一方面，本发明实施例提供了一种关节摩擦力力矩补偿方法，应用于机器人，机器人包括多个关节，各个关节分别安装有电机；该方法包括：
获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；
基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
可选的，各个关节处还分别安装有温度传感器，获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，包括：
获取待补偿关节处的角速度和温度；
基于角速度和温度，采用与温度对应的摩擦力力矩模型，计算待补偿关节处的摩擦力力矩的补偿电流。
可选的，基于角速度和温度，采用与温度对应的摩擦力力矩模型，计算待补偿关节处的摩擦力力矩的补偿电流，包括：
在温度t小于预设第一温度阈值T1时，基于角速度
Figure BDA0002271775880000021
和温度t，采用公式(1)：
Figure BDA0002271775880000022
计算待补偿关节处的摩擦力力矩的补偿电流I；
在温度t大于或等于预设第一温度阈值T1，且小于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000023
和温度t，采用公式(2)：
Figure BDA0002271775880000024
计算待补偿关节处的摩擦力力矩的补偿电流I；
在温度t大于或等于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000025
和温度t，采用公式(3)：
Figure BDA0002271775880000026
计算待补偿关节处的摩擦力力矩的补偿电流I；
其中，J为待补偿关节的转动惯量，α为待补偿关节的角加速度，TC为库伦摩擦系数，
Figure BDA0002271775880000027
为温度t小于预设第一温度阈值T1时的第一粘滞摩擦系数，
Figure BDA0002271775880000028
为温度t大于或等于预设第一温度阈值T1且小于预设第二温度阈值T2时的第二粘滞摩擦系数，
Figure BDA0002271775880000029
为温度t大于或等于预设第二温度阈值T2时的第三粘滞摩擦系数，
Figure BDA00022717758800000210
为关于角速度的符号函数，β1为温度t小于预设第一温度阈值T1时的第一润滑剂粘度系数，β2为温度t大于或等于预设第一温度阈值T1且小于预设第二温度阈值T2时的第二润滑剂粘度系数，β3为温度t大于或等于预设第二温度阈值T2时的第三润滑剂粘度系数。
可选的，获取摩擦力力矩模型中的待补偿关节的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000031
第二粘滞摩擦系数
Figure BDA0002271775880000032
第三粘滞摩擦系数
Figure BDA0002271775880000033
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3的步骤包括：
获取不同测试温度时待补偿关节的测试角速度、测试角加速度以及对待补偿关节进行补偿的测试补偿电流，其中，每个测试温度对应一个测试角速度、一个测试角加速度以及一个测试补偿电流；
基于多个测试温度以及对应的测试角速度、测试角加速度以及测试补偿电流，采用公式(4)：
Figure BDA0002271775880000034
计算摩擦力力矩模型中的待补偿关节的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000035
第二粘滞摩擦系数
Figure BDA0002271775880000036
第三粘滞摩擦系数
Figure BDA0002271775880000037
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3。
可选的，各个关节处还分别安装有角度传感器，在获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流之前，该关节摩擦力力矩补偿方法，还包括：
获取待补偿关节的角度传感器在两个连续采样周期采集的两个角度值；
判断两个角度值的差值是否大于或等于预设角度改变阈值；
在两个角度值的差值大于或等于预设角度改变阈值时，执行获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流的步骤；
在两个角度值的差值小于预设角度改变阈值时，获取预设的震荡激励电流值，并控制待补偿关节的电机采用预设的震荡激励电流值，对待补偿关节进行电流激励。
可选的，在基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流之前，该关节摩擦力力矩补偿方法还包括：
基于角速度
Figure BDA0002271775880000038
采用公式(5)：
Figure BDA0002271775880000041
计算与角速度
Figure BDA0002271775880000042
对应的摩擦力力矩补偿系数co，其中，comin为预设最小摩擦力力矩补偿系数，
Figure BDA0002271775880000043
预设最大停止角速度阈值，
Figure BDA0002271775880000044
为预设最小停止角速度阈值，
Figure BDA0002271775880000045
为角速度的绝对值。
可选的，基于角速度
Figure BDA0002271775880000046
采用公式(5)：计算与角速度
Figure BDA0002271775880000047
对应的摩擦力力矩补偿系数co，包括：
在角速度的绝对值
Figure BDA0002271775880000048
小于或等于预设最小停止角速度阈值
Figure BDA0002271775880000049
时，获取待补偿关节的角加速度；
判断角加速度是否小于预设角加速度阈值；
在角加速度小于预设角加速度阈值时，基于角速度
Figure BDA00022717758800000410
采用公式(5)：
Figure BDA00022717758800000411
计算与角速度
Figure BDA00022717758800000412
对应的摩擦力力矩补偿系数co；
在角加速度大于或等于预设角加速度阈值时，确定与角速度对应的摩擦力力矩补偿系数为1。
第二方面，本发明实施例还提供了一种关节摩擦力力矩补偿装置，应用于机器人，机器人包括多个关节，各个关节处分别安装有电机；该装置包括：
获取模块，用于获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；
补偿电流调整模块，用于基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
控制模块，用于控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
可选的，各个关节处还分别安装有温度传感器，获取模块，具体用于：
获取待补偿关节处的角速度和温度；基于角速度和温度，采用与温度对应的摩擦力力矩模型，计算待补偿关节处的摩擦力力矩的补偿电流。
可选的，获取模块，具体用于：
在温度t小于预设第一温度阈值T1时，基于角速度
Figure BDA0002271775880000051
和温度t，采用公式(1)：
Figure BDA0002271775880000052
计算待补偿关节处的摩擦力力矩的补偿电流I；
在温度t大于或等于预设第一温度阈值T1，且小于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000053
和温度t，采用公式(2)：
Figure BDA0002271775880000054
计算待补偿关节处的摩擦力力矩的补偿电流I；
在温度t大于或等于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000055
和温度t，采用公式(3)：
Figure BDA0002271775880000056
计算待补偿关节处的摩擦力力矩的补偿电流I；
其中，J为待补偿关节的转动惯量，α为待补偿关节的角加速度，TC为库伦摩擦系数，
Figure BDA0002271775880000057
为温度t小于预设第一温度阈值T1时的第一粘滞摩擦系数，
Figure BDA0002271775880000058
为温度t大于或等于预设第一温度阈值T1且小于预设第二温度阈值T2时的第二粘滞摩擦系数，
Figure BDA0002271775880000059
为温度t大于或等于预设第二温度阈值T2时的第三粘滞摩擦系数，
Figure BDA00022717758800000510
为关于角速度的符号函数，β1为温度t小于预设第一温度阈值T1时的第一润滑剂粘度系数，β2为温度t大于或等于预设第一温度阈值T1且小于预设第二温度阈值T2时的第二润滑剂粘度系数，β3为温度t大于或等于预设第二温度阈值T2时的第三润滑剂粘度系数。
可选的，该摩擦力力矩补偿装置还包括：
测试数据获取模块，用于获取不同测试温度时待补偿关节的测试角速度、测试角加速度以及对待补偿关节进行补偿的测试补偿电流，其中，每个测试温度对应一个测试角速度、一个测试角加速度以及一个测试补偿电流；
参数计算模块，用于基于多个测试温度以及对应的测试角速度、测试角加速度以及测试补偿电流，采用公式(4)：
Figure BDA0002271775880000061
计算摩擦力力矩模型中的待补偿关节的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000062
第二粘滞摩擦系数
Figure BDA0002271775880000063
第三粘滞摩擦系数
Figure BDA0002271775880000064
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3。
可选的，各个关节处还分别安装有角度传感器，该摩擦力力矩补偿装置还包括：
角度值模块，用于获取待补偿关节的角度传感器在两个连续采样周期采集的两个角度值；
角度值判断模块，用于判断两个角度值的差值是否大于或等于预设角度改变阈值；在两个角度值的差值大于或等于预设角度改变阈值时，触发获取模块，在两个角度值的差值小于预设角度改变阈值时，触发震荡激励模块；
震荡激励模块，用于获取预设的震荡激励电流值，并控制待补偿关节的电机采用预设的震荡激励电流值，对待补偿关节进行电流激励。
可选的，该关节摩擦力力矩补偿装置，还包括：
补偿系数计算模块，用于基于角速度
Figure BDA0002271775880000065
采用公式(5)：
Figure BDA0002271775880000066
计算与角速度
Figure BDA0002271775880000067
对应的摩擦力力矩补偿系数co，其中，comin为预设最小摩擦力力矩补偿系数，
Figure BDA0002271775880000068
预设最大停止角速度阈值，
Figure BDA0002271775880000069
为预设最小停止角速度阈值，
Figure BDA00022717758800000610
为角速度的绝对值。
可选的，该关节摩擦力力矩补偿装置，还包括：
角加速度获取模块，用于在角速度的绝对值
Figure BDA00022717758800000611
小于或等于预设最小停止角速度阈值
Figure BDA00022717758800000612
时，获取待补偿关节的角加速度；
角加速度判断模块，用于判断角加速度是否小于预设角加速度阈值；在角加速度小于预设角加速度阈值时，触发补偿系数计算模块；在角加速度大于或等于预设角加速度阈值时，确定与角速度对应的摩擦力力矩补偿系数为1。
第三方面，本发明实施例还提供了一种机器人，该机器人包括：处理器和机器可读存储介质，机器可读存储介质存储有能够被处理器执行的机器可执行指令，处理器被机器可执行指令促使：实现上述第一方面的方法步骤。
本发明实施例提供的一种关节摩擦力力矩补偿方法、装置及机器人，可以先获取获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，然后基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；最后控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。这样，可以使得该待补偿关节在不同的运动速度时，可以采用不同的补偿电流对该待补偿关节进行摩擦力力矩补偿，从而避免采用相同的补偿电流对不同运动速度的待补偿关节进行摩擦力力矩补偿，提高对关节进行摩擦力力矩补偿的准确度，进而提高对机器人的操作灵活性。当然，实施本发明的任一产品或方法并不一定需要同时达到上述的所有优点。
附图说明
为了更清楚地说明本发明实施例或现有技术中的技术方案，下面将对实施例或现有技术描述中所需要使用的附图作简单地介绍，显而易见地，下面描述中的附图仅仅是本发明的一些实施例，对于本领域普通技术人员来讲，在不付出创造性劳动的前提下，还可以根据这些附图获得其他的附图。
图1为本发明实施例的一种关节摩擦力力矩补偿方法第一种实施方式的流程图；
图2为本发明实施例的一种关节摩擦力力矩补偿方法第二种实施方式的流程图；
图3为本发明实施例的一种关节摩擦力力矩补偿方法第三种实施方式的流程图；
图4为本发明实施例的一种关节摩擦力力矩补偿方法第四种实施方式的流程图；
图5a为本发明实施例的一种关节摩擦力力矩补偿方法中关节在25℃时的实际补偿电流与计算得到的补偿电流对比图；
图5b为本发明实施例的一种关节摩擦力力矩补偿方法中关节在35℃时的实际补偿电流与计算得到的补偿电流对比图；
图5c为本发明实施例的一种关节摩擦力力矩补偿方法中关节在40℃时的实际补偿电流与计算得到的补偿电流对比图；
图6为采用本发明实施例的一种关节摩擦力力矩补偿方法进行拖动示教时的时间-关节角度曲线图；
图7为本发明实施例的一种关节摩擦力力矩补偿装置的结构示意图；
图8为本发明实施例的一种机器人的结构示意图。
具体实施方式
下面将结合本发明实施例中的附图，对本发明实施例中的技术方案进行清楚、完整地描述，显然，所描述的实施例仅仅是本发明一部分实施例，而不是全部的实施例。基于本发明中的实施例，本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例，都属于本发明保护的范围。
为了解决现有技术存在的问题，本发明实施例提供了一种关节摩擦力力矩补偿方法、装置及机器人，以实现在关节处于不同运动速度时，采用不同的摩擦力力矩对关节进行摩擦力力矩补偿，提高对关节进行摩擦力力矩补偿的准确度。
下面，首先对本发明实施例的一种关节摩擦力力矩补偿方法进行介绍，如图1所示，为本发明实施例的一种关节摩擦力力矩补偿方法第一种实施方式的流程图，该方法可以应用于机器人，该机器人包括多个关节，各个关节分别安装有电机。参见图1，该方法可以包括：
S110，获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；
S120，基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
S130，控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
在一些示例中，在拖动示教过程中，也即，在机器人启动后，机器人的关节的速度往往会随着工作人员拖动速度的改变而改变，例如，机器人的关节的速度随工作人员拖动速度的增加而增加，机器人的关节的速度随工作人员拖动速度的减小而减小等。
因此，在改变机器人的关节的运动速度时，可以通过电机转速的改变来获取到该关节的角速度的改变，则可以将改变运动速度的至少一个关节中的任一个关节作为待补偿关节。
在又一些示例中，当该电机为该待补偿关节进行摩擦力力矩补偿时，通常会为该电机输入补偿电流，因此，可以获取到为该待补偿关节的电机输入的补偿电流。
在获取到角速度和补偿电流后，为了对该待补偿关节进行合适的摩擦力力矩补偿，可以对该补偿电流进行调节，然后采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
在一些示例中，待补偿关节的摩擦力力矩补偿系数通常是与该待补偿关节的运动速度是有关系的，因此，为了对该补偿电流进行合适的调整，可以基于该待补偿关节的角速度，采用与该角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流。
在一些示例中，该与待补偿关节的角速度对应的摩擦力力矩补偿系数可以是根据经验预先设置的系数，例如，可以分别为不同的角速度设置不同的摩擦力力矩补偿系数，这也是可以的。
在一些示例中，与该待补偿关节的角速度对应的摩擦力力矩补偿系数可以是预先设置好的，也可以是基于该待补偿关节的角速度计算得到的，例如，可以基于角速度
Figure BDA0002271775880000091
采用公式(5)：
Figure BDA0002271775880000092
计算与角速度
Figure BDA0002271775880000093
对应的摩擦力力矩补偿系数co，然后采用与计算得到的摩擦力力矩补偿系数对补偿电流进行调整，得到调整后的补偿电流。
其中，comin为预设最小摩擦力力矩补偿系数，
Figure BDA0002271775880000101
预设最大停止角速度阈值，
Figure BDA0002271775880000102
为预设最小停止角速度阈值，
Figure BDA0002271775880000103
为角速度的绝对值。
在一些示例中，当角速度的绝对值
Figure BDA0002271775880000104
大于预设最大停止角速度阈值
Figure BDA0002271775880000105
时，则说明该待补偿关节正在以该角速度进行运动，并不会逐渐停止，需要对摩擦力力矩进行完全补偿，因此，这里的摩擦力力矩补偿系数为1。
当角速度的绝对值
Figure BDA0002271775880000106
大于预设最小停止角速度阈值
Figure BDA0002271775880000107
且小于预设最大停止角速度阈值
Figure BDA0002271775880000108
时，则说明该待补偿关节即将进入静止状态，无需进行完全补偿，此时，可以采用公式：
Figure BDA0002271775880000109
来计算该待补偿关节的摩擦力力矩补偿系数co。
此时，该待补偿关节的摩擦力力矩补偿系数co的大小与该待补偿关节的角速度相关。从而可以实现随着该待补偿关节的角速度的改变而改变该待补偿关节的摩擦力力矩补偿系数。
当角速度的绝对值
Figure BDA00022717758800001010
小于预设最小停止角速度阈值
Figure BDA00022717758800001011
时，则说明该待补偿关节进一步接近静止状态，由于此时该待补偿关节的角速度非常小，可以采用一个恒定值来调整摩擦力力矩补偿电流，因此，可以将该待补偿关节的摩擦力力矩补偿系数设置为comin。
在又一些示例中，当该待补偿关节进行换向时，换向前后该待补偿关节的角速度也往往比较小，因此，为了准确识别该待补偿关节是由运动状态改变为静止状态还是该待补偿关节是被工作人员拖动换向。在角速度的绝对值
Figure BDA00022717758800001012
小于或等于预设最小停止角速度阈值
Figure BDA00022717758800001013
时，可以获取待补偿关节的角加速度；然后判断角加速度是否小于预设角加速度阈值；
在角加速度小于预设角加速度阈值时，可以说明该待补偿关节即将由运动状态改变为静止状态，不是进行换向，因此，可以对摩擦力力矩进行部分补偿，此时的摩擦力力矩补偿系数可以是comin。
在角加速度大于或等于预设角加速度阈值时，则可以说明该待补偿关节的加速度比较大，从而可以确定该待补偿关节是在进行换向，需要对该待补偿关节的摩擦力力矩进行完全补偿，因此，可以确定与角速度对应的摩擦力力矩补偿系数为1。
在一些示例中，该预先设置的角加速度阈值可以是预先根据经验设置的阈值，例如，该预先设置的角加速度阈值可以是1°/s2。
这样，可以在角速度的绝对值
Figure BDA0002271775880000111
小于预设最小停止角速度阈值
Figure BDA0002271775880000112
时，准确捕捉到机器人的停止意图，对机器人关节摩擦力进行部分补偿，使得机器人凭借自身阻尼而停止，解决了机器人拖动示教停止时抖动的问题。
在一些示例中，该预设最小摩擦力力矩补偿系数comin、预设最大停止角速度阈值
Figure BDA0002271775880000113
以及预设最小停止角速度阈值
Figure BDA0002271775880000114
可以是预先设置的值，例如，该预设最小摩擦力力矩补偿系数comin可以是0.5，该预设最大停止角速度阈值
Figure BDA0002271775880000115
可以是3.0°/s，该预设最小停止角速度阈值
Figure BDA0002271775880000116
可以是1.0°/s。
在又一些示例中，为了确定该待补偿关节是否改变为停止状态，可以设置一个角速度停止值
Figure BDA0002271775880000117
当该待补偿关节的角速度小于或等于该角速度停止值
Figure BDA0002271775880000118
时，可以说明该待补偿关节从运动状态改变成了停止状态。该角速度停止值可以是预先根据经验设置的值，例如，该角速度停止值
Figure BDA0002271775880000119
可以是0.9°/s。
在又一些示例中，该待补偿关节通常是先处于静止状态，然后由工作人员进行拖动，从而由静止状态改变为运动状态，当该待补偿关节处于静止状态，为了使得该待补偿关节容易启动，使得工作人员使用较小的力量便可以拖动该待补偿关节，则可以对该待补偿关节的电机施加一个震荡激励电流。对此，上述的机器人可以获取预设的震荡激励电流值，然后控制待补偿关节的电机采用预设的震荡激励电流值，对待补偿关节进行电流激励。
在一些示例中，该震荡激励电流可以是正弦激励电流，该正弦激励电流的公式为：I＝A1sin(2πft')，其中A1代表震荡激励电流的幅值，f代表震荡激励电流的频率，t'为时间。例如，该震荡激励电流的幅值A1可以是0.15A，震荡激励电流的频率f可以是10Hz。
通过使用震荡激励电流不断地对机器人的待补偿关节进行扰动，使该待补偿关节处于不稳定状态，此时，当工作人员对该待补偿关节施加较小的外力后，该待补偿关节便可以产生角速度。
可以理解的是，震荡激励电流的幅值和频率可以结合实际情况进行调整。这也是可以的。
经过研究和实验表明，震荡激励电流的幅值影响待补偿关节的灵敏度。即在一定范围内，震荡激励电流的幅值越大，产生相同的微小位移所需的外力越小。震荡激励电流的频率影响操作灵敏度，即在一定范围内，震荡激励电流的频率越高，机器人能够更加灵敏的捕捉工作人员的启动意图。
在一些示例中，为了使得该机器人能够准确的判断工作人员是否对待补偿关节进行启动，可以对该待补偿关节设置一个角度改变阈值，然后该机器人可以在两个采样周期内，分别采集该待补偿关节的角度值，也即，在一个采集周期中采集一个该待补偿关节的角度值，然后在该采集周期的下一个采集周期内再采集一个该待补偿关节的角度值，然后计算该两个周期采集到的待补偿关机的角度值的差值，然后将计算得到的差值与该预设的角度改变阈值进行比较，在一些示例中，该角度改变阈值可以是0.02°。
当计算得到的差值大于该预设的角度改变阈值时，则可以说明该机器人的待补偿关节已经被工作人员拖动，此时，可以控制该待补偿关节的电机进行摩擦力力矩补偿，也即执行步骤S110。
在计算得到的差值小于预设角度改变阈值时，则可以说明该待补偿关节还未被工作人员拖动，则可以获取预设的震荡激励电流值，并控制待补偿关节的电机采用预设的震荡激励电流值，对待补偿关节进行电流激励。
可以理解的是，该两个采样周期内分别采集的角度值可以是由该待补偿关节处安装的角度传感器进行采集的。
本发明实施例提供的一种关节摩擦力力矩补偿方法，可以先获取获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，然后基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；最后控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。这样，可以使得该待补偿关节在不同的运动速度时，可以采用不同的补偿电流对该待补偿关节进行摩擦力力矩补偿，从而避免采用相同的补偿电流对不同运动速度的待补偿关节进行摩擦力力矩补偿，提高对关节进行摩擦力力矩补偿的准确度，进而提高对机器人的操作灵活性。
在一些示例中，上述的机器人的各个关节处还分别安装有温度传感器，对此，在图1所示的一种摩擦力力矩补偿方法的基础上，本发明实施例还提供了一种可能的实现方式如图2所示，为本发明实施例的一种摩擦力力矩补偿方法第二种实施方式的流程图，该方法可以包括：
S210，获取待补偿关节处的角速度和温度；其中，待补偿关节为多个关节中的任一关节；
S220，基于角速度和温度，采用与温度对应的摩擦力力矩模型，计算待补偿关节处的摩擦力力矩的补偿电流。
S230，基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
S240，控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
在一些示例中，上述的补偿电流可以是直接从该机器人的待补偿关节的电机上获取到的，也可以是通过计算得到的。为了提高本发明实施例的对待补偿关节的补偿电流的调整的准确度，这里通过计算来获取补偿电流。
具体的，上述的机器人可以获取待补偿关节处的角速度和温度，然后基于角速度和温度，采用与温度对应的摩擦力力矩模型，计算待补偿关节处的摩擦力力矩的补偿电流。
在一些示例中，当待补偿关节处的温度不同时，待补偿关节处的摩擦力也会不同，因此，补偿摩擦力力矩的补偿电流也会不同，因此，可以基于角速度和温度，采用与温度对应的摩擦力力矩模型，来计算待补偿关节处的摩擦力力矩的补偿电流。
在又一些示例中，该与温度对应的摩擦力力矩模型可以是预先设置好的，不同的温度对应不同的摩擦力力矩模型，或者不同阶段的温度对应不同的摩擦力力矩模型。
例如，在温度t小于预设第一温度阈值T1时，基于角速度
Figure BDA0002271775880000131
和温度t，采用公式(1)：
Figure BDA0002271775880000132
计算待补偿关节处的摩擦力力矩的补偿电流I；
又例如，在温度t大于或等于预设第一温度阈值T1，且小于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000141
和温度t，采用公式(2)：
Figure BDA0002271775880000142
计算待补偿关节处的摩擦力力矩的补偿电流I；
再例如，在温度t大于或等于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000143
和温度t，采用公式(3)：
Figure BDA0002271775880000144
计算待补偿关节处的摩擦力力矩的补偿电流I；
其中，J为待补偿关节的转动惯量，α为待补偿关节的角加速度，TC为库伦摩擦系数，
Figure BDA0002271775880000145
为温度t小于预设第一温度阈值T1时的第一粘滞摩擦系数，
Figure BDA0002271775880000146
为温度t大于或等于预设第一温度阈值T1且小于预设第二温度阈值T2时的第二粘滞摩擦系数，
Figure BDA0002271775880000147
为温度t大于或等于预设第二温度阈值T2时的第三粘滞摩擦系数，
Figure BDA0002271775880000148
为关于角速度的符号函数，β1为温度t小于预设第一温度阈值T1时的第一润滑剂粘度系数，β2为温度t大于或等于预设第一温度阈值T1且小于预设第二温度阈值T2时的第二润滑剂粘度系数，β3为温度t大于或等于预设第二温度阈值T2时的第三润滑剂粘度系数。
可以理解的是，这里的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000149
第二粘滞摩擦系数
Figure BDA00022717758800001410
第三粘滞摩擦系数
Figure BDA00022717758800001411
第一温度阈值T1、第二温度阈值T2、第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3可以是根据经验设置的参数值。例如，该第一温度阈值T1可以为20℃，第二温度阈值T2可以为40℃。
通过本发明实施例，可以使得得到的补偿电流更加准确，因此，调整后的补偿电流也更准确。从而使得可以对待补偿关节的摩擦力力矩进行更准确的补偿。
可以理解的是，本发明实施例中的步骤S230～S240与上述的第一种实施方式中的步骤S120～S130相同或相似，这里不再赘述。
在一些示例中，上述的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000151
第二粘滞摩擦系数
Figure BDA0002271775880000152
第三粘滞摩擦系数
Figure BDA0002271775880000153
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3也可以是通过测量计算得到的。对此，在图2所示的一种摩擦力力矩补偿方法的基础上，本发明实施例还提供了一种摩擦力力矩补偿方法，如图3所示，为本发明实施例的一种摩擦力力矩补偿方法第三种实施方式的流程图，该方法可以包括：
S310，获取不同测试温度时待补偿关节的测试角速度、测试角加速度以及对待补偿关节进行补偿的测试补偿电流，其中，每个测试温度对应一个测试角速度、一个测试角加速度以及一个测试补偿电流；
S320，基于多个测试温度以及对应的测试角速度、测试角加速度以及测试补偿电流，采用公式(4)：
Figure BDA0002271775880000154
计算摩擦力力矩模型中的待补偿关节的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000155
第二粘滞摩擦系数
Figure BDA0002271775880000156
第三粘滞摩擦系数
Figure BDA0002271775880000157
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3。
S330，获取待补偿关节处的角速度和温度；其中，待补偿关节为多个关节中的任一关节；
S340，基于角速度和温度，采用与温度对应的摩擦力力矩模型，计算待补偿关节处的摩擦力力矩的补偿电流。
S350，基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
S360，控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
在一些示例中，在对待补偿关节的补偿电流进行调整前，可以先计算该与温度对应的摩擦力力矩模型中的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000158
第二粘滞摩擦系数
Figure BDA0002271775880000159
第三粘滞摩擦系数
Figure BDA00022717758800001510
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3。
对此，可以在该待补偿关节启动后，可以控制该待补偿关节的电机以正弦激励速度进行运行。其中，该正弦激励速度可以为
Figure BDA0002271775880000161
其中，该A2可以表示该正弦激励速度的幅值，也即该正弦激励速度的最大值为A2，例如，该A2可以为60。这样，可以使得待补偿关节的电机以该正弦激励速度进行正反转运动，当该待补偿关节的电机在运动的过程中，可以通过角速度传感器、温度传感器、角加速度传感器来采集该待补偿关节电机的角速度、角加速度以及该待补偿关节处的温度信息，因此，可以获取到测试温度、测试角速度、测试角加速度。
在又一些示例中，在采集一个测试温度时，可以同时采集测试角速度、测试角加速度，也即采集同一时刻的测试温度、测试角速度、测试角加速度。还可以获取同一时刻的测试补偿电流。
在又一些示例中，由于该角加速度传感器采集的测试角加速度有较大的误差，为了降低角加速度的误差，这里可以对测试角速度进行一阶求导，从而可以得到该测试角速度同一时刻的角加速度，用理论测试角加速度代替实际采集得到的角加速度。例如，可以对上述的正弦激励速度可以为
Figure BDA0002271775880000162
求一阶导数，可以得到正弦激励角加速度α＝A2cos(t)。
可以理解的是，当该待补偿关节的电机进行正反转运动时，该待补偿关节处的温度会逐步升高，因此，可以在该待补偿关节处的温度处于不同温度的时刻，同时采集该待补偿关节处的测试角速度以及获取待补偿关节进行摩擦力力矩补偿的测试补偿电流。这样，便可以得到多组测试数据，其中，每一组数据中，一个测试温度对应一个测试角速度、一个测试角加速度以及一个测试补偿电流。例如，采集得到的数据可以是表1所示的2万组测试数据。
表1测试数据表
Figure BDA0002271775880000163
在得到上述的测试数据后，可以基于该测试数据，采用公式(4)便可以计算得到该摩擦力力矩模型中的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000171
第二粘滞摩擦系数
Figure BDA0002271775880000172
第三粘滞摩擦系数
Figure BDA0002271775880000173
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3。例如，计算得到的待补偿关节的各参数的参数值可以是表2所示的参数值。
表2待补偿关节的摩擦力力矩模型中的各参数的参数值
Figure BDA0002271775880000175
可以理解的是，这里的2万组数据仅仅只是示例性的说明，在计算该待补偿关节的摩擦力力矩模型中的各参数的参数值时，还可以采用更多组的数据或者更少组的数据进行计算，例如采用1000组数据或者采用10万组数据，这都是可以的。
通过本发明实施例来计算得到该待补偿关节的摩擦力力矩模型中的各个参数，可以使得该待补偿关节的摩擦力力矩模型更适用于该待补偿关节，从而可以提高计算补偿电流的准确度，进而可以提高对补偿电流进行调整的准确的，使得采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿时更准确。
可以理解的是，本发明实施例中的步骤S330～S360，与上述的第二种实施方式中的步骤S210～S240相同或相似，这里不再赘述。
为了更清楚的说明本发明实施例，这里结合图4对本发明实施例进行说明，如图4所示，为本发明实施例的有种关节摩擦力力矩补偿方法第四种实施方式的流程图，该方法可以包括：
S401，获取不同测试温度时待补偿关节的测试角速度、测试角加速度以及对待补偿关节进行补偿的测试补偿电流，其中，每个测试温度对应一个测试角速度、一个测试角加速度以及一个测试补偿电流；
S402，基于多个测试温度以及对应的测试角速度、测试角加速度以及测试补偿电流，采用公式(4)：
Figure BDA0002271775880000174
计算摩擦力力矩模型中的待补偿关节的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000181
第二粘滞摩擦系数
Figure BDA0002271775880000182
第三粘滞摩擦系数
Figure BDA0002271775880000183
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3。
S403，将该待补偿关节的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000184
第二粘滞摩擦系数
Figure BDA0002271775880000185
第三粘滞摩擦系数
Figure BDA0002271775880000186
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3输入至公式(5)，得到该待补偿关节的摩擦力力矩补偿模型。
S404，获取待补偿关节处的角度传感器在两个连续的采样周期采集到的待补偿关节的两个角度值，并判断该两个角度值的差值是否大于角度改变阈值，如果否，则执行步骤S405，如果是，执行步骤S406。
S405，获取预设的震荡激励电流值，并控制待补偿关节的电机采用预设的震荡激励电流值，对待补偿关节进行电流激励。然后返回执行步骤S404。
S406，获取待补偿关节处的角速度和温度；其中，待补偿关节为多个关节中的任一关节；
S407，在温度t小于预设第一温度阈值T1时，基于角速度
Figure BDA0002271775880000187
和温度t，采用公式(1)：
Figure BDA0002271775880000188
计算待补偿关节处的摩擦力力矩的补偿电流I；
S408，在温度t大于或等于预设第一温度阈值T1，且小于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000189
和温度t，采用公式(2)：
Figure BDA00022717758800001810
计算待补偿关节处的摩擦力力矩的补偿电流I；
S409，在温度t大于或等于预设第二温度阈值T2时，基于角速度
Figure BDA00022717758800001811
和温度t，采用公式(3)：
Figure BDA00022717758800001812
计算待补偿关节处的摩擦力力矩的补偿电流I；
S410，在角速度的绝对值小于或等于预设最小停止角速度阈值时，获取待补偿关节的角加速度；判断角加速度是否小于预设角加速度阈值；如果是，执行步骤S411，如果否，执行步骤S412。
S411，基于角速度，采用公式(5)：
Figure BDA0002271775880000191
计算与角速度对应的摩擦力力矩补偿系数co。
S412，确定与角速度对应的摩擦力力矩补偿系数为1。
S413，基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
S414，控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
通过本发明实施例，可以在待补偿关节静止时对该待补偿关节施加震荡激励，提高了机器人启动的灵敏度，解决了机器人启动困难的难题，使机器人启动流畅。通过在该待补偿关节运行时考虑待补偿关节处温度、待补偿关机的角速度速度对摩擦力力矩补偿的影响，对机器人关节摩擦力进行了准确的建模，使得机器人拖动示教更加轻便、柔顺，提高工作效率。并且，可以在待补偿关节速度较小时，可以准确捕捉机器人的停止意图，对机器人关节摩擦力进行部分补偿，使得机器人凭借自身阻尼而停止，解决了机器人拖动示教停止时抖动的工程问题。这样，可以对机器人的待补偿关节应用完整的摩擦力补偿策略。可以实现机器人小范围的精确拖动，极大的改善了拖动性能，提高效率，提高了人机交互体验。
为了更清楚的说明本发明实施例的效果，这里结合图5a、图5b以及图5c进行说明，如图5a所示，为关节在25℃时的实际补偿电流与计算得到的补偿电流对比图，图5b为在35℃时的实际补偿电流与计算得到的补偿电流对比图，图5b为在40℃时的实际补偿电流与计算得到的补偿电流对比图。在5a、5b以及5c中，横坐标为时间，纵坐标为电流值。平滑曲线为计算得到的补偿电流值，锯齿形曲线为实际补偿电流值。
对比可见，温度为25℃时，电流峰值＞2A；温度为40℃时，电流峰值＜2A，说明随着温度的升高，摩擦力逐渐减小，因此需要补偿的摩擦力力矩也减小。并且，通过观察5a、5b以及5c可见，该计算得到的补偿电流值与实际补偿电流值较好的重合了，从而说明通过本发明实施例的一种关节摩擦力力矩补偿方法计算得到的补偿电流比较准确，从而可以能够对关节的摩擦力力矩进行准确的补偿。
进一步的，为了验证本发明实施例的一种关节摩擦力力矩补偿方法的可行性。这里先反向拖动关节，使关节产生反向的位移，然后在关节的零点附近往复拖动关节，最后撤销对关节施加的力，使关节依靠自身阻尼停止。从而绘制得到图6所示的时间-关节角度曲线。
由图6可知，机器人启动阶段、人为换向过程、停止阶段均比较平稳，无时间延迟、阶跃位移及位置抖动发生，说明摩擦力补偿方法的可行性较高。
相应于上述的方法实施例，本发明实施例还提供了一种关节摩擦力力矩补偿装置，可以应用于机器人，机器人包括多个关节，各个关节处分别安装有电机；如图7所示，为本发明实施例的一种关节摩擦力力矩补偿装置的结构示意图，该装置可以包括：
获取模块710，用于获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；
补偿电流调整模块720，用于基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
控制模块730，用于控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
本发明实施例提供的一种关节摩擦力力矩补偿装置，可以先获取获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，然后基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；最后控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。这样，可以使得该待补偿关节在不同的运动速度时，可以采用不同的补偿电流对该待补偿关节进行摩擦力力矩补偿，从而避免采用相同的补偿电流对不同运动速度的待补偿关节进行摩擦力力矩补偿，提高对关节进行摩擦力力矩补偿的准确度，进而提高对机器人的操作灵活性。
可选的，各个关节处还分别安装有温度传感器，获取模块710，具体用于：
获取待补偿关节处的角速度和温度；基于角速度和温度，采用与温度对应的摩擦力力矩模型，计算待补偿关节处的摩擦力力矩的补偿电流。
可选的，获取模块710，具体用于：
在温度t小于预设第一温度阈值T1时，基于角速度
Figure BDA0002271775880000211
和温度t，采用公式(1)：
Figure BDA0002271775880000212
计算待补偿关节处的摩擦力力矩的补偿电流I；
在温度t大于或等于预设第一温度阈值T1，且小于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000213
和温度t，采用公式(2)：
Figure BDA0002271775880000214
计算待补偿关节处的摩擦力力矩的补偿电流I；
在温度t大于或等于预设第二温度阈值T2时，基于角速度
Figure BDA0002271775880000215
和温度t，采用公式(3)：
Figure BDA0002271775880000216
计算待补偿关节处的摩擦力力矩的补偿电流I；
其中，J为待补偿关节的转动惯量，α为待补偿关节的角加速度，TC为库伦摩擦系数，
Figure BDA0002271775880000217
为温度t小于预设第一温度阈值T1时的第一粘滞摩擦系数，
Figure BDA0002271775880000218
为温度t大于或等于预设第一温度阈值T1且小于预设第二温度阈值T2时的第二粘滞摩擦系数，
Figure BDA0002271775880000219
为温度t大于或等于预设第二温度阈值T2时的第三粘滞摩擦系数，
Figure BDA00022717758800002110
为关于角速度的符号函数，β1为温度t小于预设第一温度阈值T1时的第一润滑剂粘度系数，β2为温度t大于或等于预设第一温度阈值T1且小于预设第二温度阈值T2时的第二润滑剂粘度系数，β3为温度t大于或等于预设第二温度阈值T2时的第三润滑剂粘度系数。
可选的，该摩擦力力矩补偿装置还包括：
测试数据获取模块，用于获取不同测试温度时待补偿关节的测试角速度、测试角加速度以及对待补偿关节进行补偿的测试补偿电流，其中，每个测试温度对应一个测试角速度、一个测试角加速度以及一个测试补偿电流；
参数计算模块，用于基于多个测试温度以及对应的测试角速度、测试角加速度以及测试补偿电流，采用公式(4)：
Figure BDA0002271775880000221
计算摩擦力力矩模型中的待补偿关节的转动惯量J、库伦摩擦系数TC、第一粘滞摩擦系数
Figure BDA0002271775880000222
第二粘滞摩擦系数
Figure BDA0002271775880000223
第三粘滞摩擦系数
Figure BDA0002271775880000224
第一润滑剂粘度系数β1、第二润滑剂粘度系数β2以及第三润滑剂粘度系数β3。
可选的，各个关节处还分别安装有角度传感器，该摩擦力力矩补偿装置还包括：
角度值模块，用于获取待补偿关节的角度传感器在两个连续采样周期采集的两个角度值；
角度值判断模块，用于判断两个角度值的差值是否大于或等于预设角度改变阈值；在两个角度值的差值大于或等于预设角度改变阈值时，触发获取模块，在两个角度值的差值小于预设角度改变阈值时，触发震荡激励模块；
震荡激励模块，用于获取预设的震荡激励电流值，并控制待补偿关节的电机采用预设的震荡激励电流值，对待补偿关节进行电流激励。
可选的，该关节摩擦力力矩补偿装置，还包括：
补偿系数计算模块，用于基于角速度
Figure BDA0002271775880000225
采用公式(5)：
Figure BDA0002271775880000226
计算与角速度
Figure BDA0002271775880000227
对应的摩擦力力矩补偿系数co，其中，comin为预设最小摩擦力力矩补偿系数，
Figure BDA0002271775880000228
预设最大停止角速度阈值，
Figure BDA0002271775880000229
为预设最小停止角速度阈值，
Figure BDA00022717758800002210
为角速度的绝对值。
可选的，该关节摩擦力力矩补偿装置，还包括：
角加速度获取模块，用于在角速度的绝对值
Figure BDA0002271775880000231
小于或等于预设最小停止角速度阈值
Figure BDA0002271775880000232
时，获取待补偿关节的角加速度；
角加速度判断模块，用于判断角加速度是否小于预设角加速度阈值；在角加速度小于预设角加速度阈值时，触发补偿系数计算模块；在角加速度大于或等于预设角加速度阈值时，确定与角速度对应的摩擦力力矩补偿系数为1。
本发明实施例还提供了一种机器人，如图8所示，为本发明实施例的一种机器人的结构示意图，包括多个关节，各个关节分别安装有电机；该机器人还可以包括：处理器801和机器可读存储介质802，机器可读存储介质802存储有能够被处理器801执行的机器可执行指令，处理器801被机器可执行指令促使实现上述任一实施例所示的关节摩擦力力矩补偿方法的步骤，例如，可以实现如下步骤：
获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；
基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
本发明实施例提供的一种机器人，可以先获取获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，然后基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；最后控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。这样，可以使得该待补偿关节在不同的运动速度时，可以采用不同的补偿电流对该待补偿关节进行摩擦力力矩补偿，从而避免采用相同的补偿电流对不同运动速度的待补偿关节进行摩擦力力矩补偿，提高对关节进行摩擦力力矩补偿的准确度，进而提高对机器人的操作灵活性。
上述的机器可读存储介质802可以包括随机存取存储器(Random Access Memory，RAM)，也可以包括非易失性存储器(Non-Volatile Memory，NVM)，例如至少一个磁盘存储器。在一些示例中，存储器还可以是至少一个位于远离前述处理器的存储装置。
上述的处理器801可以是通用处理器，包括中央处理器(Central ProcessingUnit，CPU)、网络处理器(Network Processor，NP)等；还可以是数字信号处理器(DigitalSignal Processing，DSP)、专用集成电路(Application Specific Integrated Circuit，ASIC)、现场可编程门阵列(Field-Programmable Gate Array，FPGA)或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件。
本发明实施例还提供了一种计算机可读存储介质，该计算机可读存储介质内存储有计算机程序，计算机程序被处理器执行时，实现上述任一实施例所示的关节摩擦力力矩补偿方法的步骤，例如，可以实现如下步骤：
获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；
基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
本发明实施例还提供了一种包含指令的计算机程序产品，当其在计算机上运行时，使得计算机执行上述任一实施例所示的关节摩擦力力矩补偿方法的步骤，例如，可以实现如下步骤：
获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；
基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
本发明实施例还提供了一种计算机程序，当其在计算机上运行时，使得计算机执行上述任一实施例所示的关节摩擦力力矩补偿方法的步骤，例如，可以实现如下步骤：
获取待补偿关节的角速度和对待补偿关节进行摩擦力力矩补偿的补偿电流，其中，待补偿关节为多个关节中的任一关节；
基于角速度和与角速度对应的摩擦力力矩补偿系数，对补偿电流进行调整，得到调整后的补偿电流；
控制待补偿关节处的电机，采用调整后的补偿电流对待补偿关节进行摩擦力力矩补偿。
需要说明的是，在本文中，诸如第一和第二等之类的关系术语仅仅用来将一个实体或者操作与另一个实体或操作区分开来，而不一定要求或者暗示这些实体或操作之间存在任何这种实际的关系或者顺序。而且，术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含，从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素，而且还包括没有明确列出的其他要素，或者是还包括为这种过程、方法、物品或者设备所固有的要素。在没有更多限制的情况下，由语句“包括一个……”限定的要素，并不排除在包括所述要素的过程、方法、物品或者设备中还存在另外的相同要素。
本说明书中的各个实施例均采用相关的方式描述，各个实施例之间相同相似的部分互相参见即可，每个实施例重点说明的都是与其他实施例的不同之处。尤其，对于系统实施例而言，由于其基本相似于方法实施例，所以描述的比较简单，相关之处参见方法实施例的部分说明即可。
以上所述仅为本发明的较佳实施例而已，并非用于限定本发明的保护范围。凡在本发明的精神和原则之内所作的任何修改、等同替换、改进等，均包含在本发明的保护范围内。

Claims (9)

1.一种关节摩擦力力矩补偿方法，其特征在于，应用于机器人，所述机器人包括多个关节，各个所述关节分别安装有电机；所述方法包括：
获取待补偿关节的角速度和对所述待补偿关节进行摩擦力力矩补偿的补偿电流，其中，所述待补偿关节为所述多个关节中的任一关节；
基于所述角速度和与所述角速度对应的摩擦力力矩补偿系数，对所述补偿电流进行调整，得到调整后的补偿电流；
控制所述待补偿关节处的电机，采用所述调整后的补偿电流对所述待补偿关节进行摩擦力力矩补偿；
所述各个关节处还分别安装有角度传感器，在所述获取待补偿关节的角速度和对所述待补偿关节进行摩擦力力矩补偿的补偿电流之前，所述方法还包括：
获取所述待补偿关节的角度传感器在两个连续采样周期采集的两个角度值；
判断所述两个角度值的差值是否大于或等于预设角度改变阈值；
在所述两个角度值的差值大于或等于预设角度改变阈值时，执行所述获取待补偿关节的角速度和对所述待补偿关节进行摩擦力力矩补偿的补偿电流的步骤；
在所述两个角度值的差值小于预设角度改变阈值时，获取预设的震荡激励电流值，并控制所述待补偿关节的电机采用所述预设的震荡激励电流值，对所述待补偿关节进行电流激励。
2.根据权利要求1所述的方法，其特征在于，所述各个关节处还分别安装有温度传感器，所述获取待补偿关节的角速度和对所述待补偿关节进行摩擦力力矩补偿的补偿电流，包括：
获取所述待补偿关节处的角速度和温度；
基于所述角速度和所述温度，采用与所述温度对应的摩擦力力矩模型，计算所述待补偿关节处的摩擦力力矩的补偿电流。
3.根据权利要求2所述的方法，其特征在于，所述基于所述角速度和所述温度，采用与所述温度对应的摩擦力力矩模型，计算所述待补偿关节处的摩擦力力矩的补偿电流，包括：
在所述温度t小于预设第一温度阈值T1时，基于所述角速度
Figure FDA00030127492900000212
和所述温度t，采用公式(1)：
Figure FDA0003012749290000021
计算所述待补偿关节处的摩擦力力矩的补偿电流I；
在所述温度t大于或等于所述预设第一温度阈值T1，且小于预设第二温度阈值T2时，基于所述角速度
Figure FDA0003012749290000022
和所述温度t，采用公式(2)：
Figure FDA0003012749290000023
计算所述待补偿关节处的摩擦力力矩的补偿电流I；
在所述温度t大于或等于所述预设第二温度阈值T2时，基于所述角速度
Figure FDA00030127492900000213
和所述温度t，采用公式(3)：
Figure FDA0003012749290000024
计算所述待补偿关节处的摩擦力力矩的补偿电流I；
其中，所述J为所述待补偿关节的转动惯量，所述α为所述待补偿关节的角加速度，所述TC为库伦摩擦系数，所述
Figure FDA0003012749290000025
为所述温度t小于预设第一温度阈值T1时的第一粘滞摩擦系数，所述
Figure FDA0003012749290000026
为所述温度t大于或等于所述预设第一温度阈值T1且小于预设第二温度阈值T2时的第二粘滞摩擦系数，所述
Figure FDA0003012749290000027
为所述温度t大于或等于所述预设第二温度阈值T2时的第三粘滞摩擦系数，所述
Figure FDA0003012749290000028
为关于所述角速度的符号函数，所述β1为所述温度t小于预设第一温度阈值T1时的第一润滑剂粘度系数，所述β2为所述温度t大于或等于所述预设第一温度阈值T1且小于预设第二温度阈值T2时的第二润滑剂粘度系数，所述β3为所述温度t大于或等于所述预设第二温度阈值T2时的第三润滑剂粘度系数。
4.根据权利要求3所述的方法，其特征在于，获取所述摩擦力力矩模型中的待补偿关节的转动惯量J、所述库伦摩擦系数TC、所述第一粘滞摩擦系数
Figure FDA0003012749290000029
所述第二粘滞摩擦系数
Figure FDA00030127492900000210
所述第三粘滞摩擦系数
Figure FDA00030127492900000211
所述第一润滑剂粘度系数β1、所述第二润滑剂粘度系数β2以及所述第三润滑剂粘度系数β3的步骤，包括：
获取不同测试温度时所述待补偿关节的测试角速度、测试角加速度以及对所述待补偿关节进行补偿的测试补偿电流，其中，每个所述测试温度对应一个所述测试角速度、一个所述测试角加速度以及一个所述测试补偿电流；
基于多个所述测试温度以及对应的所述测试角速度、所述测试角加速度以及所述测试补偿电流，采用公式(4)：
Figure FDA0003012749290000031
计算所述摩擦力力矩模型中的待补偿关节的转动惯量J、所述库伦摩擦系数TC、所述第一粘滞摩擦系数
Figure FDA0003012749290000032
所述第二粘滞摩擦系数
Figure FDA0003012749290000033
所述第三粘滞摩擦系数
Figure FDA0003012749290000034
所述第一润滑剂粘度系数β1、所述第二润滑剂粘度系数β2以及所述第三润滑剂粘度系数β3。
5.根据权利要求1～4任一项所述的方法，其特征在于，在所述基于所述角速度和与所述角速度对应的摩擦力力矩补偿系数，对所述补偿电流进行调整，得到调整后的补偿电流之前，所述方法还包括：
基于所述角速度
Figure FDA0003012749290000035
采用公式(5)：
Figure FDA0003012749290000036
计算与所述角速度
Figure FDA0003012749290000037
对应的摩擦力力矩补偿系数co，其中，所述comin为预设最小摩擦力力矩补偿系数，所述
Figure FDA0003012749290000038
预设最大停止角速度阈值，所述
Figure FDA0003012749290000039
为预设最小停止角速度阈值，所述
Figure FDA00030127492900000310
为所述角速度的绝对值。
6.根据权利要求5所述的方法，其特征在于，在所述基于所述角速度
Figure FDA00030127492900000311
采用公式(5)：计算与所述角速度
Figure FDA00030127492900000312
对应的摩擦力力矩补偿系数co之前，所述方法包括：
在所述角速度的绝对值
Figure FDA00030127492900000313
小于或等于所述预设最小停止角速度阈值
Figure FDA00030127492900000314
时，获取所述待补偿关节的角加速度；
判断所述角加速度是否小于预设角加速度阈值；
在所述角加速度小于所述预设角加速度阈值时，执行所述基于所述角速度
Figure FDA0003012749290000041
采用公式(5)：计算与所述角速度
Figure FDA0003012749290000042
对应的摩擦力力矩补偿系数co的步骤；
在所述角加速度大于或等于所述预设角加速度阈值时，确定与所述角速度对应的摩擦力力矩补偿系数为1。
7.一种关节摩擦力力矩补偿装置，其特征在于，应用于机器人，所述机器人包括多个关节，各个所述关节处分别安装有电机；所述装置包括：
获取模块，用于获取待补偿关节的角速度和对所述待补偿关节进行摩擦力力矩补偿的补偿电流，其中，所述待补偿关节为所述多个关节中的任一关节；
补偿电流调整模块，用于基于所述角速度和与所述角速度对应的摩擦力力矩补偿系数，对所述补偿电流进行调整，得到调整后的补偿电流；
控制模块，用于控制所述待补偿关节处的电机，采用所述调整后的补偿电流对所述待补偿关节进行摩擦力力矩补偿；
所述摩擦力力矩补偿装置还包括：
角度值模块，用于获取待补偿关节的角度传感器在两个连续采样周期采集的两个角度值；
角度值判断模块，用于判断两个角度值的差值是否大于或等于预设角度改变阈值；在两个角度值的差值大于或等于预设角度改变阈值时，触发获取模块，在两个角度值的差值小于预设角度改变阈值时，触发震荡激励模块；
震荡激励模块，用于获取预设的震荡激励电流值，并控制待补偿关节的电机采用预设的震荡激励电流值，对待补偿关节进行电流激励。
8.根据权利要求7所述的装置，其特征在于，所述各个关节处还分别安装有温度传感器，所述获取模块，具体用于：
获取所述待补偿关节处的角速度和温度；基于所述角速度和所述温度，采用与所述温度对应的摩擦力力矩模型，计算所述待补偿关节处的摩擦力力矩的补偿电流。
9.一种机器人，其特征在于，所述机器人包括：处理器和机器可读存储介质，所述机器可读存储介质存储有能够被所述处理器执行的机器可执行指令，所述处理器被所述机器可执行指令促使：实现权利要求1～6任一项所述的方法步骤。
CN201911107603.0A 2019-11-13 2019-11-13 一种关节摩擦力力矩补偿方法、装置及机器人 Active CN111216120B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN201911107603.0A CN111216120B (zh) 2019-11-13 2019-11-13 一种关节摩擦力力矩补偿方法、装置及机器人

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN201911107603.0A CN111216120B (zh) 2019-11-13 2019-11-13 一种关节摩擦力力矩补偿方法、装置及机器人

Publications (2)

Publication Number Publication Date
CN111216120A CN111216120A (zh) 2020-06-02
CN111216120B true CN111216120B (zh) 2021-06-01

Family

ID=70806870

Family Applications (1)

Application Number Title Priority Date Filing Date
CN201911107603.0A Active CN111216120B (zh) 2019-11-13 2019-11-13 一种关节摩擦力力矩补偿方法、装置及机器人

Country Status (1)

Country Link
CN (1) CN111216120B (zh)

Families Citing this family (7)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN112187134A (zh) * 2020-09-01 2021-01-05 瑞声科技（南京）有限公司 电机摩擦力补偿方法、系统及其计算机可读存储介质
CN113510693B (zh) * 2021-08-03 2022-10-25 香港中文大学（深圳） 一种基于摩擦力的机器人控制方法、装置及设备
CN113855473B (zh) * 2021-08-25 2023-08-15 上海傅利叶智能科技有限公司 用于控制外骨骼机器人的方法、装置和外骨骼机器人
CN114800498B (zh) * 2022-04-20 2022-12-09 上海捷勃特机器人有限公司 一种scara机器人力矩前馈补偿方法
CN116460859B (zh) * 2023-06-19 2023-10-03 广东隆崎机器人有限公司 Scara机器人运动补偿方法、装置、设备及存储介质
CN117340899B (zh) * 2023-12-06 2024-05-14 苏州康多机器人有限公司 转矩补偿方法、装置、电子设备及存储介质
CN117400268B (zh) * 2023-12-13 2024-03-15 苏州康多机器人有限公司 非线性摩擦力补偿方法、装置、电子设备及存储介质

Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103425100A (zh) * 2013-07-23 2013-12-04 南京航空航天大学 基于力矩平衡的机器人直接示教控制方法
JP2015030076A (ja) * 2013-08-05 2015-02-16 株式会社東芝 ロボット制御装置
CN105479459A (zh) * 2015-12-29 2016-04-13 深圳市汇川技术股份有限公司 机器人零力控制方法以及系统
CN106994686A (zh) * 2016-12-01 2017-08-01 遨博（北京）智能科技有限公司 关节外力力矩的计算方法及装置、机器人
JP2017171224A (ja) * 2016-03-25 2017-09-28 株式会社Ｓｕｂａｒｕ 車両の操舵支援装置
JP2019049852A (ja) * 2017-09-08 2019-03-28 国立大学法人横浜国立大学 制御装置、システム、制御方法及びプログラム
CN109571549A (zh) * 2018-12-29 2019-04-05 上海新时达机器人有限公司 一种机器人本体的摩擦力监测方法和系统以及设备
CN110026981A (zh) * 2019-04-19 2019-07-19 中科新松有限公司 一种基于模型自适应的机械臂碰撞检测方法

Patent Citations (8)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN103425100A (zh) * 2013-07-23 2013-12-04 南京航空航天大学 基于力矩平衡的机器人直接示教控制方法
JP2015030076A (ja) * 2013-08-05 2015-02-16 株式会社東芝 ロボット制御装置
CN105479459A (zh) * 2015-12-29 2016-04-13 深圳市汇川技术股份有限公司 机器人零力控制方法以及系统
JP2017171224A (ja) * 2016-03-25 2017-09-28 株式会社Ｓｕｂａｒｕ 車両の操舵支援装置
CN106994686A (zh) * 2016-12-01 2017-08-01 遨博（北京）智能科技有限公司 关节外力力矩的计算方法及装置、机器人
JP2019049852A (ja) * 2017-09-08 2019-03-28 国立大学法人横浜国立大学 制御装置、システム、制御方法及びプログラム
CN109571549A (zh) * 2018-12-29 2019-04-05 上海新时达机器人有限公司 一种机器人本体的摩擦力监测方法和系统以及设备
CN110026981A (zh) * 2019-04-19 2019-07-19 中科新松有限公司 一种基于模型自适应的机械臂碰撞检测方法

Also Published As

Publication number Publication date
CN111216120A (zh) 2020-06-02

Similar Documents

Publication Publication Date Title
CN111216120B (zh) 一种关节摩擦力力矩补偿方法、装置及机器人
US10108177B2 (en) Control parameter adjustment device
CN102104361A (zh) 具有齿槽转矩修正量计算功能的电动机控制装置
JP6192849B2 (ja) 振動モード測定装置
EP3564574B1 (en) Method and device for controlling cradle head, and cradle head
JP6443311B2 (ja) 制御装置、制御プログラムおよび記録媒体
JP5269158B2 (ja) 制御方法及び制御装置
JP6120720B2 (ja) 周波数分析方法、及びこの周波数分析方法を用いた回転機器の診断方法
US20150258685A1 (en) Robot apparatus and control method therefor
CN106873383B (zh) 一种降低工业机器人振动的在线控制方法
WO2007105527A1 (ja) 位置決め機構の制御方法および制御装置
JP2019181610A (ja) モータエンコーダ及びセンサを用いて学習制御を行うロボットシステム
CN106020111A (zh) 定位装置的参数设定方法及定位装置
JP2010123018A (ja) サーボ制御装置
CN107438502A (zh) 通过触摸来控制工业机器人的方法
JP4361285B2 (ja) 数値制御装置
JP2014018941A (ja) 制御装置、及び制御方法
JP2015080398A (ja) 負荷トルク推定装置、画像形成装置、負荷トルク推定方法及びプログラム
TWI481183B (zh) 馬達參數量測方法與馬達參數量測系統
JP6661676B2 (ja) ロボット制御装置
JP7159945B2 (ja) 処理装置
JP2014186586A (ja) 支援装置
JP6333495B1 (ja) サーボ制御装置
JP4449693B2 (ja) ロボット制御装置およびその制御方法
JP7035457B2 (ja) パラメータ更新方法、パラメータ更新システム、及びプログラム

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant
CP03 Change of name, title or address
CP03 Change of name, title or address

Address after: Room 407, building 5, yard 98, lianshihu West Road, Mentougou District, Beijing 102300

Patentee after: AUBO (Beijing) Intelligent Technology Co.,Ltd.

Address before: 102300 301a1, building 5, Shilong Yangguang building, 98 lianshihu West Road, Mentougou District, Beijing

Patentee before: AUBO (BEIJING) ROBOTICS TECHNOLOGY Co.,Ltd.