从MPU6050和arduino获得自由旋转

时间:2017-03-13 10:18:59

标签: angle mpu6050

我正在使用Jeff库从MPU6050获取旋转数据。 但有个问题 ! Jeff lib

杰夫代码输出0到360度。这意味着我们没有361度!和更多。 在我的项目中,我需要自由旋转。例如800度或-1250度......

我想这部分库必须改变:

uint8_t MPU6050::dmpGetYawPitchRoll(float *data, Quaternion *q, VectorFloat *gravity) {
    // yaw: (about Z axis)
    data[0] = atan2(2*q -> x*q -> y - 2*q -> w*q -> z, 2*q -> w*q -> w + 2*q -> x*q -> x - 1);
    // pitch: (nose up/down, about Y axis)
    data[1] = atan(gravity -> x / sqrt(gravity -> y*gravity -> y + gravity -> z*gravity -> z));
    // roll: (tilt left/right, about X axis)
    data[2] = atan(gravity -> y / sqrt(gravity -> x*gravity -> x + gravity -> z*gravity -> z));
    return 0;
}

但我没有数学知识。 : - [

请帮我这样做。 非常感谢...

0 个答案:

没有答案