初中生
最后登录1970-1-1
在线时间 小时
注册时间2015-5-6
|
MPU6050读出数据加速度和陀螺仪的正负是如何判断的,求大神请教,我要做正负的判断,请指导指导,这里只有数据没有正负的东西。
void MPU6050ReadAcc(short *accData)
{
u8 buf[6];
PMU6050_ReadData(MPU6050_ACC_OUT, buf, 6);
accData[0] = (buf[0] << 8) | buf[1];
accData[1] = (buf[2] << 8) | buf[3];
accData[2] = (buf[4] << 8) | buf[5];
}
void MPU6050ReadGyro(short *gyroData)
{
u8 buf[6];
PMU6050_ReadData(MPU6050_GYRO_OUT,buf,6);
gyroData[0] = (buf[0] << 8) | buf[1];
gyroData[1] = (buf[2] << 8) | buf[3];
gyroData[2] = (buf[4] << 8) | buf[5];
}
void MPU6050ReadTemp(short *tempData)
{
u8 buf[2];
PMU6050_ReadData(MPU6050_RA_TEMP_OUT_H,buf,2);
*tempData = (buf[0] << 8) | buf[1];
}
void MPU6050_ReturnTemp(short*Temperature)
{
short temp3;
u8 buf[2];
PMU6050_ReadData(MPU6050_RA_TEMP_OUT_H,buf,2);
temp3= (buf[0] << 8) | buf[1];
*Temperature=(((double) (temp3 + 13200)) / 280)-13;
|
|