# MSPM0 **Repository Path**: vsght/mspm0 ## Basic Information - **Project Name**: MSPM0 - **Description**: No description available - **Primary Language**: Unknown - **License**: Not specified - **Default Branch**: main - **Homepage**: None - **GVP Project**: No ## Statistics - **Stars**: 0 - **Forks**: 0 - **Created**: 2026-07-26 - **Last Updated**: 2026-07-28 ## Categories & Tags **Categories**: Uncategorized **Tags**: None ## README # 21 送药小车 基于 TI MSPM0G3507 微控制器的智能送药小车,集成了循迹、色块追踪、原地旋转等多种运动控制模式,通过摄像头、灰度传感器、陀螺仪、VL53L0X、超声波等多传感器融合实现自主导航。 ## 硬件平台 - **MCU**: TI MSPM0G3507(ARM Cortex-M0+,80MHz,LQFP-64 封装) - **开发工具**: Code Composer Studio (CCS) 12.x+ / SysConfig 1.26+ - **SDK**: mspm0_sdk@2.10.00.04 ## 项目结构 ``` ├── main.c / main.h # 主程序入口 ├── config.syscfg # SysConfig 外设配置文件(引脚与外设分配的唯一来源) ├── App/ # 应用层(非阻塞状态机,Init → Tick → Start/Stop) │ ├── ColorTrack/ # 摄像头色块追踪 + VL53L0X 测距 │ ├── LineFollow/ # 八路循迹传感器 + 陀螺仪循迹 │ ├── RALineFollow/ # 矩形直角赛道循迹(无陀螺仪) │ ├── GrayscaleLineFollow/ # 八路数字灰度循迹(PD + 速度PID) │ ├── DistanceLineFollow2/ # 基于摄像头距离的分阶段循迹 │ ├── DistanceLineFollow3/ # 距离循迹变体 │ └── Rotation/ # 基于摄像头IMU的原地旋转控制 ├── Drivers/ # 驱动层 │ ├── Motor/ # 双路直流电机 + 编码器 + PWM + PID │ ├── Grayscale/ # 8路数字灰度传感器(AD0/AD1/AD2地址选择 + OUT读取) │ ├── Track/ # 极光哨卫T8八路灰度传感器 UART 驱动 │ ├── MPU92/ # MPU9250/6500 IMU 初始化与零偏标定(I2C) │ ├── Gyro/ # 独立陀螺仪模组 UART 驱动 │ ├── Cam/ # 摄像头 UART 文本通信 │ ├── Bluez/ # 蓝牙透传 UART 驱动(VOFA上位机) │ ├── VL53L0X/ # 激光测距传感器 I2C 驱动 │ ├── Ultrasonic_Capture/ # 超声波测距(Trig/Echo + 定时器) │ ├── Key/ # 四路物理按键扫描(20ms消抖) │ ├── OLED_Software_I2C/ # 软件I2C SSD1306 OLED显示驱动 │ ├── SEG/ # 74HC595 四位七段数码管驱动 │ ├── MOS/ # 大功率MOS模块GPIO开关驱动 │ └── MSPM0/ # 系统时钟(SysTick 1ms节拍)与延时 └── Debug/ # CCS编译输出(.o / .d / .map 等) ``` --- ## 引脚分配总览 以下引脚分配来自 `config.syscfg`,由 SysConfig 自动生成 `ti_msp_dl_config.h/.c`。 ### 电机驱动(Motor) | 功能 | 引脚 | 外设 | 说明 | |------|------|------|------| | 左电机 PWM | PA12 | TIMG0 CC0 (PWM_MOTOR) | 10kHz,占空比 0~100 | | 右电机 PWM | PA13 | TIMG0 CC1 | 同上 | | 左电机方向 AIN1 | PB21 | GPIO 输出 | AIN1=H, AIN2=L 正转 | | 左电机方向 AIN2 | PB22 | GPIO 输出 | | | 右电机方向 BIN1 | PB12 | GPIO 输出 | BIN1=H, BIN2=L 正转 | | 右电机方向 BIN2 | PB13 | GPIO 输出 | | ### 编码器 | 功能 | 引脚 | 外设 | 说明 | |------|------|------|------| | 左编码器 A 相 | PB4 | GPIO 输入,双边沿中断 | GPIO 中断单相 2x 计数,PPR=13,每转26计数 | | 左编码器 B 相 | PB5 | GPIO 输入 | 用于方向判断 | | 右编码器 PHA | PA29 | TIMG8 硬件 QEI (QEI_MOTOR) | 硬件双相 4x 计数,PPR=13,每转52计数 | | 右编码器 PHB | PA30 | TIMG8 硬件 QEI | | ### 舵机(Servo) | 功能 | 引脚 | 外设 | |------|------|------| | 舵机 CH0 | PB14 | TIMA0 CC0 (PWM_SERVO) | | 舵机 CH1 | PB9 | TIMA0 CC1 | | 舵机 CH2 | PB20 | TIMA0 CC2 | ### 通信接口 | 模块 | 实例名 | 外设 | TX 引脚 | RX 引脚 | 波特率 | |------|--------|------|---------|---------|--------| | 极光哨卫T8循迹传感器 | UART_TRACK | UART0 | PA0 | PA1 | 115200 | | 独立陀螺仪模组 | UART_GYRO | UART1 | PA8 | PA9 | 115200 | | 蓝牙透传(VOFA) | UART_BLUEZ | UART2 | PB17 | PB18 | 115200 | | 摄像头 IMU | UART_CAM | UART3 | PA26 | PA25 | 115200 | | MPU9250/6500 | I2C_GYRO | I2C0 | — | SDA=PA28, SCL=PA31 | 400kHz | > **注意**: MSPM0G3507 共 4 个 UART 实例,本项目已全部使用。 ### 灰度传感器(Grayscale) 8 路数字灰度模块,通过 3 根地址线选择通道,单根 OUT 线读取数字电平。 | 功能 | 引脚 | 方向 | 说明 | |------|------|------|------| | AD0(地址 bit0) | PA18 | 输出 | 3 位地址选择 0~7 通道 | | AD1(地址 bit1) | PB25 | 输出 | | | AD2(地址 bit2) | PB24 | 输出 | | | OUT(数据) | PA24 | 输入 | 选中通道的数字电平(0=黑线,1=白底) | ### 超声波测距(当前禁用) PB15 已改作 `GPIO_MOS` 输出,原超声波 TRIG/ECHO GPIO 已从 SysConfig 移除,`Drivers/Ultrasonic_Capture` 也已从当前构建排除。 ### 按键(Key) | 功能 | 引脚 | 配置 | |------|------|------| | KEY0 | PA10 | GPIO 输入,内部上拉 | | KEY1 | PA11 | GPIO 输入,内部上拉 | | KEY2 | PA7 | GPIO 输入,内部上拉 | | KEY3 | PA2 | GPIO 输入,内部上拉 | ### OLED 显示(软件 I2C) | 功能 | 引脚 | |------|------| | SCL | PB2 | | SDA | PB3 | ### 四位七段数码管(双 74HC595) | 功能 | 引脚 | 配置 | |------|------|------| | SCLK(移位时钟) | PA14 | GPIO 推挽输出,初始低 | | RCLK(锁存时钟) | PA16 | GPIO 推挽输出,初始低 | | DIO(串行数据) | PA17 | GPIO 推挽输出,初始低 | 数码管使用现有 SysTick 每 1ms 扫描一位,不额外占用定时器。 ### 大功率 MOS 模块 | 功能 | 引脚 | 外设 | 配置 | |------|------|------|------| | IO/PWM | PB15 | GPIO 输出 | 初始低电平 | MOS模块控制输入高电平有效,使用独立的5~24V负载电源。 ### 其他 GPIO | 功能 | 引脚 | 说明 | |------|------|------| | LED0 | PB19 | GPIO 输出 | | LED1 | PA21 | GPIO 输出 | | LED2 | PA23 | GPIO 输出 | | 蜂鸣器 | PA22 | GPIO 输出 | ### 调试接口 | 功能 | 引脚 | |------|------| | SWDIO | PA19 | | SWCLK | PA20 | ### GPIO 中断分组 GPIOB GROUP1 当前仅由 **PB4** 左编码器 A 相双边沿中断使用。 ### VL53L0X 激光测距(待集成) VL53L0X 驱动代码 (`Drivers/VL53L0X/vl53l0x.h`) 中注释记录了设计意图引脚,但 **SysConfig 中尚未配置**,需手动添加: | 功能 | 预定引脚 | 说明 | |------|----------|------| | I2C SDA | PA16 | 需在 SysConfig 中新建 I2C 实例 | | I2C SCL | PA17 | | | XSHUT(复位) | PA15 | GPIO 输出(与声音传感器引脚冲突,需二选一) | | GPIO1(中断) | PA14 | 与数码管 SCLK 冲突 | > **当前冲突**:PA14、PA16、PA17 已分配给数码管。后续集成 > VL53L0X 时,必须移动数码管引脚或重新选择 VL53L0X 引脚。 --- ## 外设资源占用汇总 | 外设 | 实例 | 分配给 | |------|------|--------| | UART0 | UART_TRACK | 极光哨卫T8循迹传感器 | | UART1 | UART_GYRO | 独立陀螺仪模组 | | UART2 | UART_BLUEZ | 蓝牙透传 | | UART3 | UART_CAM | 摄像头 IMU | | I2C0 | I2C_GYRO | MPU9250/6500 | | TIMG0 | PWM_MOTOR | 左右电机 PWM | | TIMA0 | PWM_SERVO | 舵机 PWM(3 通道) | | TIMG8 | QEI_MOTOR | 右编码器硬件 QEI | | TIMG6 | TIMER_ULTRASONIC | 超声波测距定时 | | SysTick | — | 1ms 系统节拍(clock 模块) | | GPIOB GROUP1 | — | 左编码器 PB4 | --- ## 驱动层详解(Drivers) 所有驱动在 `SYSCFG_DL_init()` 之后调用各自的 `Init()` 函数初始化。 ### Motor — 电机驱动 双路直流电机控制,含编码器测速和 PID 速度闭环。 **关键参数**: - PWM 频率: 10kHz(TIMG0,1MHz 时钟 / 周期 100) - 电机减速比: 28:1 - 左编码器: GPIO 中断单相双边沿 2x 计数(每转 26 计数) - 右编码器: TIMG8 硬件 QEI 双相双边沿 4x 计数(每转 52 计数) - PID 默认参数: Kp=100.0, Ki=25.0, Kd=0.2 - 速度采样周期: 10ms,一阶低通滤波系数 0.20 **使用步骤**: ```c // 1. 初始化(SYSCFG_DL_init() 之后) Motor_Init(); Encoder_Init(); Motor_PID_Init(); // 2. 开环控制(直接设置功率) Motor_SetPower(50, 50); // 左右各50%功率前进 Motor_SetPower(-30, 30); // 左退右进,原地右转 Motor_SetPower(0, 0); // 停车 // 3. 闭环速度控制(PID) Motor_PID_Enable(); Motor_Set_TargetSpeed(2.0f, 2.0f); // 左右目标 2.0 RPS // 4. 主循环中必须持续调用 while (1) { Encoder_Update(); // 每次循环都要调用,内部按10ms节流 // ... 其他逻辑 } // 5. 读取实际速度 float speed_l = Encoder_GetSpeedRPS_L(); // 左轮实际转速(RPS) float speed_r = Encoder_GetSpeedRPS_R(); // 右轮实际转速(RPS) // 6. 距离闭环(通过累计编码器脉冲) Encoder_ResetAccum_R(); // ... 直行一段距离后 int32_t pulses = Encoder_GetAccum_R(); // 正=前进,负=后退 // 7. 在线调参 Motor_PID_SetGains(120.0f, 30.0f, 0.3f); // 8. 停止 Motor_PID_Disable(); Motor_SetPower(0, 0); ``` **常用函数速查**: | 函数 | 用途 | |------|------| | `Motor_SetPower(l, r)` | 开环功率控制,-100~100 | | `Motor_PID_Enable()` | 启用速度闭环 | | `Motor_Set_TargetSpeed(l, r)` | 设置目标转速(RPS) | | `Motor_PID_Disable()` | 关闭速度闭环 | | `Motor_PID_SetGains(kp, ki, kd)` | 在线调节 PID 参数 | | `Encoder_Update()` | 主循环中持续调用,更新速度并执行 PID | | `Encoder_GetSpeedRPS_L/R()` | 读取滤波后的实际转速 | | `Encoder_ResetAccum_R()` / `Encoder_GetAccum_R()` | 距离闭环 | --- ### Grayscale — 8 路数字灰度传感器 通过 AD0/AD1/AD2 三根地址线选择 0~7 通道,从 OUT 引脚读取数字电平。每个通道切换后需等待 200us 稳定时间,全 8 通道扫描约 1.6ms。 **使用步骤**: ```c // 1. 初始化 Grayscale_Init(); // 2. 读取单个通道 uint8_t val = Grayscale_ReadChannel(3); // 读取第4通道,返回0或1 // 3. 读取全部8通道 uint8_t values[8]; Grayscale_ReadAll(values); // values[0]~values[7] 对应 X1~X8 // 4. 读取全部通道并打包成一个字节(快速读取) uint8_t packed = Grayscale_ReadPacked(); // bit0=X1, bit7=X8 ``` **电平约定**: 0=黑线,1=白底。若传感器模块输出相反,修改 `grayscale.h` 中的 `GRAYSCALE_OUTPUT_INVERTED` 宏为 1。 --- ### Track — 极光哨卫 T8 八路循迹传感器(UART) 通过 UART 二进制协议与传感器通信,支持 8 路数字量和 8 路 16 位 ADC 数据。 **使用步骤**: ```c // 1. 初始化(自动发送首次查询) Track_Init(); // 2. 主循环中持续轮询 while (1) { // 检查是否有新数据 if (Track_New_Data()) { uint8_t is_digital = Track_Handle_Data(); if (is_digital) { // 数字量已更新,读取结果 uint8_t *digital = Track_Number(); // 0=黑,1=白,[0]~[7] } else { // ADC 数据已更新 uint16_t *adc = Track_Anglo(); // 16位ADC值,[0]~[7] } } // 请求下一次数据(数字量和ADC交替查询) Track_Request_Data(); } ``` --- ### Cam — 摄像头 UART 文本通信 接收摄像头通过 UART 发送的文本行(如 IMU Yaw 数据),环形缓冲区 + 中断接收。 **数据格式**: `imu yaw:\r\n`,每 50ms 发送一次。 **使用步骤**: ```c // 1. 初始化 Cam_Init(); // 2. 主循环中读取文本行 char line[CAM_LINE_MAX_LENGTH]; while (1) { if (Cam_ReadLine(line, sizeof(line))) { // 成功读到一行非空文本 // 解析 "imu yaw:12.34" 等格式 } } // 3. 向摄像头发送指令(阻塞) Cam_SendString("get yaw\r\n"); // 4. 调试:检查是否丢失数据 uint32_t overflow = Cam_GetOverflowCount(); // 正常应为0 ``` --- ### Bluez — 蓝牙透传(VOFA 上位机) 与 Cam 模块接口完全一致的蓝牙 UART 驱动,用于连接 VOFA 上位机调试。 **使用步骤**: ```c // 1. 初始化 Bluez_Init(); // 2. 接收指令 char cmd[BLUEZ_LINE_MAX_LENGTH]; if (Bluez_ReadLine(cmd, sizeof(cmd))) { // 解析指令,如 "L90"、"R45"、"STOP" } // 3. 发送数据到VOFA(FireWater格式) char buf[32]; snprintf(buf, sizeof(buf), "yaw:%.2f\r\n", yaw_angle); Bluez_SendString(buf); ``` **当前协议指令**: - `"test"` — 上电自检 - `"stop"` — 立即停车 --- ### Key — 四路物理按键 非阻塞扫描,20ms 消抖,一次长按只触发一次,松开后才能再次触发。 **使用步骤**: ```c // 1. 初始化 KEY_Init(); // 2. 主循环中扫描 while (1) { KeyId_t key = KEY_ScanNonBlock(); switch (key) { case KEY_ID_0: /* KEY0 按下 */ break; case KEY_ID_1: /* KEY1 按下 */ break; case KEY_ID_2: /* KEY2 按下 */ break; case KEY_ID_3: /* KEY3 按下 */ break; case KEY_ID_NONE: /* 无新事件 */ break; } // 或读取实时状态 if (KEY_IsPressed(KEY_ID_0)) { // KEY0 当前被按住 } } ``` --- ### OLED — SSD1306 软件 I2C 显示 128x64 像素 OLED,软件模拟 I2C,无硬件 I2C 依赖。 **坐标系**: x=0~127(横向像素),y=0~7(页坐标,每页 8 像素)。 **使用步骤**: ```c // 1. 初始化 OLED_Init(); OLED_Clear(); // 2. 显示字符串 OLED_ShowString(0, 0, (uint8_t *)"Hello", 16); // 第1行,16号字 // 3. 显示数字 OLED_ShowNum(0, 2, 12345, 5, 8); // 第3行,5位数,8号字 // 4. 显示浮点数 OLED_ShowFloat(0, 3, 3.14f, 1, 2, 8); // 整数1位,小数2位 // 5. 显示汉字(需要字库支持) OLED_ShowChinese(0, 4, 0, 16); // 字库中第0个汉字 // 6. 显示位图 OLED_DrawBMP(0, 0, 128, 8, image_data); // 7. 控制 OLED_DisplayTurn(1); // 旋转180度 OLED_ColorTurn(1); // 反色显示 OLED_Display_Off(); // 关闭显示(省电) ``` --- ### SEG — 双 74HC595 四位七段数码管 模块接口为 `VCC / SCLK / RCLK / DIO / GND`,使用三根 GPIO 完成 串行移位和锁存。当前模块为四位共阳数码管,段线低电平点亮,物理位选 顺序与逻辑显示顺序相反;这些特性已经作为默认配置写入驱动。 **显示特性**: - 每 1ms 扫描一位,完整四位刷新率为 250Hz - `Seg_Show()` 自动使用尽可能多的小数位 - `16.88` 显示为 `16.88` - `168.8` 显示为 `168.8` - 支持负数和四舍五入,超出显示范围时显示 `----` - 显示缓存更新时短暂关闭中断,避免扫描过程中读取到一半的新数据 **使用步骤**: ```c #include "clock.h" #include "seg.h" int main(void) { SYSCFG_DL_init(); SysTick_Init(); Seg_Init(); Seg_Show(16.88f); while (1) { // Seg_Tick() 已由 SysTick_Handler 每 1ms 自动调用, // 主循环不需要重复刷新。 } } ``` **常用接口**: | 接口 | 说明 | |------|------| | `Seg_Init()` | 初始化驱动并清空显示 | | `Seg_Show(value)` | 显示浮点数并自动确定小数点位置 | | `Seg_Clear()` | 清空四位显示 | | `Seg_Tick()` | 扫描一位,由 SysTick 自动调用 | 模块硬件差异可通过 `Drivers/SEG/seg.h` 中的配置宏调整: | 配置宏 | 当前值 | 说明 | |--------|--------|------| | `SEG_SEGMENTS_ACTIVE_LOW` | `1` | 共阳模块,段码低电平有效 | | `SEG_DIGITS_ACTIVE_LOW` | `0` | 位选高电平有效 | | `SEG_REVERSE_DIGITS` | `1` | 反转物理位选顺序 | | `SEG_SEGMENT_BYTE_FIRST` | `1` | 先发送段码,再发送位选 | | `SEG_SHIFT_LSB_FIRST` | `0` | MSB 优先发送 | --- ### MOS — 大功率 MOS 模块 GPIO 开关驱动 使用 `GPIO_MOS / PB15` 输出高低电平。初始化时先输出低电平,避免 电磁铁等负载在上电阶段误动作。 ```c #include "mos.h" MOS_Init(); // 默认0%,负载关闭 MOS_On(); // 100%全功率 MOS_Off(); // 0%,关闭 uint8_t power = MOS_GetPower(); ``` | 接口 | 说明 | |------|------| | `MOS_Init()` | 初始化GPIO并保持负载关闭 | | `MOS_On()` | 设置100%全功率 | | `MOS_Off()` | 设置0%,关闭负载 | | `MOS_GetPower()` | 返回当前开关对应的0或100 | --- ### Ultrasonic — 超声波测距 该驱动代码仍保留在仓库中,但当前 SysConfig 已移除超声波GPIO并将PB15 分配给MOS模块,因此当前构建不包含此驱动。重新分配TRIG/ECHO引脚后 才能恢复使用。 **使用步骤**: ```c // 1. 初始化 Ultrasound_Init(); // 2. 设置测量模式 Ultrasound_SetMode(ULTRASOUND_MODE_MULTI, 5); // 多次测量,5个样本去极值平均 // 或 Ultrasound_SetMode(ULTRASOUND_MODE_SINGLE, 0); // 单次测量 // 3. 主循环中触发并读取 while (1) { Ultrasound_Trig(); // 触发一次测量(非阻塞,内部自动50ms节流) uint16_t distance_cm; uint8_t result = Ultrasound_Read(&distance_cm); switch (result) { case ULTRASOUND_RESULT_VALID: /* 有效,distance_cm 已更新 */ break; case ULTRASOUND_RESULT_WAITING: /* 测量进行中 */ break; case ULTRASOUND_RESULT_TIMEOUT: /* 无回波 */ break; case ULTRASOUND_RESULT_OUTRANGE: /* 超出2~400cm范围 */ break; } // 或读取最近一次有效值(不消耗状态,适合OLED刷新) if (Ultrasound_GetDistance(&distance_cm)) { // 距离有效(150ms内更新过) } } ``` --- ## 应用层详解(App) 所有应用模块遵循相同的生命周期模式: ``` Init() → [主循环中调用 Tick()] → Start() → ... → Stop() ``` - `Init()` — 在 `SYSCFG_DL_init()` 和 `SysTick_Init()` 之后调用一次 - `Tick()` — 非阻塞调度函数,在主循环中持续调用 - `Start()` / `Stop()` — 启动/停止功能 - `IsRunning()` — 查询运行状态 **重要**: 所有应用模块都依赖 `Encoder_Update()` 由主循环独立、持续调用。 ### GrayscaleLineFollow — 灰度循迹 基于 AD0/AD1/AD2/OUT 八路灰度模块的循迹。外环 PD 控制方向,内环编码器 PID 控制速度。通道 0~7 对应车体从左到右,0=黑线,1=白底。连续全白 1000ms 后自动停车。 ```c // 初始化 GrayscaleLineFollow_Init(); // 启动循迹(默认速度或指定速度) GrayscaleLineFollow_Start(2.0f); // 2.0 RPS // 或 GrayscaleLineFollow_Start(0); // 使用默认速度 // 主循环 while (1) { Encoder_Update(); // 必须持续调用 GrayscaleLineFollow_Tick(); // 非阻塞调度,内部20ms周期读取灰度 // 动态调速 GrayscaleLineFollow_SetSpeed(3.0f); // 范围 0~6 RPS // 查询状态 if (!GrayscaleLineFollow_IsRunning()) { // 已停止(可能因全白超时) } } // 停止 GrayscaleLineFollow_Stop(); ``` **内部时序**: 每 20ms 读取一次灰度,单通道稳定时间 200us,8 通道扫描约 1.6ms。 --- ### Rotation — 原地旋转 基于摄像头 IMU Yaw 角的原地旋转控制。数据源为摄像头通过 UART_CAM 发送的 `imu yaw:\r\n`(50ms 周期)。 **状态机**: IDLE → TURNING(固定 0.8 RPS 转向)→ SETTLING(确认停稳,偏离时 0.17 RPS 微调) **与循迹互斥**: Rotation 和 LineFollow 共用电机和速度 PID,启动 Rotation 前必须先停止循迹。 ```c // 初始化 Rotation_Init(); // 绝对角度控制 Rotation_TurnToYaw(90); // 转到 Yaw=90°(最短路径) Rotation_TurnToYaw(-45); // 转到 Yaw=-45° // 相对角度控制 Rotation_TurnLeft(90.0f); // 从当前Yaw左转90°(范围0~90) Rotation_TurnRight(45.0f); // 从当前Yaw右转45° // 主循环 while (1) { Encoder_Update(); Rotation_Tick(); // 内部自动解析Cam UART的Yaw数据 // 查询状态 RotationState_t state = Rotation_GetState(); RotationResult_t result = Rotation_GetResult(); float current_yaw = Rotation_GetYaw(); float error = Rotation_GetError(); // 正=需左转 if (!Rotation_IsBusy()) { // 旋转完成 if (result == ROTATION_RESULT_COMPLETED) { // 成功到达目标 } } } // 强制停止 Rotation_Stop(); ``` **返回值说明**: - `TurnToYaw` / `TurnLeft` / `TurnRight` 返回 1=请求已接受,0=拒绝(参数越界/Yaw未就绪/已有任务运行) - `IsYawReady()` 返回 1 表示最近 120ms 内收到过有效 Yaw --- ### LineFollow — 陀螺仪辅助循迹 八路循迹传感器 + 陀螺仪航向角补偿。全白达到 50ms 且 Yaw 已就绪时自动结束循迹。 ```c LineFollow_Init(); LineFollow_Start(2.5f); // 2.5 RPS while (1) { Encoder_Update(); LineFollow_Tick(); // 动态调速 LineFollow_SetSpeed(3.0f); } LineFollow_Stop(); ``` --- ### RALineFollow — 直角赛道循迹 无陀螺仪的矩形直角赛道循迹。正常路段 PD 循迹,直角处连续全白丢线后自动判定转向方向,制动后原地旋转,以重新进入传感器中央为准。 **状态机**: STOPPED → FOLLOW → CORNER_BRAKE → TURN_SEARCH → TURN_STABILIZE → FOLLOW → ... ```c RALineFollow_Init(); // 启动(参数指定顺时针或逆时针路线方向) RALineFollow_Start(2.45f); // 默认2.45 RPS while (1) { Encoder_Update(); RALineFollow_Tick(); // 查询状态 RALineFollowState_t state = RALineFollow_GetState(); uint8_t corners = RALineFollow_GetCornerCount(); // 已通过的直角数 RATurnDirection_t dir = RALineFollow_GetTurnDirection(); } RALineFollow_Stop(); ``` **注意**: 原地转向速度固定为 2.5 RPS,不受 `SetSpeed` 影响。 --- ### ColorTrack — 色块追踪 摄像头识别色块横向偏差进行对准,VL53L0X 测距进行前进/保持/后退控制。 **工作模式**: - `CT_MODE_ALIGN` — 色块偏离中心,原地旋转对准 - `CT_MODE_APPROACH` — 距离过远,前进 - `CT_MODE_HOLD` — 距离合适,停止 - `CT_MODE_RETREAT` — 距离过近,后退 ```c ColorTrack_Init(); ColorTrack_Start(); while (1) { Encoder_Update(); ColorTrack_Tick(); // 查询当前模式 ColorTrack_Mode_t mode = ColorTrack_GetMode(); // 读取距离 uint16_t dist_mm; if (ColorTrack_GetDistanceMm(&dist_mm)) { // dist_mm 有效 } // 读取横向偏差 int cx = ColorTrack_GetTargetXError(); } ColorTrack_Stop(); ``` --- ## 当前数码管测试程序 当前 `main.c` 仅用于验证四位数码管,不会初始化电机、蓝牙、摄像头或 其他应用模块。程序每隔 2 秒在 `16.88` 和 `168.8` 之间切换,用于同时 检查四位数字、左右顺序及两个小数点位置。 ```c #include "ti_msp_dl_config.h" #include "clock.h" #include "seg.h" int main(void) { unsigned long last_switch_ms; uint8_t show_second_value = 0U; SYSCFG_DL_init(); SysTick_Init(); Seg_Init(); Seg_Show(16.88f); last_switch_ms = Get_clock_ms(); while (1) { unsigned long now_ms = Get_clock_ms(); if ((now_ms - last_switch_ms) >= 2000UL) { last_switch_ms = now_ms; show_second_value ^= 1U; Seg_Show((show_second_value != 0U) ? 168.8f : 16.88f); } } } ``` --- ## 编译与烧录 1. 使用 Code Composer Studio (CCS) 导入本项目 2. 编译: `Project → Build Project` 3. 烧录: 连接 XDS110 调试器,`Run → Debug` ## 依赖 - TI MSPM0 SDK 2.10.00.04(含 `ti_msp_dl_config.h` 等驱动库) - Code Composer Studio 12.x+ - SysConfig 1.26+