Patent ID: 11926054
Assignee: PANASONIC INTELLECTUAL PROPERTY MANAGEMENT CO., LTD.
Field: Handling (Mechanical engineering)
Classification: CPC B  G | IPC B  G

Claim 0:
1. A robot control method of controlling an operation of a robot arm including at least a first joint, a second joint, a third joint, and a fourth joint,
the first joint, the second joint, the third joint, and the fourth joint each having a rotary shaft,
the first joint and the fourth joint being configured such that tilts of the respective rotary shafts affect positional displacement of a tip of the robot arm, and
the second joint and the third joint being configured such that the rotary shaft of each of the second joint and the third joint rotates in a gravity direction, the robot control method comprising:
calculating a deflection angle of the first joint based on moment rigidity of the first joint and gravitational torque applied in a tilting direction of the rotary shaft of the first joint;
calculating a deflection angle of the second joint based on a spring constant of the second joint and gravitational torque applied in a pivoting direction of the second joint;
calculating a deflection angle of the third joint based on a spring constant of the third joint and gravitational torque applied in a pivoting direction of the third joint;
calculating a deflection angle of the fourth joint based on moment rigidity of the fourth joint and gravitational torque applied in a tilting direction of the rotary shaft of the fourth joint;
calculating a determination value based on a distance from a work point of the tip of the robot arm to a virtual straight line passing through an axis of the rotary shaft of the second joint and an axis of the rotary shaft of the third joint;
comparing the determination value with a predetermined threshold;
calculating a deflection compensation amount for the second joint based on deflection angles of the first joint, the second joint, and the fourth joint and calculating a deflection compensation amount for the third joint based on deflection angles of the first joint, the third joint, and the fourth joint when the determination value is larger than the predetermined threshold value;
calculating a deflection compensation amount for the second joint based on deflection angles of the first joint, the second joint, and the fourth joint, and the predetermined threshold value and calculating a deflection compensation amount for the third joint based on deflection angles of the first joint, the third joint, and the fourth joint, and the predetermined threshold value when the determination value is smaller than the predetermined threshold value; and
causing the second joint and the third joint to pivot based on the deflection compensation amounts for the second joint and the third joint.