四元数姿态解算详细步骤
获取陀螺仪和加速度计原始数据short gryox,gyroy,gyroz;short accx,accy,accz;void IMU_GetData(void){ MPU_Get_Gyroscope(&gyrox,&gyroy,&gyroz); MPU_Get_Accelerometer(&accx,&accy,&accz);}定义变量#define RtA 57.295779f //弧度->角度 #define.
复制链接