简介面向嵌入式开发者的 MPU9250 九轴传感器移植例程重点解决把 STM32F4 上的惯性测量代码迁移到 STM32F1 时遇到的端口映射、中断向量、时钟配置与内存受限等问题可作为低成本运动检测、姿态解算与导航类项目的参考工程。包内共有 219 个文件以 68 个 .h 头文件和 46 个 .c 源文件为主另含 Keil 工程、编译中间文件以及少量 hex、map、bat 辅助文件压缩包约 4.48MB从 inv_mpu.c、inv_mpu_dmp_motion_driver.c、data_builder.c 与 stm32f10x 系列外设驱动可见内容围绕 MPU9250 初始化、DMP 运动数据读取和 STM32F1 底层适配展开。已有 2143 人学习下载说明其在同类移植问题上有一定参考价值。读者可重点参考其工程组织、驱动分层与传感器接口重配方式理解中断服务例程调整、时钟适配和资源裁剪思路便于快速定位驱动与工程配置适合具备一定 STM32 开发基础、正在做 F1 平台传感器移植的工程师对照学习。1. STM32F4 上跑通的 MPU9250 驱动搬到 STM32F1 为什么就读不出 0x71STM32F4 工程里跑得好好的 MPU9250 九轴驱动换到 STM32F1 上编译能过、下载能跑串口却吐出一串 0xFF连 WHO_AM_I 都读不出那个标志性的 0x71。这不是玄学问题基本都藏在那几行被原样照搬的底层接口里SPI 分频、CS 控制方式、AFIO 重映射、磁力计的访问路径每一处都在 F4 和 F1 之间换了一套规则。这份源码例程做的就是把这件事拆开——把初始化序列、SPI/I2C 读写、AK8963 磁力计接入、原始值换算和姿态融合逐层改成 F1 能跑的写法同时保留可以直接替换进现有工程的函数边界。适合手里已经有 F1 板子和九轴模块、想做倾角或姿态测量却在第一步读 ID 就卡住的嵌入式开发者。2. 摊开两颗芯片的差异F4 与 F1 的六个硬指标对照移植失败的原因八成不是驱动逻辑写错了而是底层假设错了。F4 工程里那些看起来理所当然的写法——42MHz 的 SPI 时钟、GPIO_PinAFConfig指定 AF 号、硬件 FPU 撑着的浮点运算——在 F1 上全部不成立。所以在动手改任何一个寄存器之前先把两颗芯片在六个维度上的实际差别列清楚比改完再调试要省事得多。下面这张表是移植时最该贴在屏幕边上的东西左边是 F4 工程的常见配置中间是 F1 的真实约束右边是对应的动作。可以看出需要修改的地方集中在时钟、GPIO 复用和算力预算三块传感器本身的寄存器序列几乎不用动——这也说明 MPU9250 这颗器件的驱动逻辑本身是跨平台稳定的麻烦都在怎么跟它说话上。指标STM32F4 典型工程STM32F1 典型工程移植动作主频168MHz72MHz重算延时循环核对 SysTick 分频SPI1 挂载总线APB284MHzAPB272MHz分频系数重算SPI1 速率上限APB2/2可到 42MHz手册限制 18MHz分频不小于 4GPIO 复用方式AF 编号 AFR 寄存器AFIO 时钟 重映射改初始化代码开 AFIO浮点运算硬件单精度 FPU无 FPU软件浮点禁 double慎用超越函数可用 RAM128KB 起20KB 到 64KB砍 DMP缩小缓冲区2.1 主频与 SPI 上限分频系数不能直接抄F4 工程里写SPI_BaudRatePrescaler_2在 APB2 为 84MHz 的情况下得到 42MHz 的 SCK 时钟MPU9250 数据手册标称 SPI 最高 20MHz所以很多人在这时候其实已经超频使用了只是因为 F4 的 GPIO 翻转快、走线短勉强能跑。把这行代码原封不动搬到 F1APB2 是 72MHz/2得到 36MHz超出手册标的 SPI1 上限 18MHz 整整一倍。现象很有迷惑性数据不是读不出来而是读出来在跳——静止放在桌上加速度 Z 轴在 0.7g 到 1.3g 之间乱蹦陀螺零偏看着像有几十度每秒的噪声。我一般的做法是把 SPI1 的时钟压到 9MHz72MHz 除以 8这个速率对 200Hz 的采样率来说完全够用一帧 20 字节的数据传输时间不到 20 微秒。如果板上走线短、器件是正品18MHz除以 4也能跑但没必要为了这点带宽去冒风险。/* F1 的 SPI1 初始化分频系数按 72MHz 主频重算目标是 9MHz */ void spi1_init(void) { SPI_InitTypeDef spi; spi.SPI_Direction SPI_Direction_2Lines_FullDuplex; spi.SPI_Mode SPI_Mode_Master; spi.SPI_DataSize SPI_DataSize_8b; spi.SPI_CPOL SPI_CPOL_High; /* MPU9250 支持模式 0 和模式 3 */ spi.SPI_CPHA SPI_CPHA_2Edge; /* 这里选模式 3CPOL1, CPHA1 */ spi.SPI_NSS SPI_NSS_Soft; /* 必须软件 NSS理由见 3.2 */ spi.SPI_BaudRatePrescaler SPI_BaudRatePrescaler_8; /* 72MHz / 8 9MHz */ spi.SPI_FirstBit SPI_FirstBit_MSB; spi.SPI_CRCPolynomial 7; SPI_Init(SPI1, spi); SPI_Cmd(SPI1, ENABLE); }SPI_CPOL_High配合SPI_CPHA_2Edge就是模式 3MPU9250 同时兼容模式 0 和模式 3两者选其一即可但整份代码里必须统一。曾经见过一半函数按模式 0 写、另一半按模式 3 配的工程表现是单字节读正常、突发读错位一位查了半天以为是时序问题其实是模式不一致。延时函数也要跟着改。F4 工程里常见的delay_us是靠空循环凑出来的循环次数按 168MHz 调好搬到 72MHz 上同样的循环次数实际延时不到原来的一半。初始化里的delay_ms(100)短一点无所谓但磁力计软复位后那个等待、以及 SPI 事务之间的空闲间隔靠空循环就不靠谱了。稳妥的做法是统一换成 SysTick 计数延时SystemCoreClock是多少就按多少算跟主频解耦。2.2 GPIO 复用AF 编号和 AFIO 重映射是两套语言F4 的复用功能靠GPIO_PinAFConfig(GPIOA, GPIO_PinSource5, GPIO_AF5_SPI1)指定把引脚和 AF 编号绑起来一个引脚可以挂十几个 AF。F1 完全是另一套复用功能是固定的引脚要么用默认映射要么整组重映射由 AFIO 外设的 MAPR 寄存器控制。所以从 F4 搬过来的GPIO_InitTypeDef里那个GPIO_Mode GPIO_MODE_AF_PP在 F1 的标准外设库里对应的是GPIO_Mode_AF_PP名字像、含义不同而且少了开启 AFIO 时钟这一步。更麻烦的是重映射的连带影响。如果板子把 SPI1 走到 PB3/PB4/PB5很常见的布局为了把 PA5/PA6/PA7 让给别的外设就必须先关掉 JTAG。PB3 默认是 JTDOPB4 默认是 NJTRST不关 JTAG 这两个脚根本不受 GPIO 控制你写再多初始化代码SCK 也没有波形。/* F1 上把 SPI1 重映射到 PB3/PB4/PB5三行代码少一行都不出波形 */ RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO | RCC_APB2Periph_GPIOB, ENABLE); /* 关 JTAG保留 SWD释放 PB3(JTDO) 和 PB4(NJTRST)下载调试不受影响 */ GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE); /* SPI1 整组重映射到 PB3/4/5 */ GPIO_PinRemapConfig(GPIO_Remap_SPI1, ENABLE);注意GPIO_Remap_SWJ_JTAGDisable而不是GPIO_Remap_SWJ_Disable后者会把 SWD 一起关掉下次就只能靠上电时序抢那几百毫秒的窗口来下载程序属于自己给自己挖坑。这类细节在 F4 工程里根本不会遇到因为 F4 没有 AFIO 这个概念。引脚模式配置也有差异F1 的 MISO 在标准库里要配GPIO_Mode_IN_FLOATING或者上拉输入SCK 和 MOSI 配GPIO_Mode_AF_PP速度建议 50MHz。F4 上统一配GPIO_MODE_AF_PP就行所以照抄到 F1 会把 MISO 也配成推挽输出结果就是 MISO 线上两个输出对顶读回来的永远是 0xFF 或者 0x00。2.3 内存与算力20KB RAM 里塞不塞得下 DMPF4 工程如果用了官方 DMP 方案那部分代码几乎是搬不过来的。DMP 固件本身占几 KB加上运动驱动库的缓冲区、四元数输出队列、事件回调RAM 占用很容易超过 10KB。F103C8 这类只有 20KB RAM 的型号扣掉栈、串口缓冲、其他外设剩下能给的不到 8KB链阶段不一定报错跑起来就是莫名奇妙的 HardFault 或者数据被踩。Flash 也是同理DMP 加库动辄二三十 KB64KB Flash 的型号装完就没多少空间了。所以我的建议很明确F1 上不要碰 DMP直接读原始寄存器自己算。九轴原始数据 20 字节一帧200Hz 采样也不过 4KB/s 的带宽姿态解算用一阶互补滤波或简化 Mahony代码量一两百行RAM 占用几百字节完全在 F1 的预算内。算力这块要提前有心理准备。F4 有单精度硬件 FPU一次浮点乘法一个周期Cortex-M3 没有 FPU浮点运算全靠软件模拟一次单精度乘法二三十个周期除法上百atan2f、sqrtf这类超越函数更贵double类型在 M3 上更是雪上加霜——编译器会用软件双精度库一次运算几百个周期。F4 工程里随手写的double angle atan2(y, x) * 180.0 / M_PI;搬到 F1 上就是每帧多出几毫秒的开销200Hz 的采样率直接被拖垮。提示移植第一步就把工程里所有double搜一遍能改float的全改掉。这一步通常能把姿态解算的耗时砍掉一半以上而且不损失精度——传感器的原始精度根本用不到双精度。预算怎么估以 72MHz 主频算假设姿态解算每帧允许 500 微秒那就是 36000 个周期。一阶互补滤波含两次atan2f和一次sqrtf软件浮点下大概要八九千个周期勉强够要是再加磁力计做九轴融合还得翻倍。所以第 6 章会专门讲怎么把这块压下来但在第 2 章这个阶段先把F1 上没有 FPU这件事记牢后面每一处浮点运算都要掂量一下。3. 接口层重写SPI 时序、CS 控制与 AK8963 的两条访问路径接口层是整个移植里最容易翻车的一层因为它牵涉到硬件时序、引脚配置和器件状态机三件事任何一处对不上表现都是读不到数据看不出区别。这一章把 SPI 单字节读、突发读、CS 控制方式以及磁力计 AK8963 的两条接入路径全部拆开写代码可以直接抄但每行的用意要清楚不然换个板子又得重来。先说清楚 MPU9250 的 SPI 协议约定地址字节的最高位是读写标志读操作要reg | 0x80写操作要reg 0x7F。SPI 是全双工主机发地址字节的同时从机也在往回送数据但那个字节是无效的必须再发一个哑字节通常写 0xFF才能换回真正的寄存器值。这两点在 F4 工程里一般已经写对了移植时不用改但调试的时候必须知道否则会怀疑是时序问题。3.1 单字节读、突发读与 CS 的拉法单字节读是最基础的原子操作突发读则是性能关键——读加速度、陀螺、磁力计一共 20 个字节如果每字节都走一次拉 CS、发地址、读数据、抬 CS的完整事务光 CS 翻转就够呛而且 MPU9250 在 CS 上升沿会把内部地址指针复位逐字节读反而更慢。正确做法是从 0x3BACCEL_XOUT_H开始一次突发读完 20 个字节寄存器地址是连续自增的。/* SPI1 单字节收发等待发送缓冲空 - 写 DR - 等待接收非空 - 读 DR */ static uint8_t spi1_xfer(uint8_t d) { while (SPI_I2S_GetFlagStatus(SPI1, SPI_I2S_FLAG_TXE) RESET); SPI_I2S_SendData(SPI1, d); while (SPI_I2S_GetFlagStatus(SPI1, SPI_I2S_FLAG_RXNE) RESET); return SPI_I2S_ReceiveData(SPI1); /* 读 DR 会同时清 RXNE 标志 */ } /* 读单个寄存器 */ uint8_t mpu_read_reg(uint8_t reg) { uint8_t v; MPU_CS_LOW(); spi1_xfer(reg | 0x80); /* 最高位置 1 表示读 */ v spi1_xfer(0xFF); /* 哑字节换回数据 */ MPU_CS_HIGH(); return v; } /* 从 reg 开始连续读 len 个字节用于一次取完 20 字节原始数据 */ void mpu_read_burst(uint8_t reg, uint8_t *buf, uint8_t len) { MPU_CS_LOW(); spi1_xfer(reg | 0x80); while (len--) { *buf spi1_xfer(0xFF); } MPU_CS_HIGH(); }MPU_CS_LOW()和MPU_CS_HIGH()是两个宏展开就是GPIO_ResetBits和GPIO_SetBitsCS 引脚配成普通推挽输出。这里有个细节值得说CS 拉高之后最好给一两个微秒的空闲再开始下一次事务MPU9250 靠 CS 上升沿判断事务结束并锁存数据连续事务之间完全没有间隔时偶尔会出现后一帧数据被前一帧覆盖的情况。在 9MHz 的 SPI 下一次 20 字节的突发读本身就要二十多微秒事务间隔反而不用太刻意但如果把 SPI 压到 1MHz 以下调试这个间隔就得显式加上。还有一个隐蔽的时间点问题MPU9250 上电后并不会自动进入 SPI 模式。器件靠 CS 引脚上的电平判断接口类型——CS 一直为高认为是 I2CCS 被主机拉低过才切换到 SPI。所以初始化流程里第一步必须是主动拉低一次 CS 再拉高哪怕不发任何数据。少了这一步读 WHO_AM_I 会稳定返回 0xFF 或 0x00很多人在这里以为是焊接虚焊把模块吹下来重焊了两遍。3.2 CS 用软件还是硬件 NSSF1 上必须选前者F1 的 SPI 外设有硬件 NSS 功能配置成SPI_NSS_Hard之后NSS 引脚由硬件自动管理多主机模式下还能做仲裁。听起来省事但用在 MPU9250 上会出事硬件 NSS 在每传输完一个字节后可能短暂拉高而 MPU9250 把 CS 的任何上升沿都当成事务结束于是 20 字节的突发读被切成了 20 次单字节事务地址指针每次都被复位读回来的数据全是第一个寄存器的值。所以SPI_NSS_Soft不是可选项是必须项。CS 用普通 GPIO 推挽输出代码里手动拉低拉高整个突发读期间保持低电平。这个习惯从 F4 带过来是对的但 F4 上硬件 NSS 的问题没这么明显时钟快高电平间隙短移植到 F1 后时钟变慢间隙被拉长问题就暴露了。血泪经验是只要是用 MPU9250 这类靠 CS 边沿分帧的器件不管什么平台一律软件 NSS。GPIO 初始化这块F1 的写法和 F4 差别不小特别是 MISO 的模式/* F1 的 SPI1 引脚配置注意 MISO 用浮空输入不是复用推挽 */ static void spi1_gpio_init(void) { GPIO_InitTypeDef gpio; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_SPI1, ENABLE); /* SCK(PA5) 和 MOSI(PA7)复用推挽输出 */ gpio.GPIO_Pin GPIO_Pin_5 | GPIO_Pin_7; gpio.GPIO_Mode GPIO_Mode_AF_PP; gpio.GPIO_Speed GPIO_Speed_50MHz; GPIO_Init(GPIOA, gpio); /* MISO(PA6)浮空输入配成输出会和从机对顶 */ gpio.GPIO_Pin GPIO_Pin_6; gpio.GPIO_Mode GPIO_Mode_IN_FLOATING; GPIO_Init(GPIOA, gpio); /* CS(PA4)普通推挽输出软件控制 */ gpio.GPIO_Pin GPIO_Pin_4; gpio.GPIO_Mode GPIO_Mode_Out_PP; GPIO_Init(GPIOA, gpio); GPIO_SetBits(GPIOA, GPIO_Pin_4); /* 默认拉高空闲状态 */ }这段代码里GPIO_Speed_50MHz对 MISO 那组不生效输入模式没有速度概念配了也无害。真正的重点是 MISO 必须是输入模式这是 F1 标准库和 F4 HAL 库在写法上最容易被忽略的差异之一。3.3 AK8963 的两条路BYPASS 直连与 I2C Master 转发MPU9250 里的磁力计不是直接挂在 SPI 总线上的它是独立的 I2C 从机地址 0x0C8 位写地址 0x18读地址 0x19通过 MPU9250 内部的 I2C 主控转发或者旁路出来。所以访问磁力计有两条路各有各的适用场景。第一条是 BYPASS 模式把INT_PIN_CFG0x37的 bit1 置 1MPU9250 内部会把 I2C 主控和辅助接口断开把 AK8963 的 SDA/SCL 直接旁路到主机总线。这时候主机 I2C 可以直接用 0x0C 地址访问磁力计配置起来直观。缺点是整个系统要多一路 I2C而且 BYPASS 期间 MPU9250 自己的 I2C 主控不能用。我一般用这条路径做磁力计的初始化和校准因为要连续读写好几个寄存器CNTL1、CNTL2、ASAX/Y/Z直连最省事。第二条是 I2C Master 转发MPU9250 内部的 I2C 主控按配置好的节奏自动去读 AK8963 的寄存器把结果放进EXT_SENS_DATA_000x49开始的区域。主机只需要一次 SPI 突发读就能同时拿到加速度、陀螺和磁力计数据时序上完全同步。这条路径适合跑起来之后的连续采样效率高。实际工程里两条路会一起用先用 BYPASS 直连把 AK8963 配置好、读出出厂灵敏度调整值然后关掉 BYPASS开 I2C Master 让它自动搬运数据。配置 I2C Master 的代码如下/* 关 BYPASS启动 MPU9250 内部 I2C 主控400kHz */ mpu_write_reg(MPU_INT_PIN_CFG, 0x00); mpu_write_reg(MPU_I2C_MST_CTRL, 0x0D); /* 400kHz 时钟与 AK8963 匹配 */ mpu_write_reg(MPU_USER_CTRL, 0x20); /* 使能 I2C_MST_EN */ /* SLV0读 AK8963 的 0x03 开始 8 个字节HXL~ST2 */ mpu_write_reg(MPU_I2C_SLV0_ADDR, 0x0C | 0x80); /* bit71 表示读低 7 位是从机地址 */ mpu_write_reg(MPU_I2C_SLV0_REG, AK_ST1); /* 从 ST1 开始一共 8 字节 */ mpu_write_reg(MPU_I2C_SLV0_CTRL, 0x88); /* bit7 使能 长度 8 */这里有个必须记住的细节读 8 个字节是从ST10x02开始的结束于ST20x09。ST2一定要读AK8963 用读 ST2这个动作来释放数据锁存不读 ST2 的话下一次测量结果不会更新磁力计数据会一直卡在第一次的值上。这是 AK8963 的器件特性在 F4 上一样成立但因为很多人移植时只改了 SPI 部分、磁力计部分照抄这个问题反而容易被带到新平台上排查时又因为加速度陀螺都在动就磁力计不动而误判成硬件故障。提示I2C_SLV0_CTRL的长度字段是要读的字节数最大 15。读磁力计时配 8ST1 6 字节数据 ST2刚好别图省事配成 7 把 ST2 漏掉。I2C_MST_CTRL里的 0x0D 是 400kHz 时钟分频值AK8963 最高支持 400kHz慢一点比如 0x07 对应约 200kHz在长走线或排线连接的模块上更稳但会增加一点读取延迟。如果磁力计数据偶尔出现 0 值或明显跳变先降这个时钟试试比换模块快。4. 初始化序列重排从复位到数据就绪的 11 个寄存器初始化序列的逻辑本身不依赖平台F4 上怎么写F1 上还怎么写但顺序和时序必须严格。很多移植后的读不到数据不是接口层的问题而是初始化中途失败了却没检查返回值一路往下跑最后读到的全是默认值。这一章把整个序列按实际执行顺序拆开每一步都说明白为什么要这么做、怎么判断这一步成功了。整个流程分四段接口探测确认器件活着、MPU 主体配置复位、唤醒、量程、滤波、磁力计配置旁路直连、读灵敏度、切连续测量、数据链路接通开 I2C Master、开中断或轮询。下面按段展开。4.1 接口探测与复位先确认能说话再谈配置第一步永远是读 WHO_AM_I0x75期望值 0x71。这一步失败后面全部免谈。失败原因按概率排CS 没有先拉低一次器件还在 I2C 模式、SPI 模式配错、分频太快、MISO 引脚模式配错。按这个顺序查比乱试快。确认能读到 0x71 之后再走软复位。PWR_MGMT_10x6B的 bit7 写 1 触发器件复位所有寄存器回到默认值器件进入睡眠模式。复位后必须等足够时间数据手册给的是 100ms实际工程里给 100ms 到 200ms 都行短了会出现后续写入不生效的情况。/* 第一步拉低一次 CS让 MPU9250 从 I2C 模式切到 SPI 模式 */ MPU_CS_LOW(); delay_us(10); MPU_CS_HIGH(); delay_us(10); /* 第二步确认器件在线 */ if (mpu_read_reg(MPU_WHO_AM_I) ! 0x71) { return MPU_ERR_ID; /* 到这一步就失败别往下跑 */ } /* 第三步软复位等 100ms 让内部寄存器恢复默认 */ mpu_write_reg(MPU_PWR_MGMT_1, 0x80); delay_ms(100); /* 第四步唤醒时钟源选自动PLL比内部 8MHz 振荡器稳 */ mpu_write_reg(MPU_PWR_MGMT_1, 0x01); delay_ms(10); /* 第五步三个轴全部使能不要留在待机 */ mpu_write_reg(MPU_PWR_MGMT_2, 0x00);PWR_MGMT_1写 0x01 这个值有讲究低三位是时钟源选择0 是内部 8MHz 振荡器1 是 PLL基于陀螺 X 轴后面还有几个外部时钟选项。选 PLL 的陀螺零偏随温度漂移会小一些代价是陀螺 X 轴必须处于使能状态所以第五步的PWR_MGMT_2写 0x00 不能省。有些工程为了省电关掉某些轴然后发现时钟不稳、数据抖动根子就在这里。4.2 量程与滤波三组寄存器的取值换算量程配置决定了后面的换算系数配错了数据不会报错但物理量整体偏大或偏小而且姿态解算会跟着一起歪。三组寄存器分别是陀螺量程GYRO_CONFIG0x1B、加速度量程ACCEL_CONFIG0x1C、以及两个数字低通滤波CONFIG0x1A 和ACCEL_CONFIG20x1D。寄存器关键位常用取值物理含义换算系数GYRO_CONFIG (0x1B)FS_SEL[1:0]0x00 / 0x08 / 0x10 / 0x18±250 / ±500 / ±1000 / ±2000 dps131 / 65.5 / 32.8 / 16.4 LSB/(°/s)ACCEL_CONFIG (0x1C)AFS_SEL[1:0]0x00 / 0x08 / 0x10 / 0x18±2 / ±4 / ±8 / ±16 g16384 / 8192 / 4096 / 2048 LSB/gCONFIG (0x1A)DLPF_CFG[2:0]0x03陀螺带宽 42Hz采样 1kHz决定陀螺噪声与延迟ACCEL_CONFIG2 (0x1D)A_DLPF_CFG[2:0]0x03加速度带宽 44Hz与陀螺尽量对齐SMPLRT_DIV (0x19)—0x04采样率 1000/(14) 200Hz与主循环节拍匹配选量程的原则是够用就好不要贪大。做倾角测量±2g 足够分辨率最高做剧烈运动的姿态捕捉±8g 或 ±16g 才不会削顶但分辨率会掉到四分之一甚至八分之一。陀螺同理手部动作跟踪 ±500dps 够用机械臂快速旋转可能要 ±2000dps。量程一旦改动换算函数里的系数必须同步改这是最容易漏的一步——代码里写死 16384配置却改成 ±4g结果算出来的加速度永远是实际值的一半姿态角看着稳定但不对排查起来非常费劲。采样率和滤波要一起看。SMPLRT_DIV设成 4采样率 200Hz对应的主循环周期就是 5ms。DLPF 带宽设成 42Hz意味着高于 42Hz 的振动会被滤掉但也会带来几毫秒的群延迟。做平衡车这类对延迟敏感的场合DLPF 要往高带宽调比如 0x01184Hz代价是噪声变大做静态倾角测量带宽可以压到 20Hz 以下数据会漂亮很多。加速度的ACCEL_CONFIG2建议跟陀螺的 DLPF 对齐两个传感器带宽差太多融合时会互相打架。4.3 磁力计接入Fuse ROM 模式、灵敏度调整与连续测量磁力计的初始化比加速度陀螺麻烦因为它有自己的状态机而且出厂校准数据藏在 Fuse ROM 里必须用特定模式才能读出来。整个流程是旁路直连、软复位、进 Fuse ROM 模式读三个灵敏度调整值、退出 Fuse ROM、进连续测量模式、最后关旁路交给 I2C Master。/* 开 BYPASS主机的 I2C 就能直接访问 0x0C 上的 AK8963 */ mpu_write_reg(MP p a hrefhttps://download.csdn.net/download/qq_26045215/11142112 stylecolor:#ec7500;font-size:14px; 本文还有配套的精品资源点击获取 /a img altmenu-r.4af5f7ec.gif srchttps://csdnimg.cn/release/wenkucmsfe/public/img/menu-r.4af5f7ec.gif stylewidth:16px;margin-left:4px;vertical-align:text-bottom;cursor:text; /p
简介面向嵌入式开发者的 MPU9250 九轴传感器移植例程重点解决把 STM32F4 上的惯性测量代码迁移到 STM32F1 时遇到的端口映射、中断向量、时钟配置与内存受限等问题可作为低成本运动检测、姿态解算与导航类项目的参考工程。包内共有 219 个文件以 68 个 .h 头文件和 46 个 .c 源文件为主另含 Keil 工程、编译中间文件以及少量 hex、map、bat 辅助文件压缩包约 4.48MB从 inv_mpu.c、inv_mpu_dmp_motion_driver.c、data_builder.c 与 stm32f10x 系列外设驱动可见内容围绕 MPU9250 初始化、DMP 运动数据读取和 STM32F1 底层适配展开。已有 2143 人学习下载说明其在同类移植问题上有一定参考价值。读者可重点参考其工程组织、驱动分层与传感器接口重配方式理解中断服务例程调整、时钟适配和资源裁剪思路便于快速定位驱动与工程配置适合具备一定 STM32 开发基础、正在做 F1 平台传感器移植的工程师对照学习。1. STM32F4 上跑通的 MPU9250 驱动搬到 STM32F1 为什么就读不出 0x71STM32F4 工程里跑得好好的 MPU9250 九轴驱动换到 STM32F1 上编译能过、下载能跑串口却吐出一串 0xFF连 WHO_AM_I 都读不出那个标志性的 0x71。这不是玄学问题基本都藏在那几行被原样照搬的底层接口里SPI 分频、CS 控制方式、AFIO 重映射、磁力计的访问路径每一处都在 F4 和 F1 之间换了一套规则。这份源码例程做的就是把这件事拆开——把初始化序列、SPI/I2C 读写、AK8963 磁力计接入、原始值换算和姿态融合逐层改成 F1 能跑的写法同时保留可以直接替换进现有工程的函数边界。适合手里已经有 F1 板子和九轴模块、想做倾角或姿态测量却在第一步读 ID 就卡住的嵌入式开发者。2. 摊开两颗芯片的差异F4 与 F1 的六个硬指标对照移植失败的原因八成不是驱动逻辑写错了而是底层假设错了。F4 工程里那些看起来理所当然的写法——42MHz 的 SPI 时钟、GPIO_PinAFConfig指定 AF 号、硬件 FPU 撑着的浮点运算——在 F1 上全部不成立。所以在动手改任何一个寄存器之前先把两颗芯片在六个维度上的实际差别列清楚比改完再调试要省事得多。下面这张表是移植时最该贴在屏幕边上的东西左边是 F4 工程的常见配置中间是 F1 的真实约束右边是对应的动作。可以看出需要修改的地方集中在时钟、GPIO 复用和算力预算三块传感器本身的寄存器序列几乎不用动——这也说明 MPU9250 这颗器件的驱动逻辑本身是跨平台稳定的麻烦都在怎么跟它说话上。指标STM32F4 典型工程STM32F1 典型工程移植动作主频168MHz72MHz重算延时循环核对 SysTick 分频SPI1 挂载总线APB284MHzAPB272MHz分频系数重算SPI1 速率上限APB2/2可到 42MHz手册限制 18MHz分频不小于 4GPIO 复用方式AF 编号 AFR 寄存器AFIO 时钟 重映射改初始化代码开 AFIO浮点运算硬件单精度 FPU无 FPU软件浮点禁 double慎用超越函数可用 RAM128KB 起20KB 到 64KB砍 DMP缩小缓冲区2.1 主频与 SPI 上限分频系数不能直接抄F4 工程里写SPI_BaudRatePrescaler_2在 APB2 为 84MHz 的情况下得到 42MHz 的 SCK 时钟MPU9250 数据手册标称 SPI 最高 20MHz所以很多人在这时候其实已经超频使用了只是因为 F4 的 GPIO 翻转快、走线短勉强能跑。把这行代码原封不动搬到 F1APB2 是 72MHz/2得到 36MHz超出手册标的 SPI1 上限 18MHz 整整一倍。现象很有迷惑性数据不是读不出来而是读出来在跳——静止放在桌上加速度 Z 轴在 0.7g 到 1.3g 之间乱蹦陀螺零偏看着像有几十度每秒的噪声。我一般的做法是把 SPI1 的时钟压到 9MHz72MHz 除以 8这个速率对 200Hz 的采样率来说完全够用一帧 20 字节的数据传输时间不到 20 微秒。如果板上走线短、器件是正品18MHz除以 4也能跑但没必要为了这点带宽去冒风险。/* F1 的 SPI1 初始化分频系数按 72MHz 主频重算目标是 9MHz */ void spi1_init(void) { SPI_InitTypeDef spi; spi.SPI_Direction SPI_Direction_2Lines_FullDuplex; spi.SPI_Mode SPI_Mode_Master; spi.SPI_DataSize SPI_DataSize_8b; spi.SPI_CPOL SPI_CPOL_High; /* MPU9250 支持模式 0 和模式 3 */ spi.SPI_CPHA SPI_CPHA_2Edge; /* 这里选模式 3CPOL1, CPHA1 */ spi.SPI_NSS SPI_NSS_Soft; /* 必须软件 NSS理由见 3.2 */ spi.SPI_BaudRatePrescaler SPI_BaudRatePrescaler_8; /* 72MHz / 8 9MHz */ spi.SPI_FirstBit SPI_FirstBit_MSB; spi.SPI_CRCPolynomial 7; SPI_Init(SPI1, spi); SPI_Cmd(SPI1, ENABLE); }SPI_CPOL_High配合SPI_CPHA_2Edge就是模式 3MPU9250 同时兼容模式 0 和模式 3两者选其一即可但整份代码里必须统一。曾经见过一半函数按模式 0 写、另一半按模式 3 配的工程表现是单字节读正常、突发读错位一位查了半天以为是时序问题其实是模式不一致。延时函数也要跟着改。F4 工程里常见的delay_us是靠空循环凑出来的循环次数按 168MHz 调好搬到 72MHz 上同样的循环次数实际延时不到原来的一半。初始化里的delay_ms(100)短一点无所谓但磁力计软复位后那个等待、以及 SPI 事务之间的空闲间隔靠空循环就不靠谱了。稳妥的做法是统一换成 SysTick 计数延时SystemCoreClock是多少就按多少算跟主频解耦。2.2 GPIO 复用AF 编号和 AFIO 重映射是两套语言F4 的复用功能靠GPIO_PinAFConfig(GPIOA, GPIO_PinSource5, GPIO_AF5_SPI1)指定把引脚和 AF 编号绑起来一个引脚可以挂十几个 AF。F1 完全是另一套复用功能是固定的引脚要么用默认映射要么整组重映射由 AFIO 外设的 MAPR 寄存器控制。所以从 F4 搬过来的GPIO_InitTypeDef里那个GPIO_Mode GPIO_MODE_AF_PP在 F1 的标准外设库里对应的是GPIO_Mode_AF_PP名字像、含义不同而且少了开启 AFIO 时钟这一步。更麻烦的是重映射的连带影响。如果板子把 SPI1 走到 PB3/PB4/PB5很常见的布局为了把 PA5/PA6/PA7 让给别的外设就必须先关掉 JTAG。PB3 默认是 JTDOPB4 默认是 NJTRST不关 JTAG 这两个脚根本不受 GPIO 控制你写再多初始化代码SCK 也没有波形。/* F1 上把 SPI1 重映射到 PB3/PB4/PB5三行代码少一行都不出波形 */ RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO | RCC_APB2Periph_GPIOB, ENABLE); /* 关 JTAG保留 SWD释放 PB3(JTDO) 和 PB4(NJTRST)下载调试不受影响 */ GPIO_PinRemapConfig(GPIO_Remap_SWJ_JTAGDisable, ENABLE); /* SPI1 整组重映射到 PB3/4/5 */ GPIO_PinRemapConfig(GPIO_Remap_SPI1, ENABLE);注意GPIO_Remap_SWJ_JTAGDisable而不是GPIO_Remap_SWJ_Disable后者会把 SWD 一起关掉下次就只能靠上电时序抢那几百毫秒的窗口来下载程序属于自己给自己挖坑。这类细节在 F4 工程里根本不会遇到因为 F4 没有 AFIO 这个概念。引脚模式配置也有差异F1 的 MISO 在标准库里要配GPIO_Mode_IN_FLOATING或者上拉输入SCK 和 MOSI 配GPIO_Mode_AF_PP速度建议 50MHz。F4 上统一配GPIO_MODE_AF_PP就行所以照抄到 F1 会把 MISO 也配成推挽输出结果就是 MISO 线上两个输出对顶读回来的永远是 0xFF 或者 0x00。2.3 内存与算力20KB RAM 里塞不塞得下 DMPF4 工程如果用了官方 DMP 方案那部分代码几乎是搬不过来的。DMP 固件本身占几 KB加上运动驱动库的缓冲区、四元数输出队列、事件回调RAM 占用很容易超过 10KB。F103C8 这类只有 20KB RAM 的型号扣掉栈、串口缓冲、其他外设剩下能给的不到 8KB链阶段不一定报错跑起来就是莫名奇妙的 HardFault 或者数据被踩。Flash 也是同理DMP 加库动辄二三十 KB64KB Flash 的型号装完就没多少空间了。所以我的建议很明确F1 上不要碰 DMP直接读原始寄存器自己算。九轴原始数据 20 字节一帧200Hz 采样也不过 4KB/s 的带宽姿态解算用一阶互补滤波或简化 Mahony代码量一两百行RAM 占用几百字节完全在 F1 的预算内。算力这块要提前有心理准备。F4 有单精度硬件 FPU一次浮点乘法一个周期Cortex-M3 没有 FPU浮点运算全靠软件模拟一次单精度乘法二三十个周期除法上百atan2f、sqrtf这类超越函数更贵double类型在 M3 上更是雪上加霜——编译器会用软件双精度库一次运算几百个周期。F4 工程里随手写的double angle atan2(y, x) * 180.0 / M_PI;搬到 F1 上就是每帧多出几毫秒的开销200Hz 的采样率直接被拖垮。提示移植第一步就把工程里所有double搜一遍能改float的全改掉。这一步通常能把姿态解算的耗时砍掉一半以上而且不损失精度——传感器的原始精度根本用不到双精度。预算怎么估以 72MHz 主频算假设姿态解算每帧允许 500 微秒那就是 36000 个周期。一阶互补滤波含两次atan2f和一次sqrtf软件浮点下大概要八九千个周期勉强够要是再加磁力计做九轴融合还得翻倍。所以第 6 章会专门讲怎么把这块压下来但在第 2 章这个阶段先把F1 上没有 FPU这件事记牢后面每一处浮点运算都要掂量一下。3. 接口层重写SPI 时序、CS 控制与 AK8963 的两条访问路径接口层是整个移植里最容易翻车的一层因为它牵涉到硬件时序、引脚配置和器件状态机三件事任何一处对不上表现都是读不到数据看不出区别。这一章把 SPI 单字节读、突发读、CS 控制方式以及磁力计 AK8963 的两条接入路径全部拆开写代码可以直接抄但每行的用意要清楚不然换个板子又得重来。先说清楚 MPU9250 的 SPI 协议约定地址字节的最高位是读写标志读操作要reg | 0x80写操作要reg 0x7F。SPI 是全双工主机发地址字节的同时从机也在往回送数据但那个字节是无效的必须再发一个哑字节通常写 0xFF才能换回真正的寄存器值。这两点在 F4 工程里一般已经写对了移植时不用改但调试的时候必须知道否则会怀疑是时序问题。3.1 单字节读、突发读与 CS 的拉法单字节读是最基础的原子操作突发读则是性能关键——读加速度、陀螺、磁力计一共 20 个字节如果每字节都走一次拉 CS、发地址、读数据、抬 CS的完整事务光 CS 翻转就够呛而且 MPU9250 在 CS 上升沿会把内部地址指针复位逐字节读反而更慢。正确做法是从 0x3BACCEL_XOUT_H开始一次突发读完 20 个字节寄存器地址是连续自增的。/* SPI1 单字节收发等待发送缓冲空 - 写 DR - 等待接收非空 - 读 DR */ static uint8_t spi1_xfer(uint8_t d) { while (SPI_I2S_GetFlagStatus(SPI1, SPI_I2S_FLAG_TXE) RESET); SPI_I2S_SendData(SPI1, d); while (SPI_I2S_GetFlagStatus(SPI1, SPI_I2S_FLAG_RXNE) RESET); return SPI_I2S_ReceiveData(SPI1); /* 读 DR 会同时清 RXNE 标志 */ } /* 读单个寄存器 */ uint8_t mpu_read_reg(uint8_t reg) { uint8_t v; MPU_CS_LOW(); spi1_xfer(reg | 0x80); /* 最高位置 1 表示读 */ v spi1_xfer(0xFF); /* 哑字节换回数据 */ MPU_CS_HIGH(); return v; } /* 从 reg 开始连续读 len 个字节用于一次取完 20 字节原始数据 */ void mpu_read_burst(uint8_t reg, uint8_t *buf, uint8_t len) { MPU_CS_LOW(); spi1_xfer(reg | 0x80); while (len--) { *buf spi1_xfer(0xFF); } MPU_CS_HIGH(); }MPU_CS_LOW()和MPU_CS_HIGH()是两个宏展开就是GPIO_ResetBits和GPIO_SetBitsCS 引脚配成普通推挽输出。这里有个细节值得说CS 拉高之后最好给一两个微秒的空闲再开始下一次事务MPU9250 靠 CS 上升沿判断事务结束并锁存数据连续事务之间完全没有间隔时偶尔会出现后一帧数据被前一帧覆盖的情况。在 9MHz 的 SPI 下一次 20 字节的突发读本身就要二十多微秒事务间隔反而不用太刻意但如果把 SPI 压到 1MHz 以下调试这个间隔就得显式加上。还有一个隐蔽的时间点问题MPU9250 上电后并不会自动进入 SPI 模式。器件靠 CS 引脚上的电平判断接口类型——CS 一直为高认为是 I2CCS 被主机拉低过才切换到 SPI。所以初始化流程里第一步必须是主动拉低一次 CS 再拉高哪怕不发任何数据。少了这一步读 WHO_AM_I 会稳定返回 0xFF 或 0x00很多人在这里以为是焊接虚焊把模块吹下来重焊了两遍。3.2 CS 用软件还是硬件 NSSF1 上必须选前者F1 的 SPI 外设有硬件 NSS 功能配置成SPI_NSS_Hard之后NSS 引脚由硬件自动管理多主机模式下还能做仲裁。听起来省事但用在 MPU9250 上会出事硬件 NSS 在每传输完一个字节后可能短暂拉高而 MPU9250 把 CS 的任何上升沿都当成事务结束于是 20 字节的突发读被切成了 20 次单字节事务地址指针每次都被复位读回来的数据全是第一个寄存器的值。所以SPI_NSS_Soft不是可选项是必须项。CS 用普通 GPIO 推挽输出代码里手动拉低拉高整个突发读期间保持低电平。这个习惯从 F4 带过来是对的但 F4 上硬件 NSS 的问题没这么明显时钟快高电平间隙短移植到 F1 后时钟变慢间隙被拉长问题就暴露了。血泪经验是只要是用 MPU9250 这类靠 CS 边沿分帧的器件不管什么平台一律软件 NSS。GPIO 初始化这块F1 的写法和 F4 差别不小特别是 MISO 的模式/* F1 的 SPI1 引脚配置注意 MISO 用浮空输入不是复用推挽 */ static void spi1_gpio_init(void) { GPIO_InitTypeDef gpio; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_SPI1, ENABLE); /* SCK(PA5) 和 MOSI(PA7)复用推挽输出 */ gpio.GPIO_Pin GPIO_Pin_5 | GPIO_Pin_7; gpio.GPIO_Mode GPIO_Mode_AF_PP; gpio.GPIO_Speed GPIO_Speed_50MHz; GPIO_Init(GPIOA, gpio); /* MISO(PA6)浮空输入配成输出会和从机对顶 */ gpio.GPIO_Pin GPIO_Pin_6; gpio.GPIO_Mode GPIO_Mode_IN_FLOATING; GPIO_Init(GPIOA, gpio); /* CS(PA4)普通推挽输出软件控制 */ gpio.GPIO_Pin GPIO_Pin_4; gpio.GPIO_Mode GPIO_Mode_Out_PP; GPIO_Init(GPIOA, gpio); GPIO_SetBits(GPIOA, GPIO_Pin_4); /* 默认拉高空闲状态 */ }这段代码里GPIO_Speed_50MHz对 MISO 那组不生效输入模式没有速度概念配了也无害。真正的重点是 MISO 必须是输入模式这是 F1 标准库和 F4 HAL 库在写法上最容易被忽略的差异之一。3.3 AK8963 的两条路BYPASS 直连与 I2C Master 转发MPU9250 里的磁力计不是直接挂在 SPI 总线上的它是独立的 I2C 从机地址 0x0C8 位写地址 0x18读地址 0x19通过 MPU9250 内部的 I2C 主控转发或者旁路出来。所以访问磁力计有两条路各有各的适用场景。第一条是 BYPASS 模式把INT_PIN_CFG0x37的 bit1 置 1MPU9250 内部会把 I2C 主控和辅助接口断开把 AK8963 的 SDA/SCL 直接旁路到主机总线。这时候主机 I2C 可以直接用 0x0C 地址访问磁力计配置起来直观。缺点是整个系统要多一路 I2C而且 BYPASS 期间 MPU9250 自己的 I2C 主控不能用。我一般用这条路径做磁力计的初始化和校准因为要连续读写好几个寄存器CNTL1、CNTL2、ASAX/Y/Z直连最省事。第二条是 I2C Master 转发MPU9250 内部的 I2C 主控按配置好的节奏自动去读 AK8963 的寄存器把结果放进EXT_SENS_DATA_000x49开始的区域。主机只需要一次 SPI 突发读就能同时拿到加速度、陀螺和磁力计数据时序上完全同步。这条路径适合跑起来之后的连续采样效率高。实际工程里两条路会一起用先用 BYPASS 直连把 AK8963 配置好、读出出厂灵敏度调整值然后关掉 BYPASS开 I2C Master 让它自动搬运数据。配置 I2C Master 的代码如下/* 关 BYPASS启动 MPU9250 内部 I2C 主控400kHz */ mpu_write_reg(MPU_INT_PIN_CFG, 0x00); mpu_write_reg(MPU_I2C_MST_CTRL, 0x0D); /* 400kHz 时钟与 AK8963 匹配 */ mpu_write_reg(MPU_USER_CTRL, 0x20); /* 使能 I2C_MST_EN */ /* SLV0读 AK8963 的 0x03 开始 8 个字节HXL~ST2 */ mpu_write_reg(MPU_I2C_SLV0_ADDR, 0x0C | 0x80); /* bit71 表示读低 7 位是从机地址 */ mpu_write_reg(MPU_I2C_SLV0_REG, AK_ST1); /* 从 ST1 开始一共 8 字节 */ mpu_write_reg(MPU_I2C_SLV0_CTRL, 0x88); /* bit7 使能 长度 8 */这里有个必须记住的细节读 8 个字节是从ST10x02开始的结束于ST20x09。ST2一定要读AK8963 用读 ST2这个动作来释放数据锁存不读 ST2 的话下一次测量结果不会更新磁力计数据会一直卡在第一次的值上。这是 AK8963 的器件特性在 F4 上一样成立但因为很多人移植时只改了 SPI 部分、磁力计部分照抄这个问题反而容易被带到新平台上排查时又因为加速度陀螺都在动就磁力计不动而误判成硬件故障。提示I2C_SLV0_CTRL的长度字段是要读的字节数最大 15。读磁力计时配 8ST1 6 字节数据 ST2刚好别图省事配成 7 把 ST2 漏掉。I2C_MST_CTRL里的 0x0D 是 400kHz 时钟分频值AK8963 最高支持 400kHz慢一点比如 0x07 对应约 200kHz在长走线或排线连接的模块上更稳但会增加一点读取延迟。如果磁力计数据偶尔出现 0 值或明显跳变先降这个时钟试试比换模块快。4. 初始化序列重排从复位到数据就绪的 11 个寄存器初始化序列的逻辑本身不依赖平台F4 上怎么写F1 上还怎么写但顺序和时序必须严格。很多移植后的读不到数据不是接口层的问题而是初始化中途失败了却没检查返回值一路往下跑最后读到的全是默认值。这一章把整个序列按实际执行顺序拆开每一步都说明白为什么要这么做、怎么判断这一步成功了。整个流程分四段接口探测确认器件活着、MPU 主体配置复位、唤醒、量程、滤波、磁力计配置旁路直连、读灵敏度、切连续测量、数据链路接通开 I2C Master、开中断或轮询。下面按段展开。4.1 接口探测与复位先确认能说话再谈配置第一步永远是读 WHO_AM_I0x75期望值 0x71。这一步失败后面全部免谈。失败原因按概率排CS 没有先拉低一次器件还在 I2C 模式、SPI 模式配错、分频太快、MISO 引脚模式配错。按这个顺序查比乱试快。确认能读到 0x71 之后再走软复位。PWR_MGMT_10x6B的 bit7 写 1 触发器件复位所有寄存器回到默认值器件进入睡眠模式。复位后必须等足够时间数据手册给的是 100ms实际工程里给 100ms 到 200ms 都行短了会出现后续写入不生效的情况。/* 第一步拉低一次 CS让 MPU9250 从 I2C 模式切到 SPI 模式 */ MPU_CS_LOW(); delay_us(10); MPU_CS_HIGH(); delay_us(10); /* 第二步确认器件在线 */ if (mpu_read_reg(MPU_WHO_AM_I) ! 0x71) { return MPU_ERR_ID; /* 到这一步就失败别往下跑 */ } /* 第三步软复位等 100ms 让内部寄存器恢复默认 */ mpu_write_reg(MPU_PWR_MGMT_1, 0x80); delay_ms(100); /* 第四步唤醒时钟源选自动PLL比内部 8MHz 振荡器稳 */ mpu_write_reg(MPU_PWR_MGMT_1, 0x01); delay_ms(10); /* 第五步三个轴全部使能不要留在待机 */ mpu_write_reg(MPU_PWR_MGMT_2, 0x00);PWR_MGMT_1写 0x01 这个值有讲究低三位是时钟源选择0 是内部 8MHz 振荡器1 是 PLL基于陀螺 X 轴后面还有几个外部时钟选项。选 PLL 的陀螺零偏随温度漂移会小一些代价是陀螺 X 轴必须处于使能状态所以第五步的PWR_MGMT_2写 0x00 不能省。有些工程为了省电关掉某些轴然后发现时钟不稳、数据抖动根子就在这里。4.2 量程与滤波三组寄存器的取值换算量程配置决定了后面的换算系数配错了数据不会报错但物理量整体偏大或偏小而且姿态解算会跟着一起歪。三组寄存器分别是陀螺量程GYRO_CONFIG0x1B、加速度量程ACCEL_CONFIG0x1C、以及两个数字低通滤波CONFIG0x1A 和ACCEL_CONFIG20x1D。寄存器关键位常用取值物理含义换算系数GYRO_CONFIG (0x1B)FS_SEL[1:0]0x00 / 0x08 / 0x10 / 0x18±250 / ±500 / ±1000 / ±2000 dps131 / 65.5 / 32.8 / 16.4 LSB/(°/s)ACCEL_CONFIG (0x1C)AFS_SEL[1:0]0x00 / 0x08 / 0x10 / 0x18±2 / ±4 / ±8 / ±16 g16384 / 8192 / 4096 / 2048 LSB/gCONFIG (0x1A)DLPF_CFG[2:0]0x03陀螺带宽 42Hz采样 1kHz决定陀螺噪声与延迟ACCEL_CONFIG2 (0x1D)A_DLPF_CFG[2:0]0x03加速度带宽 44Hz与陀螺尽量对齐SMPLRT_DIV (0x19)—0x04采样率 1000/(14) 200Hz与主循环节拍匹配选量程的原则是够用就好不要贪大。做倾角测量±2g 足够分辨率最高做剧烈运动的姿态捕捉±8g 或 ±16g 才不会削顶但分辨率会掉到四分之一甚至八分之一。陀螺同理手部动作跟踪 ±500dps 够用机械臂快速旋转可能要 ±2000dps。量程一旦改动换算函数里的系数必须同步改这是最容易漏的一步——代码里写死 16384配置却改成 ±4g结果算出来的加速度永远是实际值的一半姿态角看着稳定但不对排查起来非常费劲。采样率和滤波要一起看。SMPLRT_DIV设成 4采样率 200Hz对应的主循环周期就是 5ms。DLPF 带宽设成 42Hz意味着高于 42Hz 的振动会被滤掉但也会带来几毫秒的群延迟。做平衡车这类对延迟敏感的场合DLPF 要往高带宽调比如 0x01184Hz代价是噪声变大做静态倾角测量带宽可以压到 20Hz 以下数据会漂亮很多。加速度的ACCEL_CONFIG2建议跟陀螺的 DLPF 对齐两个传感器带宽差太多融合时会互相打架。4.3 磁力计接入Fuse ROM 模式、灵敏度调整与连续测量磁力计的初始化比加速度陀螺麻烦因为它有自己的状态机而且出厂校准数据藏在 Fuse ROM 里必须用特定模式才能读出来。整个流程是旁路直连、软复位、进 Fuse ROM 模式读三个灵敏度调整值、退出 Fuse ROM、进连续测量模式、最后关旁路交给 I2C Master。/* 开 BYPASS主机的 I2C 就能直接访问 0x0C 上的 AK8963 */ mpu_write_reg(MP p a hrefhttps://download.csdn.net/download/qq_26045215/11142112 stylecolor:#ec7500;font-size:14px; 本文还有配套的精品资源点击获取 /a img altmenu-r.4af5f7ec.gif srchttps://csdnimg.cn/release/wenkucmsfe/public/img/menu-r.4af5f7ec.gif stylewidth:16px;margin-left:4px;vertical-align:text-bottom;cursor:text; /p
