案例 关于倾角计的原理

 

倾角里面只有加计,没有陀螺

sum是个数组 

sum[0]代表了X轴加速度计

sum[1]代表了Y轴加速度计

这里是在T时间段进行求和。

 

 然后套用下面公式,计算出角度:

 

 这里除以T是为了求取平均,然后这个时间T是很短暂的。

之后计算出的P和R

 

posted @ 2020-12-05 12:42  GXTon  阅读(527)  评论(0编辑  收藏  举报