[发明专利]减速机角度传递误差辨识系统和减速机角度传递误差辨识方法

摘要

一种减速机角度传递误差辨识系统和减速机角度传递误差辨识方法，包括：变动数据取得部(42)，取得第1变动数据和第2变动数据，上述第1变动数据是表示与第1关节控制部(24)使第1马达(11)的输出轴(11a)向第1方向以一定的第1目标速度旋转同时，第2关节控制部(27)使第2马达(16)的输出轴(16a)以一定的第2目标速度旋转后的由第1马达的角度传递误差引起的第2关节的动作的周期性的变动的数据，上述第2变动数据是表示在第1关节控制部使第1马达的输出轴向第2方向以一定的第1目标速度旋转的同时，第2关节控制部使第2马达的输出轴以一定的第2目标速度旋转的情况下，由第1马达的角度传递误差引起的第2关节的动作的周期性的变动的数据；周期函数计算部(43)，计算将第1和第2变动数据模型化后的第1和第2周期函数；平均相位计算部(44)，计算周期函数的平均相位；以及角度传递误差辨识部(46)，基于平均相位，计算第1减速机的角度传递误差的周期性的变动。

主权项

1.一种减速机角度传递误差辨识系统，其中，/n所述减速机角度传递误差辨识系统包括：/n机械臂，具有包括第1关节和第2关节在内的多个关节；/n第1关节驱动部，具有输出轴与所述第1关节连接的第1减速机、和输出轴与所述第1减速机的输入轴连接并经由该第1减速机使所述第1关节转动的第1马达；/n第1关节控制部，控制所述第1马达的动作；/n第2关节驱动部，具有输出轴与所述第2关节连接并使所述第2关节转动的第2马达；/n第2关节控制部，控制所述第2马达的动作；/n变动数据取得部，取得相互建立关联的第1变动数据和第2变动数据，所述第1变动数据是表示在所述第1关节控制部控制使所述第1马达的所述输出轴向第1方向以一定的第1目标速度旋转并使所述第1关节从所述第1关节的转动范围的规定的区域的一端的位置向另一端的位置转动的同时，所述第2关节驱动部使所述第2马达的所述输出轴以一定的第2目标速度旋转的情况下，由所述第1马达的角度传递误差引起的所述第2关节的动作的周期性的变动的数据，所述第2变动数据是表示在所述第1关节控制部控制使所述第1马达的所述输出轴向作为与所述第1方向相反的旋转方向的第2方向以一定的所述第1目标速度旋转并使所述第1关节从所述区域的另一端的位置向一端的位置转动的同时，所述第2关节驱动部使所述第2马达的所述输出轴以一定的第2目标速度旋转的情况下，由所述第1马达的角度传递误差引起的所述第2关节的动作的周期性的变动的数据；/n周期函数计算部，计算将所述第1变动数据模型化后的第1周期函数和将所述第2变动数据模型化后的第2周期函数；/n相位计算部，计算作为所述第1周期函数的相位与所述第2周期函数的相位的平均值的平均相位；以及/n角度传递误差辨识部，基于所述平均相位，计算所述第1减速机的角度传递误差的周期性的变动。/n