Angular transmission error identification system, angular transmission error identification method, and robot system

An angular transmission error identification method for identifying an angular transmission error of a speed reducer of a robot arm including a joint that is rotationally driven by a motor via the speed reducer,

• the angular transmission error identification method comprising a minute region amplitude/phase calculation step of calculating a minute motion range amplitude which is an amplitude of a predetermined frequency component of the angular transmission error of the speed reducer of a minute motion range and a minute motion range phase which is a phase thereof for each of a plurality of minute motion ranges arranged in a turning direction of the joint included in the motion range of the joint;
• a minute region gravitational torque value calculation step of calculating a corresponding gravitational torque value which is a gravitational torque value acting on the joint in the corresponding minute motion range for each of the plurality of minute motion ranges;
• a torque-amplitude correlation calculation step of calculating the first amplitude function and the second amplitude function representing a correlation between the minute motion range amplitude and the corresponding gravitational torque value, the first amplitude function being a function calculated based on the minute motion range amplitude and the corresponding gravitational torque value in the minute motion range in which the corresponding gravitational torque value takes a negative value among the plurality of minute motion ranges calculated in the minute region amplitude/phase calculation step, the second amplitude function being a function calculated based on the minute motion range amplitude and the corresponding gravitational torque value in the minute motion range in which the corresponding gravitational torque value takes a positive value among the plurality of minute motion ranges calculated in the minute region amplitude/phase calculation step;
• a torque-phase correlation calculation step of calculating the first phase function and the second phase function representing the correlation between the minute motion range phase and the corresponding gravitational torque value, the first phase function being a function calculated based on the minute motion range phase and the corresponding gravitational torque value in the minute motion range in which the corresponding gravitational torque value takes a negative value among phases of the plurality of minute motion ranges calculated in the minute region amplitude/phase calculation step, the second phase function being a function calculated based on the minute motion range phase and the corresponding gravitational torque value in the minute motion range in which the corresponding gravitational torque value takes a positive value among the phase of the plurality of minute motion ranges calculated in the minute region amplitude/phase calculation step;
• and
• an identification step of calculating an amplitude parameter and a phase parameter of an angular transmission error identification function that models an angular transmission error of the speed reducer and has the amplitude parameter and the phase parameter, and identifying the angular transmission error using the angular transmission error identification function, in which, when a gravitational torque current value, which is a gravitational torque value acting on the joint when the angular transmission error of the speed reducer is identified, is included in a predetermined numerical range which is a negative numerical range, the identification step calculates the amplitude parameter corresponding to the gravitational torque current value using the first amplitude function, when the gravitational torque current value is included in the predetermined numerical range which is the negative numerical range, the identification step calculates the phase parameter corresponding to the gravitational torque current value using the first phase function, when the gravitational torque current value is included in a predetermined numerical range which is a positive numerical range, the identification step calculates the amplitude parameter corresponding to the gravitational torque current value using the second amplitude function, and when the gravitational torque current value is included in the predetermined numerical range which is the positive numerical range, the identification step calculates the phase parameter corresponding to the gravitational torque current value using the second phase function.

A robot system comprising an angular transmission error identification system that identifies an angular transmission error of a speed reducer of a robot arm including a joint that is rotationally driven by a motor via the speed reducer,

• the angular transmission error identification system comprising an identification unit that calculates an amplitude parameter and a phase parameter of an angular transmission error identification function, which is a periodic function that models an angular transmission error of the speed reducer and has the amplitude parameter and the phase parameter, and identifies the angular transmission error using the angular transmission error identification function,
• wherein, when a gravitational torque current value, which is a gravitational torque value acting on the joint when the angular transmission error of the speed reducer is identified, is included in a predetermined numerical range which is a negative numerical range, the identification unit calculates the amplitude parameter corresponding to the gravitational torque current value using a first amplitude function that represents a correlation between the amplitude parameter and the gravitational torque value acting on the joint in a motion range in which the gravitational torque value acting on the joint takes a negative value in a motion range of the joint, when the gravitational torque current value is included in the predetermined numerical range which is the negative numerical range, the identification unit calculates the phase parameter corresponding to the gravitational torque current value using a first phase function that represents the correlation between the phase parameter and the gravitational torque value acting on the joint in the motion range in which the gravitational torque value acting on the joint takes a negative value in the motion range of the joint, when the gravitational torque current value is included in a predetermined numerical range which is a positive numerical range, the identification unit calculates the amplitude parameter corresponding to the gravitational torque current value using a second amplitude function that represents a correlation between the amplitude parameter and the gravitational torque value acting on the joint in a motion range in which the gravitational torque value acting on the joint takes a positive value in the motion range of the joint, and when the gravitational torque current value is included in the predetermined numerical range which is the positive numerical range, the identification unit calculates the phase parameter corresponding to the gravitational torque current value using a second phase function that represents the correlation between the phase parameter and the gravitational torque value acting on the joint in the motion range in which the gravitational torque value acting on the joint takes a positive value in the motion range of the joint.