The invention discloses an IMU (
Inertial Measurement Unit)
drift error calibration method for long-term attitude measurement of an
industrial robot. The IMU
drift error calibration method comprises the following steps: deducing a
pose matrix between a
robot base coordinate
system and a navigation coordinate
system; deriving a
pose matrix between a
robot tail end coordinate
system and a sensor body coordinate system;
kinematics modeling is conducted on the
industrial robot, and motion parameters are obtained; deriving a
homogeneous transformation matrix between two adjacent joints according to the kinematic parameters; acquiring actual joint corner information when the
robot runs and actual information measured by a
tail end IMU when the robot runs; wherein the actual information of the IMU comprises actual
angular velocity information and actual attitude information; the collected actual
joint rotation angle information is substituted into the
homogeneous transformation matrix, theoretical attitude information of the
tail end of the robot is obtained, and the theoretical attitude information is converted into a navigation coordinate system; converting the theoretical attitude information converted into the navigation coordinate system into an Euler angle; designing a
Kalman filter; according to a
Kalman filter, data fusion of theoretical attitude information and actual attitude information is completed, and calibration is achieved. According to the method,
joint angle information, the
industrial robot end theoretical attitude obtained through
forward kinematics calculation of the
kinematics model and actual attitude data obtained through IMU measurement are fused, and accumulated error calibration formed in long-term attitude measurement of the IMU is achieved.