电子产品世界 » 论坛首页 » DIY与开源设计 » 电子DIY » 【Let'sDo|2026年第3期】基础任务三:电机运行状态加速度数据采集与整理

共1条 1/1 1 跳转至页

【Let'sDo|2026年第3期】基础任务三:电机运行状态加速度数据采集与整理

助工
2026-11-17 00:33:55     打赏
基础任务三:电机运行状态加速度数据采集与整理

工程: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 管脚与软件接口对应

模块信号MCU 管脚开发板入口设备树/代码接口用途
ULN2003 IN1PC0CN7-38zephyr,user 的 motor-gpios[0]A 相控制
ULN2003 IN2PC1CN7-36motor-gpios[1]B 相控制
ULN2003 IN3PC2CN7-35motor-gpios[2]C 相控制
ULN2003 IN4PC3CN7-37motor-gpios[3]D 相控制
LIS3DHTR SCLPB6D15 / CN5-10i2c1 / FIFO I²C 适配层时钟
LIS3DHTR SDAPB7D14 / CN5-9accel: accelerometer@19数据,0x19
墨水屏 SCKPB3D3 / CN9-4SPI1 pinctrl时钟,避开 PA5
墨水屏 MOSIPB5D4 / CN9-5SPI1 pinctrl数据,避开 PA7
墨水屏 MISOPB4D5 / CN9-6SPI1 pinctrl软件配置保留;实体连接按模块接口核对
墨水屏 CSPC9D10 / CN5-3SPI1 片选低有效
墨水屏 DCPC7D8 / CN5-1dc-gpios命令/数据选择
墨水屏 BUSYPB10D6 / CN9-7busy-gpios忙状态输入
墨水屏 RSTPA8D7 / CN9-8reset-gpios复位
keyAPC6D9 / CN5-2eink_keys/key_a加档、低有效、30 ms 消抖
keyBPA7D11 / CN5-4eink_keys/key_b减档、低有效、30 ms 消抖
LD2 / B1PA5 / PC13板载LED/按键服务档位提示及操作
USART2 TX/RXPA2 / PA3ST-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 直接供电。

原理图资料入口沿用仓库硬件说明:


image.png


2.3 实物图占位

图 3-1:系统整体接线
主控、驱动板、电机、传感器、墨水屏及供电,实物如下

image.png

图 3-2:串口数据与三类文件
采集了3种电机状态的加速度计数据,如下所示:

- motor_stop.csv 是电机停止时采集的数据

- motor_level_1.csv 是电机一档转速时采集的加速度计数据

- motor_level_2.csv 是电机二档转速时采集的加速度计数据

image.png


下图是 motor_level_1.csv 文件打开截图,展示部分数据

image.png


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.pyPC 采集、格式校验及元数据保存

共享锁只保护短状态更新,持锁不进行 I²C、SPI、UART 或休眠。传感器线程通过四窗消息队列交给串口线程,发送阻塞不直接拖住采集。

3.2 固定采样契约

参数当前值
ODR / 模式400 Hz / 普通 10 位
量程 / 单位±2 g / 整数 mg,4 mg/LSB
一致性与处理BDU 开启,不额外去重力、高通或归一化
FIFO32 组三轴,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. 工作流程图

main_flowchart.jpg



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 整理链路,为任务四提供三类输入数据。



共1条 1/1 1 跳转至页

回复

匿名不能发帖!请先 [ 登陆 注册 ]