Based on the 6-axis force/torque sensor mounted on the robot wrist, a estimating and computing method is studied to obtain the force between the load and nearby object. In the method, the gravity of load, bias of the sensor, installing angle of the robot are overall considered. Using the sensor data of not less than 3 robot orientations, all these parameters can be calculated, include the bias of sensor, installing angle of the robot, the gravity of the load and the coordinate of gravity center. Using the result, the influence of the load gravity and bias of sensor on the data of the sensor can be compensated, and the external force on the load can be precisely obtained. In the experiments, sensing the external force/torque for the loads from 320 N to 1917 N at static state, the error of force is not more than 0.28%of the load gravity, and the error of torque is not more than 0.59%of the torque caused by the load gravity.%针对工业机器人末端负载与外界环境接触力的感知需求,在机器人法兰与负载之间设置六维力传感器,并研究一套标定与计算方法,综合考虑负载重力作用、传感器零点、机器人安装倾角等因素,利用不少于3个机器人姿态下的力传感器数据,可求得传感器零点、机器人安装倾角、负载重力大小、负载重心坐标等参数,进一步可消除传感器零点及负载重力对受力感知的影响,精确得到机器人末端负载所受的外部作用力与力矩.实验得到对于重量从320 N到1917 N的负载,在静态条件下,感知外力的误差在负载重力的0.28%以内,感知外力矩的误差在负载对传感器力矩的0.59%以内.
展开▼
