STM32F407 + MPU6500 + 4.3寸TFTLCD：10Hz 实时姿态显示与 45° 倾角报警实战

前言：本周的实训任务是把手头的 MPU6500 六轴传感器数据搬到 TFTLCD 屏幕上，并在 X 轴倾斜超过 45° 时给出红色报警提示。整个项目基于 STM32CubeIDE + HAL 库开发，跑在 STM32F407ZGT6（探索者开发板）上。功能不复杂，但把「传感器驱动 → 数据换算 → LCD 刷新 → 状态报警」整条链路跑通，对嵌入式入门来说是个非常典型的练手项目。下面把实现思路和踩过的坑记录一下。

---

一、硬件与环境

硬件/软件	说明
主控板	STM32F407ZGT6 探索者开发板
显示屏	4.3 寸 TFTLCD（读取到的 LCD ID：35918）
传感器	MPU6500 六轴 IMU（三轴加速度 + 三轴陀螺仪）
IDE	STM32CubeIDE（HAL 库）
调试器	ST-Link

工程按模块拆分：app_lcd.c 负责 LCD 显示任务，IMU 部分封装了统一的采样接口 IMU_ReadSample()，主循环只管「取数据 → 画界面」，层次比较清晰。

二、实现思路

整体流程一句话概括：上电自检 → 主循环 10Hz 轮询 IMU → LCD 分区刷新 → 超阈值点亮红色报警。

上电
 ├─ LCD 初始化，打印 LCD ID
 ├─ MPU6500 初始化，打印 IMU OK / 失败
 └─ while(1) 主循环
      ├─ IMU_ReadSample() 读取一次采样
      ├─ 显示三轴加速度 (AX/AY/AZ，青色)
      ├─ 显示三轴角速度 (GX/GY/GZ，品红色)
      └─ |AX| > 6.93 m/s² ?
           ├─ 是 → 红字 "WARNING: Tilt 45 Degrees"
           └─ 否 → 白字 "Status: OK"

上电自检时屏幕顶部依次打印标题、LCD ID 和 IMU 状态（绿色 IMU OK），这样一上电就能快速判断「屏幕好没好、传感器通没通」，排错效率很高，建议大家在类似项目里都保留这个习惯。

三、核心代码解析

主循环任务位于 app_lcd.c 中，逻辑如下：

/* USER CODE BEGIN 3 */
if (imu_ok)
{
    ImuSample_t s;
    if (IMU_ReadSample(&s))
    {
        /* --- 1. LCD 数据显示 --- */
        /* 加速度 (m/s^2): y=80, 110, 140 */
        LCD_ShowString(20, 80,  "AX:", LCD_WHITE,  LCD_BLACK);
        LCD_ShowFloat (56, 80,  s.ax, LCD_CYAN,   LCD_BLACK);
        LCD_ShowString(20, 110, "AY:", LCD_WHITE,  LCD_BLACK);
        LCD_ShowFloat (56, 110, s.ay, LCD_CYAN,   LCD_BLACK);
        LCD_ShowString(20, 140, "AZ:", LCD_WHITE,  LCD_BLACK);
        LCD_ShowFloat (56, 140, s.az, LCD_CYAN,   LCD_BLACK);

        /* 角速度 (deg/s): y=170, 200, 230 */
        LCD_ShowString(20, 170, "GX:", LCD_WHITE,  LCD_BLACK);
        LCD_ShowFloat (56, 170, s.gx, LCD_MAGENTA, LCD_BLACK);
        LCD_ShowString(20, 200, "GY:", LCD_WHITE,  LCD_BLACK);
        LCD_ShowFloat (56, 200, s.gy, LCD_MAGENTA, LCD_BLACK);
        LCD_ShowString(20, 230, "GZ:", LCD_WHITE,  LCD_BLACK);
        LCD_ShowFloat (56, 230, s.gz, LCD_MAGENTA, LCD_BLACK);

        /* --- 2. X轴 45度倾角报警判断 --- */
        const float threshold = 6.93f;  // 45度时X轴的加速度阈值 (9.8 * sin45° ≈ 6.93)
        // 使用 fabsf(s.ax) 取绝对值，向左或向右倾斜超过45度都会报警
        if (fabsf(s.ax) > threshold)
        {
            // 屏幕下方显示红色的报警提示文字
            LCD_ShowString(20, 260, "WARNING: Tilt 45 Degrees", LCD_RED, LCD_BLACK);
        }
        else
        {
            // 角度正常时，显示提示或清除报警区域文字
            LCD_ShowString(20, 260, "Status: OK           ", LCD_WHITE, LCD_BLACK);
        }

        HAL_Delay(100); // 10Hz 刷新
    }
}
/* USER CODE END 3 */

