看上去,你的这个程序不仅没有滤波,也没有做零偏校准。
一般来说每一个6050都是不一样的,在水平静止状态下,重力加速度的值,与角速度的值,都不是零,所以,要对水平静止状态下的数值进行采样,然后作为零偏校准数据,
再在进行计算时,需要把采样到的数值减去零偏数值才能作为正常的数值使用。
看上去,你的这个程序不仅没有滤波,也没有做零偏校准。
一般来说每一个6050都是不一样的,在水平静止状态下,重力加速度的值,与角速度的值,都不是零,所以,要对水平静止状态下的数值进行采样,然后作为零偏校准数据,
再在进行计算时,需要把采样到的数值减去零偏数值才能作为正常的数值使用。
举报