|
我使用的是DMP库,使用地址0x68读出来的who am I 和 product revision是错误的,用0xD0就分别能读出who am I = 0x68, product revision = 2,
这样初始化是没问题了,但用
dmp_read_fifo(gyro, accel, quat, &sensor_timestamp, &sensors, &more);
if (sensors & INV_WXYZ_QUAT )
{
q0=quat[0] / q30;
q1=quat[1] / q30;
q2=quat[2] / q30;
q3=quat[3] / q30;
Pitch = asin(-2 * q1 * q3 + 2 * q0* q2)* 57.3;
}
读取计算出来的Pitch 凌乱的一塌糊涂如下,不知有没有大侠遇到一样 的情况,求教。换了坛里几个人的程序都一样。
121610231808.00
60325412864.00
60325412864.00
75061665792.00
-36264484864.00
-36264484864.00
-95676702720.00
-49825787904.00
94968889344.00
94968889344.00
64128372736.00
-88298110976.00
76997623808.00
76997623808.00
93084368896.00
-39667388416.00
-39667388416.00
-1820559232.00
84966744064.00
-52093132800.00
|
阿莫论坛20周年了!感谢大家的支持与爱护!!
月入3000的是反美的。收入3万是亲美的。收入30万是移民美国的。收入300万是取得绿卡后回国,教唆那些3000来反美的!
|