一种用于带有力传感器初始值的力牵引重力补偿方法

摘要

本发明公开了一种用于带有力传感器初始值的力牵引重力补偿方法，包括：获取末端执行工具不受外力且机器人处于不同姿态下的多组六维力传感器测量数据；根据不同姿态下的六维力传感器测量数据为固定值建立方程组，并利用最小二乘法求解最优值，求得六维力传感器初始值参数；根据六维力传感器初始值参数获取末端执行工具重力、末端执行工具质心在六维力传感器的坐标和六维力传感器力矩初始值；求解六维力传感器坐标系相对于机器人基坐标系的位姿变换；求解外界所施加给六维力传感器的力和力矩。用于有效对工具重力进行参数估计，实现工具重力补偿。