本帖最后由 xyc2690 于 2015-1-29 17:09 编辑 7 r R: m {3 H' N, R7 c
( A' z3 a8 s9 q2 e1 u9 m 功能:DMP读取MPU6050四元数,转换成欧拉角。 8 x: \9 @9 E) P- Z9 | 引脚:5 R1 A7 {/ M. S7 y7 S: L6 d& P MPU6050:: H3 \ A; m: O SCL-->PB8 SDA-->PB9 ADO-->GND4 g4 }$ g8 v$ _ p2 c4 |7 Z USART1: Tx PA9 官方提供的DMP移植到Nucleo F072RB; X+ S9 b! @) c0 @+ _ + n/ H& B5 ?$ y z7 _8 w( C3 Z 欧拉角:Roll Pitch Yaw N+ F& x | j! [ 2s左右初始化建立时间。1 D( X; d5 ]6 Q% p! t0 d# m8 [9 O 0 R3 |- {) s3 C) z; s; q/ U' D& S Roll和Pitch比较稳定。静止时数据没有漂移。 Yaw会漂移,MPU6050,6轴无法校正。需要用磁力传感器。
之前直接去读原始数据,读出三轴加速度和三轴角加速度,但是数据融合一直不好,要做平衡车的话用到俯仰角和一轴角加速度就行了,后来才发现用DMP处理好的数据更方便。网上有许多移植到STM32F103的,但是手头没有103的板子,加上准备学习用新的HAL库,于是折腾了2天移植到活动送的NucleoF072上,IIC比较关键,认真的做好时序之后会很省心。最后读出的四元数是Q30的,要除一下。
IIC驱动那边需要注意一下,6050官方库里的函数返回值,成功返回0,异常返回-1,-2 等。 一般写1表示成功,0表示失败。大家移植的时候注意一下。9 j# c: `0 W! N8 N8 ^* T) X 存在FIFO溢出的问题,具体在dmp_read_fifo()函数里的mpu_read_fifo_stream()的最后
暂时把它注释掉了,有人知道如何解决吗? & j4 P) t% }$ q) a( f 参加活动有NucleoF072rb的板子并且有MPU6050的朋友可以试一下; B6 ]; _3 G2 e W1 [ 程序:
Nocleo_soft_i2c_test1 - ç§»æ¤å¤±è´¥1失败2失败3æå4.zip
(4.07 MB, 下载次数: 2995)
|
STM32MP157双A核Linux + 自研RTOS双系统镜像免费下载
DMA 原理从 0 到 1:为什么它能解放 CPU?一文讲透 DMA 的工作流程
STM32MP1 自举程序编程:USB DFU/USART 协议全解析
小白也能明白的STM32的低功耗与唤醒机制
实战经验 | 如何配置STM32MP257的RMII Switch
STM32系统中2种数据掉电保护的方法
分享STM32F051中文参考手册(重制书签版)
AI工具训练营-用ChatGPT解决HID Keyboard实现的问题
STM32固件库分享,超全系列整理
OpenSTLinux 6.1发布:M33-TD加持+安全升级,STM32MPU开发效率翻倍!
微信公众号
手机版
也是用的减速电机,# K! v5 k, g h) N+ O; c
电机的话看参数:电流/扭矩常数、电压/转速常数
选力矩大一些的电机就行了。
好的,多谢,回头做了还需要楼主多多指点!
电机好好选哈~
多谢版主的开发板
可是我手里只有那种TT电机,楼主选的是什么电机?
好诡异的关注点哈哈