Robot system
Provided is a robot system that can accurately sense contact between an arm of a robot or an instrument attached to the arm and another object. The robot system includes: a robot main body 22 and a robot control unit 21 , the robot main body 22 including: a motor 8 ; a deceleration device 19 connected to a motor shaft 17 of the motor 8 ; an arm 15 connected to an output shaft 16 of the deceleration device 19 ; a motor shaft-side angular sensor 1 capable of detecting an angle of rotation of the motor shaft 17 of the motor 8 ; and an output shaft-side angular sensor 2 capable of detecting an angle of rotation of the output shaft 16 of the deceleration device 19 , and the robot control unit 21 being configured to detect a contact state between the arm 15 or an instrument attached to the arm 15 and another object, based on a motor shaft-side rotation angle detected by the motor shaft-side angular sensor 1 , an output shaft-side rotation angle detected by the output-side angular sensor 2 , and an angular sensor misalignment correction value for the motor shaft-side angular sensor 1 and the output shaft-side angular sensor 2.
1. A robot system comprising:
a robot main body and a robot control unit,
the robot main body including:
a motor;
a deceleration device connected to a motor shaft of the motor;
an arm connected to an output shaft of the deceleration device;
a motor shaft-side angular sensor configured to detect an angle of rotation of the motor shaft of the motor; and
an output shaft-side angular sensor configured to detect an angle of rotation of the output shaft of the deceleration device, and
the robot control unit being configured to detect a contact state between the arm or an instrument attached to the arm and another object,
wherein the robot control unit includes;
an angular sensor misalignment correction value storage unit in which an angular sensor misalignment correction value is stored, the angular sensor misalignment correction value being calculated based on an amount of misalignment when the motor shaft-side angular sensor and the output shaft-side angular sensor are attached;
a motor shaft-side angle calculation unit configured to calculate a motor shaft-side angle based on the angle of rotation on the motor shaft side;
an output shaft-side angle calculation unit configured to calculate an output shaft-side angle based on the angle of rotation on the output shaft side;
a torsional deformation amount calculation unit configured to calculate an angular difference between the motor shaft-side angle and the output shaft-side angle, and correct the calculated angular difference using the angular sensor misalignment correction value to obtain a torsional deformation amount;
a spring constant storage unit in which a spring constant of a region from the motor to the arm is stored;
a contact determination threshold storage unit in which an allowable contact torque of the arm is stored; and
a contact determination unit configured to calculate contact torque of the arm based on the torsional deformation amount and the spring constant stored in the spring constant storage unit, and detect the contact state when the calculated contact torque is larger than the allowable contact torque stored in the contact determination threshold storage unit.
2. The robot system according to claim 1 , wherein the robot control unit further includes a motor control instruction unit configured to stop the motor if the contact state is sensed by the contact determination unit.
3. The robot system according to claim 2 , wherein the robot control unit further includes:
a contact response gain storage unit in which a gain of the arm that responds to the contact torque is stored; and
a motor control instruction unit configured to drive the motor at a speed obtained by multiplying a difference between the contact torque and the allowable contact torque by the gain, if the contact state is sensed by the contact determination unit.
4. The robot system according to claim 1 ,
wherein the robot control unit further includes:
a contact response gain storage unit in which a gain of the arm that responds to the contact torque is stored; and
a motor control instruction unit configured to drive the motor at a speed obtained by multiplying a difference between the contact torque and the allowable contact torque by the gain, if the contact state is sensed by the contact determination unit.