工程:basic_task03_motor_data_collect
平台:NUCLEO-H533RE / LIS3DHTR / ULN2003 + CX28BYJ-48
1. 任务目标与实际完成范围
基础任务三要求获取电机停止与运行状态的加速度数据,并整理为 NanoEdge AI Studio 可用的输入。本项目将运行细分为 1 档和 2 档,形成 STOP、GEAR1、GEAR2 三类数据。
工程在独立目录集成电机、按键、墨水屏、加速度 FIFO 采集及 PC 保存工具。控制命令只用于安排实验,实际转动需人工观察;训练输入只包含加速度,不包含档位命令。
| 板端数据流 | 每行 512 组三轴,即 1536 个整数 mg,XYZ 按时刻交错 |
| 训练文件 | 三类分别保存纯数值 CSV,无日志、表头和标签列 |
| 辅助记录 | 工具可保存 JSON 元数据和原始串口文本 |
| 状态显示 | 墨水屏展示控制档位、采集及错误状态 |
2. 硬件资源与接线
2.1 管脚与软件接口对应
| ULN2003 IN1 | PC0 | CN7-38 | zephyr,user 的 motor-gpios[0] | A 相控制 |
| ULN2003 IN2 | PC1 | CN7-36 | motor-gpios[1] | B 相控制 |
| ULN2003 IN3 | PC2 | CN7-35 | motor-gpios[2] | C 相控制 |
| ULN2003 IN4 | PC3 | CN7-37 | motor-gpios[3] | D 相控制 |
| LIS3DHTR SCL | PB6 | D15 / CN5-10 | i2c1 / FIFO I²C 适配层 | 时钟 |
| LIS3DHTR SDA | PB7 | D14 / CN5-9 | accel: accelerometer@19 | 数据,0x19 |
| 墨水屏 SCK | PB3 | D3 / CN9-4 | SPI1 pinctrl | 时钟,避开 PA5 |
| 墨水屏 MOSI | PB5 | D4 / CN9-5 | SPI1 pinctrl | 数据,避开 PA7 |
| 墨水屏 MISO | PB4 | D5 / CN9-6 | SPI1 pinctrl | 软件配置保留;实体连接按模块接口核对 |
| 墨水屏 CS | PC9 | D10 / CN5-3 | SPI1 片选 | 低有效 |
| 墨水屏 DC | PC7 | D8 / CN5-1 | dc-gpios | 命令/数据选择 |
| 墨水屏 BUSY | PB10 | D6 / CN9-7 | busy-gpios | 忙状态输入 |
| 墨水屏 RST | PA8 | D7 / CN9-8 | reset-gpios | 复位 |
| keyA | PC6 | D9 / CN5-2 | eink_keys/key_a | 加档、低有效、30 ms 消抖 |
| keyB | PA7 | D11 / CN5-4 | eink_keys/key_b | 减档、低有效、30 ms 消抖 |
| LD2 / B1 | PA5 / PC13 | 板载 | LED/按键服务 | 档位提示及操作 |
| USART2 TX/RX | PA2 / PA3 | ST-LINK VCP | 控制台服务 | CSV 发送及命令接收 |
电机四路集中在 CN7 底部:35=IN3、36=IN2、37=IN4、38=IN1,不能按几何排列直接当相序。PC0/PC1 应保留默认焊桥路由,避免改接到已用于传感器的 PB6/PB7。
2.2 供电与原理图
传感器和墨水屏使用 3.3 V;电机由驱动板额定 5 V 入口供电,主控、驱动板与电机电源共地。采用独立电机电源时,不直接并联不同 5 V 电源。电机线圈接驱动板插座,不能由 GPIO 直接供电。
原理图资料入口沿用仓库硬件说明:
电机驱动套装资料入口,驱动板电源选择与接口以实物版本为准。

