需要使用到(mahony互补滤波、卡尔曼滤波)来消除误差
传感器的初始读数为该次通电的零点和工具的重力之和构成,工具重力随着机器人关节角度可以变化,但机器人的零点在同一次通电过程一般无变化,所以计算传感器零点