机械臂六维力传感器重力补偿原理-Toy模板网

这篇具有很好参考价值的文章主要介绍了机械臂六维力传感器重力补偿原理。希望对大家有所帮助。如果存在错误或未考虑完全的地方，请大家不吝赐教，您也可以点击"举报违法"按钮提交疑问。

重力补偿原理

1.力传感器数据分析

机械臂力传感器,工业机器人,算法,python,人工智能

将六维力传感器三个力分量与力矩分量的零点值分别记为 $F_{x0},F_{y0},F_{z0})$ ， $M_{x0},M_{y0},M_{z0})$ ，

传感器与末端工装重力为 $G$ ,质心在六维力传感器坐标系中的坐标为 $(x, y, z)$ ，

重力 $G$ 在三个坐标轴方向上的分力与作用力矩分别为 $G_x,G_y,G_z)$ ， $M_{gx},M_{gy},M_{gz})$ 。

根据力与力矩的关系可以得到（正方向由右手定则确定）：
$\left\{ \begin{array}{c} M_{gx}=G_z \times y-G_y \times z\\ M_{gy}=G_x \times z-G_z \times x\\ M_{gz}=G_y \times x-G_x \times y \end{array} \right.$
将六维力传感器直接测量得到的三个方向的力分量与力矩分量分别记为 $F_x,F_y,F_z)$ ， $M_x,M_y,M_z)$ ，

假设标定的时候没有外部作用力在末端夹持器上，则力传感器所测得的力和力矩由负载重力及零点组成，则有
$\left\{ \begin{array}{c} F_x=G_x+F_{x0}\\ F_y=G_y+F_{y0}\\ F_z=G_z+F_{z0} \end{array} \right.$

$\left\{ \begin{array}{c} M_x=M_{gx}+M_{x0}\\ M_y=M_{gy}+M_{y0}\\ M_z=M_{gz}+M_{z0} \end{array} \right.$

联立得：
$\left\{ \begin{array}{c} M_x=(F_z-F_{z0}) \times y-(F_y-F_{y0}) \times z+M_{x0}\\ M_y=(F_x-F_{x0}) \times z-(F_z-F_{z0}) \times x+M_{y0}\\ M_z=(F_y-F_{y0}) \times x-(F_x-F_{x0}) \times y+M_{z0} \end{array} \right.$

$\left\{ \begin{array}{c} M_x=F_z \times y - F_y \times z + M_{x0} + F_{y0} \times z -F_{z0} \times y \\ M_y=F_x \times z - F_z \times x + M_{y0} + F_{z0} \times x -F_{x0} \times z \\ M_z=F_y \times x - F_x \times y + M_{z0} + F_{x0} \times y -F_{y0} \times x \end{array} \right.$ 文章来源地址https://www.toymoban.com/news/detail-705972.html