【不懂就问】新手第一次接触arduino,关于DMP的问题,求指导

qq_32336905 2016-03-17 09:13:53
从网上买的自平衡小车,正在看代码,关于DMP的函数找不到详细的资料,求大神指点!
这是源代码中的一段
void dmpSetSensorFusionAccelGain(uint8_t gain)
{
// INV_KEY_0_96
mpu.setMemoryBank(0);
mpu.setMemoryStartAddress(0x60);
mpu.writeMemoryByte(0);
mpu.writeMemoryByte(gain);
mpu.writeMemoryByte(0);
mpu.writeMemoryByte(0);
}
// 快速计算,从四元解obtein披角度
float dmpGetPhi() {
mpu.getFIFOBytes(fifoBuffer, 16); // 我们只看过四元
mpu.dmpGetQuaternion(&q, fifoBuffer);
mpu.resetFIFO(); //我们始终复位FIFO
//返回( asin(-2*(q.x * q.z - q.w * q.y)) * 180/M_PI); //roll
return (atan2(2*(q.y * q.z + q.w * q.x), q.w * q.w - q.x * q.x - q.y * q.y + q.z * q.z)* RAD2GRAD);
}
...全文
217 回复 打赏 收藏 转发到动态 举报
写回复
用AI写文章
回复
切换为时间正序
请发表友善的回复…
发表回复

27,372

社区成员

发帖
与我相关
我的任务
社区描述
硬件/嵌入开发 单片机/工控
社区管理员
  • 单片机/工控社区
加入社区
  • 近7日
  • 近30日
  • 至今
社区公告
暂无公告

试试用AI创作助手写篇文章吧