一种动态补偿机器人直线导轨运动误差的方法

摘要

本发明公开了一种动态补偿机器人直线导轨运动误差的方法，包括：S10、基于运动学方程，得到机器人当前时刻的状态向量估计值与其上一时刻的状态向量最优值之间的关系式，以及该两者的协方差的关系式；S20、在直线导轨上安装位移传感器，获得机器人的实际位移值及其协方差；S30、将当前时刻机器人的状态向量估计值及其协方差、实际位移值及其协方差代入卡尔曼滤波算法中，得到当前时刻的状态向量最优值；S40、将当前时刻的状态向量最优值作为S10中机器人上一时刻的状态向量最优值，重复上述步骤，进行迭代，得到机器人最终时刻的精确位置；S50、将最终时刻的精确位置与理论位置作差补偿。本发明可以动态补偿机器人的运动误差。