2.3 实物图占位
图 3-1:系统整体接线
主控、驱动板、电机、传感器、墨水屏及供电,实物如下
图 3-2:串口数据与三类文件
采集了3种电机状态的加速度计数据,如下所示:- motor_stop.csv 是电机停止时采集的数据
- motor_level_1.csv 是电机一档转速时采集的加速度计数据
- motor_level_2.csv 是电机二档转速时采集的加速度计数据
下图是 motor_level_1.csv 文件打开截图,展示部分数据
3. 工程组织与实现思路
3.1 服务分工
| main.c / collect_app.h | 档位输入、采集会话和共享状态 |
| motor_service.c | 八拍半步、定时输出和速度渐变 |
| accel_service.c | 独占传感器寄存器,FIFO 读取、换算及组窗;优先级 3 |
| console_service.c | 运行期唯一 UART 数据发送者;优先级 9 |
| display_service.c | 独立低优先级显示;优先级 12 |
| tools/collect_data.py | PC 采集、格式校验及元数据保存 |
共享锁只保护短状态更新,持锁不进行 I²C、SPI、UART 或休眠。传感器线程通过四窗消息队列交给串口线程,发送阻塞不直接拖住采集。
3.2 固定采样契约
| ODR / 模式 | 400 Hz / 普通 10 位 |
| 量程 / 单位 | ±2 g / 整数 mg,4 mg/LSB |
| 一致性与处理 | BDU 开启,不额外去重力、高通或归一化 |
| FIFO | 32 组三轴,Stream,水位 16 |
| 读取调度 | 读取已有样本,每轮结束休眠 10 ms |
| 每窗长度 | 512 点/轴、1536 数值,非重叠 |
| 标称窗时长 | 512 / 400 = 1.28 秒 |
| 固定批次 | 默认 100 窗,即标称 128 秒有效数据 |
10 ms 是主机读取调度,不是采样周期。FIFO 硬件 ODR 决定样本间隔。直接寄存器适配层使用自定义 app,lis3dh-fifo 绑定,不同时加载另一套 Sensor 驱动修改同一器件。
3.3 工况与会话控制
电机两档半步间隔为 2500 µs、1500 µs,采用速度渐变。这是相序更新间隔,不是输出轴转速。
keyA 加档、keyB 减档,到边界保持;B1 短按循环 0→1→2→0,长按停止。串口 0/1/2 指定档位,c 采固定批次,m 连续采集,q 暂停采集但保持电机档位,旧 s 查询不输出信息。
开始采集前等待驱动节拍稳定、无驱动错误和屏幕空闲,再等待 2 秒,清 FIFO 后组窗。连续模式换档重新等待;固定批次换档取消批次。settled 只说明控制节拍到位,不证明电机真实转动。
DATA/DRAIN 期间暂停屏幕刷新;WAIT 期间允许补画。通信、FIFO 溢出、削顶或队列满使会话作废,不补零、不插值,也不将坏窗继续输出。
4. 工作流程图