1. 显示布局：坐标分区是关键

屏幕内容按 Y 坐标分区排版，加速度三行（y = 80/110/140）、角速度三行（y = 170/200/230）、报警状态一行（y = 260），标签用白色、数值用青色/品红色，黑底上一眼就能区分。标签和数值分开画（ShowString + ShowFloat），可以避免每次刷新都重画整块区域，也方便对数值列对齐。

2. 45° 报警的数学原理

这里用的是重力静态投影法：

• 板子水平静止时，Z 轴承受全部重力，AZ ≈ 9.8 m/s²，AX ≈ 0；
• 绕 Y 轴倾斜 θ 角后，重力在 X 轴上的投影为 AX = 9.8 × sinθ；
• 当 θ = 45° 时，AX = 9.8 × sin45° ≈ 6.93 m/s²，所以阈值取 6.93f。

再配合 fabsf(s.ax) 取绝对值，向左倾或向右倾超过 45° 都会触发，逻辑非常简洁。

注意：这种方法只在静止或缓慢倾斜时成立，快速运动时加速度计读数叠加了运动加速度，会产生误报。这也是为什么工程上一般要融合陀螺仪数据（互补滤波/卡尔曼），后面会说。

3. 状态行文字覆盖的小细节

报警文字比正常状态的文字长，如果只写 "Status: OK"，从 WARNING 切回 OK 时旧的尾部字符会残留在屏幕上。所以代码里给 "Status: OK" 后面补了一串空格，用黑底空格把旧内容「刷掉」——在无区域清除功能的简单 LCD 驱动上，这是最省事的残影处理方式。

4. 刷新率控制

HAL_Delay(100) 把主循环限制在 10Hz。LCD 全屏刷字符串本身不快，刷太快会闪烁且浪费 CPU，10Hz 对肉眼看数据来说完全够用，也让 IMU_ReadSample 有充足时间完成一次采样。

四、踩坑记录

1. LCD ID 一定要先确认：换屏或换驱动后先打印 LCD ID（本例为 35918），ID 对不上驱动，后面的花屏、白屏都白调。
2. fabsf 而不是 abs：abs 是整型取绝对值，浮点要用 fabsf，否则阈值判断会出诡异结果。
3. 长字符串会被屏宽截断：竖屏宽度有限，WARNING: Tilt 45 Degrees 这种长文案在屏幕上显示不全，要么缩短文案，要么调整字号/换行。
4. 报警/正常状态文字长度不一致会导致残影：用空格补齐覆盖，或者干脆固定两个等长字符串。
5. 自检信息上屏：IMU OK 打印在屏幕上比打印在串口里直观得多，现场没有串口助手时尤其好用。

五、运行效果

• 水平静止：加速度 X/Y 接近 0，Z 接近 9.8；晃动板子时陀螺仪 GY/GZ 数值明显跳动；
• 缓慢倾斜越过 45°：屏幕下方立刻切红色 WARNING，回正后恢复 Status: OK，响应及时，无闪烁。

六、总结与扩展方向

本项目完整走通了「IMU 采样 → 数据换算 → LCD 分区刷新 → 阈值报警」的最小闭环。后续可以从几个方向继续加餐：

• 用 atan2 直接算出倾角并在屏幕上显示角度值，比阈值判断更直观；
• 加入互补滤波，融合陀螺仪数据，动态场景下也不会误报；
• 增加速度/曲线显示，把姿态数据画成实时波形；
• 通过串口/蓝牙把数据上报上位机，做进一步分析。

如果这篇文章对你有帮助，欢迎点赞、收藏、评论区交流～

标签：STM32、MPU6500、TFTLCD、HAL库、嵌入式、倾角检测

七、课上实践图