Speed reducer angular transmission error identification system and speed reducer angular transmission error identification method

A speed reducer angular transmission error identification system comprising:

• a robot arm including a plurality of joints including a first joint and a second joint;
• a first joint drive unit including a first speed reducer including an output shaft connected to the first joint, and a first motor which includes an output shaft connected to an input shaft of the first speed reducer and turns the first joint via the first speed reducer;
• a first joint control unit that controls an operation of the first motor;
• a second joint drive unit including a second motor which includes an output shaft connected to the second joint and turns the second joint;
• a second joint control unit that controls an operation of the second motor;
• a variation data acquisition unit that acquires a plurality of variable data sets each including first variation data, second variation data, and a corresponding gravitational torque value in which the first variation data, the second variation data, and the corresponding gravitational torque value are associated with each other, the plurality of variable data sets being data sets corresponding to different predetermined regions of a turning range of the first joint, the first variation data being data indicating a periodic variation of an operation of the second joint caused by an angular transmission error of the first motor when the first joint control unit controls so as to rotate the output shaft of the first motor in a first direction at a constant first target speed and to turn the first joint from a position of one end to a position of the other end in the corresponding region and simultaneously the second joint drive unit rotates the output shaft of the second motor at the constant second target speed, the second variation data being data indicating a periodic variation of an operation of the second joint caused by an angular transmission error of the first motor when the first joint control unit controls so as to rotate the output shaft of the first motor in a second direction which is a rotation direction opposite to the first direction at the constant first target speed and to turn the first joint from the position of the other end to the position of the one end in the corresponding region and simultaneously the second joint drive unit rotates the output shaft of the second motor at the constant second target speed, the corresponding gravitational torque value being a value of gravitational torque acting on the output shaft of the first speed reducer in the corresponding region;
• a periodic function calculation unit that calculates a first periodic function that models the first variation data and a second periodic function that models the second variation data for each of the plurality of variable data sets;
• a phase calculation unit that calculates an average phase which is an average value of a phase of the first periodic function and a phase of the second periodic function for each of the plurality of variable data sets;
• a phase identification unit that calculates a correlation between the gravitational torque value acting on the output shaft of the first speed reducer and the average phase based on the average phase of each of the plurality of variable data sets and the corresponding gravitational torque value corresponding to the each average phase;
• and
• an angular transmission error identification unit that calculates a periodic variation of an angular transmission error of the first speed reducer based on the correlation between the gravitational torque value acting on the output shaft of the first speed reducer and the average phase, which is calculated by the phase identification unit.

A speed reducer angular transmission error identification method for a robot system,

• the robot system including:
• a robot arm including a plurality of joints including a first joint and a second joint;
• a first joint drive unit including a first speed reducer including an output shaft connected to the first joint, and a first motor which includes an output shaft connected to an input shaft of the first speed reducer and turns the first joint via the first speed reducer;
• a first joint control unit that controls an operation of the first motor;
• a second joint drive unit including a second motor which includes an output shaft connected to the second joint and turns the second joint;
• a second joint control unit that controls an operation of the second motor;
• the speed reducer angular transmission error identification method comprising:
• a variation data acquisition step of acquiring first variation data and second variation data associated with each other, the first variation data being data indicating a periodic variation of an operation of the second joint caused by an angular transmission error of the first motor when the first joint control unit controls so as to rotate the output shaft of the first motor in a first direction at a constant first target speed and to turn the first joint from a position of one end to a position of the other end in a predetermined region in a turning range of the first joint and simultaneously the second joint drive unit rotates the output shaft of the second motor at the constant second target speed, the second variation data being data indicating a periodic variation of an operation of the second joint caused by an angular transmission error of the first motor when the first joint control unit controls so as to rotate the output shaft of the first motor in a second direction which is a rotation direction opposite to the first direction at the constant first target speed and to turn the first joint from the position of the other end to the position of the one end in the region and simultaneously the second joint drive unit rotates the output shaft of the second motor at the constant second target speed;
• a periodic function calculation step of calculating a first periodic function that models the first variation data and a second periodic function that models the second variation data;
• a phase calculation step of calculating an average phase which is an average value of a phase of the first periodic function and a phase of the second periodic function;
• and
• an angular transmission error identification step of calculating a periodic variation of an angular transmission error of the first speed reducer based on the average phase.

A speed reducer angular transmission error identification method for a robot system,

• the robot system including:
• a robot arm including a plurality of joints including a first joint and a second joint;
• a first joint drive unit including a first speed reducer including an output shaft connected to the first joint, and a first motor which includes an output shaft connected to an input shaft of the first speed reducer and turns the first joint via the first speed reducer;
• a first joint control unit that controls an operation of the first motor;
• a second joint drive unit including a second motor which includes an output shaft connected to the second joint and turns the second joint;
• a second joint control unit that controls an operation of the second motor;
• the speed reducer angular transmission error identification method comprising:
• a variation data acquisition step of acquiring a plurality of variable data sets each including first variation data, second variation data, and a corresponding gravitational torque value in which the first variation data, the second variation data, and the corresponding gravitational torque value are associated with each other, the plurality of variable data sets being data sets corresponding to different predetermined regions of a turning range of the first joint, the first variation data being data indicating a periodic variation of an operation of the second joint caused by an angular transmission error of the first motor when the first joint control unit controls so as to rotate the output shaft of the first motor in a first direction at a constant first target speed and to turn the first joint from a position of one end to a position of the other end in the corresponding region and simultaneously the second joint drive unit rotates the output shaft of the second motor at the constant second target speed, the second variation data being data indicating a periodic variation of an operation of the second joint caused by an angular transmission error of the first motor when the first joint control unit controls so as to rotate the output shaft of the first motor in a second direction which is a rotation direction opposite to the first direction at the constant first target speed and to turn the first joint from the position of the other end to the position of the one end in the corresponding region and simultaneously the second joint drive unit rotates the output shaft of the second motor at the constant second target speed, the corresponding gravitational torque value being a value of gravitational torque acting on the output shaft of the first speed reducer in the corresponding region;
• a periodic function calculation step of calculating a first periodic function that models the first variation data and a second periodic function that models the second variation data for each of the plurality of variable data sets;
• a phase calculation step of calculating an average phase which is an average value of a phase of the first periodic function and a phase of the second periodic function for each of the plurality of variable data sets;
• a phase identification step of calculating a correlation between the gravitational torque value acting on the output shaft of the first speed reducer and the average phase based on the average phase of each of the plurality of variable data sets and the corresponding gravitational torque value corresponding to the each average phase;
• and
• an angular transmission error identification step of calculating a periodic variation of an angular transmission error of the first speed reducer based on the correlation between the gravitational torque value acting on the output shaft of the first speed reducer and the average phase, which is calculated by the phase identification unit.