5. 关键代码
5.1 配置确认
来源:src/accel_service.c 的 configure_sensor(),回读表摘录。
static const uint8_t expected[][2] = {
{REG_CTRL1, 0x77},
{REG_CTRL4, 0x80},
{REG_CTRL5, 0x40},
{REG_FIFO_CTRL, 0x8f},
};初始化先读取 WHO_AM_I,期望 0x33,再写入并回读关键寄存器,检查 ODR、BDU、FIFO 与模式是否符合采集契约。
5.2 原始寄存器转 mg
来源:accel_worker()。
int16_t reg = (int16_t)sys_get_le16(raw + axis * 2); xyz[axis] = (reg / 64) * 4; clipping |= xyz[axis] == -2048 || xyz[axis] == 2044;
普通模式 10 位输出左对齐于 16 位寄存器,先还原有效计数,再按 ±2 g 的 4 mg/LSB 缩放。不能直接把寄存器整数作为 mg。
5.3 交错组窗与非阻塞发布
来源:accel_worker(),分别摘录填窗与队列提交。
memcpy(&frame.mg[points * 3], xyz, sizeof(xyz));
k_msgq_put(&accel_frames, &frame, K_NO_WAIT)
布局为 x0,y0,z0,x1,y1,z1,...。发布前复查 FIFO、会话和电机状态;消息队列满则取消会话,不阻塞等待后续造成更多丢样。
6. Debug 问题与修复
6.1 配置 HSI 后 I²C 仍初始化失败
现象: 控制器实际返回 -EINVAL(-22),旧外层处理只显示 -ENODEV(-19),容易误判为传感器不存在。
原因: 本机 Zephyr 4.4.99 的 i2c_stm32.c 缺少 DT_DRV_COMPAT,使域时钟支持宏判断为 0,overlay 配置的 HSI 64 MHz 未进入预期时钟路径。
修改: CMake 仅针对本工程构建的该驱动源文件补充:
COMPILE_DEFINITIONS DT_DRV_COMPAT=st_stm32_i2c_v2
同时保留控制器真实初始化错误,屏幕区分 BUS、WHO、CONFIG、READ 阶段和器件 ID。
已有验证: 预处理确认域时钟支持值由 0 变为 1,随后构建、烧录并收到有效窗口。未修改 Zephyr 安装目录;升级 SDK/Zephyr 后需复核兼容处理。
6.2 日志混入训练数据
问题: 状态、驱动日志或串口工具时间戳会破坏“每行 1536 个数值”的输入格式。
修改: 禁用运行期应用日志和墨水屏驱动日志,只由控制台服务发送数据;保留一次启动 banner。PC 文件删除 banner,关闭串口工具时间戳、RX 前缀和 HEX 模式,按换行而非 USB 接收块拼窗。
已有验证: 已接收的 5 个完整窗口满足列数、量程与 4 mg 量化约束;PC 测试覆盖分包与超长行。
6.3 换档、刷新或故障导致窗口不连续
处理: 使用会话号取消旧窗口;换档重等稳定;采集中暂停显示;FIFO 错误和队列满立即作废。已开始发送的有效行完整发完,旧会话排队数据丢弃。
这是源码中的完整性措施。已有短记录不能证明全部长时间联合测试完成,断线恢复和换档边界仍需实机验收。
7. 数据整理与复现
7.1 构建和下载
在已激活 Zephyr 环境的终端、仓库根目录执行:
west build -b nucleo_h533re/stm32h533xx -d basic_task03_motor_data_collect/build basic_task03_motor_data_collect -- "-DCONFIG_SPEED_OPTIMIZATIONS=y" west flash -d basic_task03_motor_data_collect/build -r pyocd --no-rebuild
7.2 工具保存
关闭其他串口助手,按实际端口替换 COM21:
python -m pip install -r basic_task03_motor_data_collect/tools/requirements.txt python basic_task03_motor_data_collect/tools/collect_data.py capture --port COM21 --label GEAR1 --output basic_task03_motor_data_collect/data/GEAR1_run01.csv --installation mount-v1 --observed python basic_task03_motor_data_collect/tools/collect_data.py validate --input basic_task03_motor_data_collect/data/GEAR1_run01.csv
工具会发送暂停、档位和采集命令,会改变电机档位;退出时暂停数据不等于停止电机。--observed 表示人工已经确认安装与实际运动。固定窗口数需与固件一致。
CSV 用于 Studio;JSON 保存参数、标签、安装、哈希等;原始串口文本用于追溯。format_valid 只表示格式等检查通过,不能证明硬件无丢样、真实档位正确,也不能检出所有仍为合法数值的传输错误。
7.3 已有数据集记录
README 中用户补充记录:每档使用串口录制约 5 分钟,保存为:
| motor_stop.csv | 电机停止 |
| motor_level_1.csv | 电机 1 档 |
| motor_level_2.csv | 电机 2 档 |
报告未逐文件取得原始内容,准确有效行数、削顶统计和文件哈希待补。不能按录制时长直接推定有效窗口数,也不能把 5 窗试采记录当作三份完整数据集的质量证明。
导入时按当前项目约定选择 n-Class Classification、Time Series、Accelerometer、3 Axes、512 点/轴;每类单独文件,无表头、时间戳和标签列。训练与测试按独立运行批次划分,避免同一记录相邻窗口随机分散形成数据泄漏。
8. 最终实现效果与验收
Zephyr 4.4.99、SDK 1.0.1 构建链接及烧录成功,COM21/921600 实际收到 5 个完整窗口,每窗 1536 个整数,Z 轴均值约 -1008 mg,接收间隔约 1.30 秒。接收时间用于观察吞吐,不能替代逐样本时钟测量。
已有 PC 测试记录为 5 项通过,覆盖布局、非法/削顶数据、元数据及篡改检测、串口分包和超长行。本次报告编写未重新执行这些测试。
| 固件采集链路 | 已构建、烧录并收 5 窗 | 长时间连续采集统计 |
| 三档数据 | 用户记录每档约 5 分钟 | 实际有效行数、哈希及安装照片 |
| 数据格式 | 短记录满足 1536 列和量化约束 | 全数据集离线检查 |
| 标签可信性 | 设计上要求人工观察 | 三档实际运动、负载与停止方式记录 |
| Studio 导入 | 后续已有模型库集成依据 | 本批次导入截图、类别及数据量记录 |
| 故障与联合运行 | 源码有会话及错误保护 | 换档、断线、FIFO、队列和电机 late 计数 |
本任务已建立电机控制、连续采样、窗口输出和 PC 整理链路,为任务四提供三类输入数据。



我要赚赏金
