基于先验动力学知识的机器人参数识别及接触力监测方法

摘要

本发明为基于先验动力学知识的机器人参数识别及接触力监测方法，该方法通过编码器获得机器人的关节位置和速度信息、关节加速度信息，数据采集卡实时采集电机驱动器模拟量监测端的电流信息处理后得到的实际关节力矩；控制机器人在空间内做尽量多的不同轨迹的运动，同时采集其在不同时刻的角度、角速度、角加速度、实际力矩作为样本，通过梯度下降法离线学习，辨识出机器人的动力学参数，得到机器人的理想动力学模型；在实时监测过程中，通过采集和处理的电流信息，带入理想动力学模型，得到机器人在此时刻的理论力矩；将实际关节力矩和理论力矩比较，若相差超出阈值范围内则表示发生了碰撞。该方法能实现在低成本下准确获取接触力数据。