简介这份资料面向备战全国大学生电子设计竞赛的参赛团队与指导教师聚焦2023年E题“基于STM32F1的自动追光云台”的完整实现方案。资源包共199个文件约6.74MB以C语言源文件、头文件、编译中间文件与工程配置为主涵盖STM32F10x标准外设库、Keil工程文件及可烧录固件便于直接编译验证与二次开发。已有7797人学习下载热度较高。内容围绕光敏传感器采集、电机驱动控制、PID算法调节与电源管理等关键环节展开读者可据此理解云台从姿态检测到精确追踪的完整控制链路并参考工程目录组织方式快速搭建自己的开发环境适合具备嵌入式基础、希望提升实战能力的参赛者对照学习与排错优化。1. 从一道电赛E题说起这份参考方案到底能帮你省下多少试错时间如果你正在准备电子设计竞赛或者带学生做运动控制类题目大概率绕不开2023年那道经典的E题——它把运动目标控制与自动追踪这两个看似独立的功能塞进了一套系统里要求用摄像头识别目标、用二维云台驱动激光笔完成指定轨迹和追踪。很多人第一次拿到题目的反应是硬件搭得起来代码写不出来或者代码跑通了精度死活上不去。这份参考方案的价值就在这儿——它不是一份“标准答案”而是一套经过验证的工程实现路径把视觉识别、云台控制、激光点定位、闭环调参这几个环节的坑都踩过一遍了。适合谁适合已经搭好基础硬件、卡在算法整合阶段的参赛者也适合想理解“视觉运动控制”完整链路的嵌入式开发者。接下来我会按实际复现顺序把这份参考里最核心的模块拆开讲。2. 视觉识别与坐标映射从像素到云台角度的完整链路2.1 为什么选OpenMV而不是树莓派方案这份参考方案用的是OpenMV作为视觉前端而不是树莓派OpenCV。原因很直接电赛现场没有时间让你调Linux驱动、配Python环境、处理USB摄像头掉线。OpenMV把图像采集、色块识别、串口通信封装成几条API上电就能跑。它的算力确实有限但对于识别红色激光点、黑色矩形边框、A4纸上的目标区域这类任务帧率能稳在25fps以上完全够用。常见做法是OpenMV负责找目标质心和激光点质心把两组坐标通过串口发给主控主控跑PID算云台角度。这样分工的好处是视觉端不占用主控资源主控可以专心做控制周期和舵机驱动。如果你非要用树莓派那得做好心理准备——系统启动时间、摄像头曝光自动调整、进程调度延迟每一个都可能让你在赛场上翻车。2.2 色块识别的阈值怎么调才不玄学OpenMV的find_blobs函数依赖LAB阈值很多人调阈值全靠试结果换个场地光线一变就废。参考方案里给了一个可复用的调参流程# OpenMV 色块识别核心代码片段 import sensor, image, time from pyb import UART sensor.reset() sensor.set_pixformat(sensor.RGB565) sensor.set_framesize(sensor.QVGA) # 320x240兼顾速度和精度 sensor.skip_frames(time2000) # 等摄像头稳定别省这一步 sensor.set_auto_gain(False) # 锁定增益防止光线变化导致阈值漂移 sensor.set_auto_whitebal(False) # 锁定白平衡同上 # 红色激光点的LAB阈值L通道范围放宽A通道偏红 red_threshold (30, 100, 40, 80, 10, 70) uart UART(3, 115200) while True: img sensor.snapshot() blobs img.find_blobs([red_threshold], pixels_threshold10, area_threshold10) if blobs: # 取最大色块避免噪点干扰 b max(blobs, keylambda x: x.pixels()) img.draw_rectangle(b.rect(), color(0, 255, 0)) # 发送质心坐标格式x,y\n uart.write({%d,%d}\n % (b.cx(), b.cy())) time.sleep_ms(10)逻辑说明set_auto_gain(False)和set_auto_whitebal(False)是关键不锁的话摄像头会自动调整曝光导致同一颜色在不同时间被识别成不同阈值。pixels_threshold和area_threshold设成10是过滤小噪点如果激光点较暗可以降到5。串口发送用{%d,%d}\n格式主控端解析时以{和}为边界比纯逗号分隔更抗干扰。参数怎么改如果识别不到激光点先把red_threshold的L通道下限降到20A通道下限降到30如果识别到太多红色物体把pixels_threshold提到30以上。注意阈值没有万能值每换一个场地都要重新校准建议赛前写一个阈值调试模式按按键切换不同预设。2.3 像素坐标到云台角度的映射公式OpenMV给出的是图像坐标系下的像素坐标主控需要把它转成云台的两个舵机角度。参考方案用的是线性映射加死区补偿// 主控端以STM32为例坐标映射与PID计算 #define IMG_WIDTH 320 #define IMG_HEIGHT 240 #define PAN_CENTER 90.0f // 水平舵机中值角度 #define TILT_CENTER 90.0f // 垂直舵机中值角度 #define PAN_RANGE 30.0f // 水平方向最大偏转角度 #define TILT_RANGE 20.0f // 垂直方向最大偏转角度 float pixel_to_pan_angle(int cx) { // 将像素x坐标映射到舵机角度中心对齐 float offset (cx - IMG_WIDTH / 2.0f) / (IMG_WIDTH / 2.0f); return PAN_CENTER offset * PAN_RANGE; } float pixel_to_tilt_angle(int cy) { float offset (cy - IMG_HEIGHT / 2.0f) / (IMG_HEIGHT / 2.0f); return TILT_CENTER - offset * TILT_RANGE; // 注意方向图像y向下增大 }逻辑说明offset归一化到[-1, 1]乘以最大偏转角度得到实际角度。PAN_RANGE和TILT_RANGE需要根据你的云台机械结构实测——比如舵机转30度对应图像边缘那PAN_RANGE就设30。垂直方向取负号是因为图像坐标系y轴向下而云台抬头对应角度增大。参数怎么改如果云台运动方向反了把PAN_RANGE或TILT_RANGE的符号取反。如果中心点对不准微调PAN_CENTER和TILT_CENTER。死区补偿是在PID输出后加一个最小占空比防止舵机在误差很小时抖动具体值看舵机型号一般3%到5%。3. 云台控制与激光追踪PID调参和抗抖动策略3.1 双环PID还是单环PID参考方案用的是位置式单环PID输入是像素误差输出是舵机PWM增量。为什么不用双环因为电赛E题对动态性能要求没那么高目标基本是静态或慢速移动单环够用且调参快。双环位置环速度环需要测角速度得加陀螺仪硬件复杂度和调试时间都上去了。单环PID的代码结构typedef struct { float Kp, Ki, Kd; float integral; float prev_error; float output_limit; } PID; float pid_calc(PID *pid, float error, float dt) { pid-integral error * dt; // 积分限幅防止饱和 if (pid-integral pid-output_limit) pid-integral pid-output_limit; if (pid-integral -pid-output_limit) pid-integral -pid-output_limit; float derivative (error - pid-prev_error) / dt; pid-prev_error error; float output pid-Kp * error pid-Ki * pid-integral pid-Kd * derivative; // 输出限幅 if (output pid-output_limit) output pid-output_limit; if (output -pid-output_limit) output -pid-output_limit; return output; }逻辑说明dt是控制周期建议5ms到10ms。output_limit对应舵机最大角度变化量设太大容易过冲设太小响应慢。积分限幅是必须的否则误差持续存在时积分项会累积到爆炸表现为云台慢慢偏向一边然后突然猛转。参数怎么改先调Kp从小到大加直到云台开始等幅振荡然后取振荡值的60%。再加Kd抑制振荡Kd太大会引入高频抖动。Ki最后加一般给Kp的1/100到1/50用来消除静态误差。如果云台一直抖先检查Kd是不是太大了再检查电源是不是功率不够。3.2 激光点追踪的丢帧处理实际跑的时候OpenMV偶尔会丢帧——激光点被遮挡、反光、或者运动模糊导致识别不到。参考方案的处理策略是连续丢帧超过3帧才认为目标丢失丢失后云台保持最后角度不动而不是归零。归零会导致激光点突然跳回中心在追踪任务里直接判失败。// 丢帧计数与保持逻辑 static int lost_count 0; static float last_pan PAN_CENTER; static float last_tilt TILT_CENTER; void update_gimbal(int cx, int cy, int valid) { if (valid) { lost_count 0; float pan pixel_to_pan_angle(cx); float tilt pixel_to_tilt_angle(cy); last_pan pan; last_tilt tilt; set_servo_angle(pan, tilt); } else { lost_count; if (lost_count 3) { // 保持最后角度不动作 set_servo_angle(last_pan, last_tilt); } else { // 超过3帧可以在这里做搜索策略比如缓慢扫描 // 参考方案里简单保持不动等目标重新出现 } } }逻辑说明valid由主控解析串口数据时置位收到完整坐标帧为1超时未收到为0。lost_count阈值3是根据25fps帧率算的对应120ms再长就影响追踪连续性了。参数怎么改如果场地光线稳定、识别率高阈值可以降到2如果激光点经常被手挡住可以升到5。搜索策略参考方案没做但你可以加一个丢失超过10帧后云台按螺旋轨迹缓慢扫描直到重新捕获。3.3 舵机供电和机械回差的坑这一条是血泪经验很多人代码调通了一上电云台就抖或者追踪时总是慢半拍。八成是供电问题。舵机堵转电流能到1A以上如果和主控共用一路LDO电压会被拉低主控复位、摄像头掉线全来了。正确做法是舵机单独供电共地但不共电源。机械回差是另一个坑。塑料齿轮舵机用久了会有间隙PID输出变化了但云台没动等间隙消除后突然跳一下。解决方法是选金属齿轮舵机或者在PID输出后加一个死区小于死区的变化不输出。死区大小实测给舵机发一个微小角度变化看云台实际开始动的时候PWM变化了多少那个值就是死区。4. 避坑与排查调试现场最常见的五个翻车点4.1 现象OpenMV串口数据主控收不到原因串口波特率不匹配或者TX/RX接反了。OpenMV的UART3默认波特率是115200但有些主控初始化时设成了9600。另外OpenMV的TX要接主控的RXRX接主控的TX很多人按颜色接反了。解决先用USB转TTL单独测OpenMV确认能收到数据。再检查主控串口初始化代码波特率、数据位、停止位都要对上。如果用的是软串口注意引脚是否支持。4.2 现象激光点识别不稳定时有时无原因摄像头自动曝光没锁或者环境光变化导致LAB阈值漂移。另外激光点在白色纸面上反光强在黑色背景上反而弱阈值不能一套用到底。解决锁定auto_gain和auto_whitebal。如果还不行加一个补光灯用恒定光源消除环境光影响。阈值分两套根据背景颜色切换。4.3 现象云台追踪时振荡激光点画圈原因PID的Kp太大或者Kd太小系统相位裕度不够。也有可能是控制周期不稳定dt波动大导致微分项计算错误。解决先降Kp到原来的70%看振荡是否减弱。如果减弱了就是增益问题重新按3.1的步骤调。如果没变化检查控制周期是不是被其他任务打断了把PID计算放到定时器中断里保证dt恒定。4.4 现象追踪慢速目标时跟得上快速目标直接丢原因单环PID的响应带宽不够或者OpenMV帧率太低。25fps意味着每40ms才更新一次目标位置目标移动快了两次更新之间位置变化太大PID以为误差很大输出饱和。解决提高帧率把framesize降到QQVGA160x120帧率能到50fps以上。如果还不行加前馈——根据目标历史位置预测下一帧位置提前给云台指令。参考方案里没做前馈但这是进阶方向。4.5 现象比赛现场跑得好好的换了个场地就废了原因场地光照条件变了背景颜色变了甚至地面反光都会影响识别。这是视觉方案的通病没有万能参数。解决赛前准备一套快速校准流程放一个标准红色目标在场地中心按按键让OpenMV自动扫描当前阈值保存到Flash。上场后先跑校准再跑任务。这个流程参考方案里没写但强烈建议加上。5. 进阶技巧用示波器看PID输出和串口数据对齐调试到后期光看代码和现象已经不够了得用示波器。具体做法把PID输出PWM的一路接到示波器通道1把串口TX接到通道2触发方式设成串口起始位下降沿。这样你能看到每次收到新坐标后PWM是怎么变化的。如果PWM变化滞后串口数据超过一个控制周期说明主控解析串口太慢得优化解析代码比如用DMA接收加空闲中断。如果PWM变化方向反了说明坐标映射的符号错了回去改PAN_RANGE或TILT_RANGE的符号。还有一个技巧把PID的误差值通过DAC输出如果有或者PWM滤波后输出接示波器看误差收敛曲线。正常应该是指数衰减如果等幅振荡说明增益临界如果发散说明系统不稳定。这个习惯我每次调闭环都强制走一遍比盯着云台看靠谱得多。最后说一个验证方法在A4纸上画一个边长10cm的正方形让激光点沿边框走一圈用手机慢动作拍下来回放看激光点有没有偏离边框超过2mm。如果超了先查机械安装是不是歪了再查坐标映射的线性度——像素到角度的映射在边缘可能非线性需要分段标定。希望帮到你。本文还有配套的精品资源点击获取 
长河君 · 2026/10/16 10:50:23 · 阅读 1.2k 电赛E题视觉追踪方案：OpenMV与云台PID控制实战
简介这份资料面向备战全国大学生电子设计竞赛的参赛团队与指导教师聚焦2023年E题“基于STM32F1的自动追光云台”的完整实现方案。资源包共199个文件约6.74MB以C语言源文件、头文件、编译中间文件与工程配置为主涵盖STM32F10x标准外设库、Keil工程文件及可烧录固件便于直接编译验证与二次开发。已有7797人学习下载热度较高。内容围绕光敏传感器采集、电机驱动控制、PID算法调节与电源管理等关键环节展开读者可据此理解云台从姿态检测到精确追踪的完整控制链路并参考工程目录组织方式快速搭建自己的开发环境适合具备嵌入式基础、希望提升实战能力的参赛者对照学习与排错优化。1. 从一道电赛E题说起这份参考方案到底能帮你省下多少试错时间如果你正在准备电子设计竞赛或者带学生做运动控制类题目大概率绕不开2023年那道经典的E题——它把运动目标控制与自动追踪这两个看似独立的功能塞进了一套系统里要求用摄像头识别目标、用二维云台驱动激光笔完成指定轨迹和追踪。很多人第一次拿到题目的反应是硬件搭得起来代码写不出来或者代码跑通了精度死活上不去。这份参考方案的价值就在这儿——它不是一份“标准答案”而是一套经过验证的工程实现路径把视觉识别、云台控制、激光点定位、闭环调参这几个环节的坑都踩过一遍了。适合谁适合已经搭好基础硬件、卡在算法整合阶段的参赛者也适合想理解“视觉运动控制”完整链路的嵌入式开发者。接下来我会按实际复现顺序把这份参考里最核心的模块拆开讲。2. 视觉识别与坐标映射从像素到云台角度的完整链路2.1 为什么选OpenMV而不是树莓派方案这份参考方案用的是OpenMV作为视觉前端而不是树莓派OpenCV。原因很直接电赛现场没有时间让你调Linux驱动、配Python环境、处理USB摄像头掉线。OpenMV把图像采集、色块识别、串口通信封装成几条API上电就能跑。它的算力确实有限但对于识别红色激光点、黑色矩形边框、A4纸上的目标区域这类任务帧率能稳在25fps以上完全够用。常见做法是OpenMV负责找目标质心和激光点质心把两组坐标通过串口发给主控主控跑PID算云台角度。这样分工的好处是视觉端不占用主控资源主控可以专心做控制周期和舵机驱动。如果你非要用树莓派那得做好心理准备——系统启动时间、摄像头曝光自动调整、进程调度延迟每一个都可能让你在赛场上翻车。2.2 色块识别的阈值怎么调才不玄学OpenMV的find_blobs函数依赖LAB阈值很多人调阈值全靠试结果换个场地光线一变就废。参考方案里给了一个可复用的调参流程# OpenMV 色块识别核心代码片段 import sensor, image, time from pyb import UART sensor.reset() sensor.set_pixformat(sensor.RGB565) sensor.set_framesize(sensor.QVGA) # 320x240兼顾速度和精度 sensor.skip_frames(time2000) # 等摄像头稳定别省这一步 sensor.set_auto_gain(False) # 锁定增益防止光线变化导致阈值漂移 sensor.set_auto_whitebal(False) # 锁定白平衡同上 # 红色激光点的LAB阈值L通道范围放宽A通道偏红 red_threshold (30, 100, 40, 80, 10, 70) uart UART(3, 115200) while True: img sensor.snapshot() blobs img.find_blobs([red_threshold], pixels_threshold10, area_threshold10) if blobs: # 取最大色块避免噪点干扰 b max(blobs, keylambda x: x.pixels()) img.draw_rectangle(b.rect(), color(0, 255, 0)) # 发送质心坐标格式x,y\n uart.write({%d,%d}\n % (b.cx(), b.cy())) time.sleep_ms(10)逻辑说明set_auto_gain(False)和set_auto_whitebal(False)是关键不锁的话摄像头会自动调整曝光导致同一颜色在不同时间被识别成不同阈值。pixels_threshold和area_threshold设成10是过滤小噪点如果激光点较暗可以降到5。串口发送用{%d,%d}\n格式主控端解析时以{和}为边界比纯逗号分隔更抗干扰。参数怎么改如果识别不到激光点先把red_threshold的L通道下限降到20A通道下限降到30如果识别到太多红色物体把pixels_threshold提到30以上。注意阈值没有万能值每换一个场地都要重新校准建议赛前写一个阈值调试模式按按键切换不同预设。2.3 像素坐标到云台角度的映射公式OpenMV给出的是图像坐标系下的像素坐标主控需要把它转成云台的两个舵机角度。参考方案用的是线性映射加死区补偿// 主控端以STM32为例坐标映射与PID计算 #define IMG_WIDTH 320 #define IMG_HEIGHT 240 #define PAN_CENTER 90.0f // 水平舵机中值角度 #define TILT_CENTER 90.0f // 垂直舵机中值角度 #define PAN_RANGE 30.0f // 水平方向最大偏转角度 #define TILT_RANGE 20.0f // 垂直方向最大偏转角度 float pixel_to_pan_angle(int cx) { // 将像素x坐标映射到舵机角度中心对齐 float offset (cx - IMG_WIDTH / 2.0f) / (IMG_WIDTH / 2.0f); return PAN_CENTER offset * PAN_RANGE; } float pixel_to_tilt_angle(int cy) { float offset (cy - IMG_HEIGHT / 2.0f) / (IMG_HEIGHT / 2.0f); return TILT_CENTER - offset * TILT_RANGE; // 注意方向图像y向下增大 }逻辑说明offset归一化到[-1, 1]乘以最大偏转角度得到实际角度。PAN_RANGE和TILT_RANGE需要根据你的云台机械结构实测——比如舵机转30度对应图像边缘那PAN_RANGE就设30。垂直方向取负号是因为图像坐标系y轴向下而云台抬头对应角度增大。参数怎么改如果云台运动方向反了把PAN_RANGE或TILT_RANGE的符号取反。如果中心点对不准微调PAN_CENTER和TILT_CENTER。死区补偿是在PID输出后加一个最小占空比防止舵机在误差很小时抖动具体值看舵机型号一般3%到5%。3. 云台控制与激光追踪PID调参和抗抖动策略3.1 双环PID还是单环PID参考方案用的是位置式单环PID输入是像素误差输出是舵机PWM增量。为什么不用双环因为电赛E题对动态性能要求没那么高目标基本是静态或慢速移动单环够用且调参快。双环位置环速度环需要测角速度得加陀螺仪硬件复杂度和调试时间都上去了。单环PID的代码结构typedef struct { float Kp, Ki, Kd; float integral; float prev_error; float output_limit; } PID; float pid_calc(PID *pid, float error, float dt) { pid-integral error * dt; // 积分限幅防止饱和 if (pid-integral pid-output_limit) pid-integral pid-output_limit; if (pid-integral -pid-output_limit) pid-integral -pid-output_limit; float derivative (error - pid-prev_error) / dt; pid-prev_error error; float output pid-Kp * error pid-Ki * pid-integral pid-Kd * derivative; // 输出限幅 if (output pid-output_limit) output pid-output_limit; if (output -pid-output_limit) output -pid-output_limit; return output; }逻辑说明dt是控制周期建议5ms到10ms。output_limit对应舵机最大角度变化量设太大容易过冲设太小响应慢。积分限幅是必须的否则误差持续存在时积分项会累积到爆炸表现为云台慢慢偏向一边然后突然猛转。参数怎么改先调Kp从小到大加直到云台开始等幅振荡然后取振荡值的60%。再加Kd抑制振荡Kd太大会引入高频抖动。Ki最后加一般给Kp的1/100到1/50用来消除静态误差。如果云台一直抖先检查Kd是不是太大了再检查电源是不是功率不够。3.2 激光点追踪的丢帧处理实际跑的时候OpenMV偶尔会丢帧——激光点被遮挡、反光、或者运动模糊导致识别不到。参考方案的处理策略是连续丢帧超过3帧才认为目标丢失丢失后云台保持最后角度不动而不是归零。归零会导致激光点突然跳回中心在追踪任务里直接判失败。// 丢帧计数与保持逻辑 static int lost_count 0; static float last_pan PAN_CENTER; static float last_tilt TILT_CENTER; void update_gimbal(int cx, int cy, int valid) { if (valid) { lost_count 0; float pan pixel_to_pan_angle(cx); float tilt pixel_to_tilt_angle(cy); last_pan pan; last_tilt tilt; set_servo_angle(pan, tilt); } else { lost_count; if (lost_count 3) { // 保持最后角度不动作 set_servo_angle(last_pan, last_tilt); } else { // 超过3帧可以在这里做搜索策略比如缓慢扫描 // 参考方案里简单保持不动等目标重新出现 } } }逻辑说明valid由主控解析串口数据时置位收到完整坐标帧为1超时未收到为0。lost_count阈值3是根据25fps帧率算的对应120ms再长就影响追踪连续性了。参数怎么改如果场地光线稳定、识别率高阈值可以降到2如果激光点经常被手挡住可以升到5。搜索策略参考方案没做但你可以加一个丢失超过10帧后云台按螺旋轨迹缓慢扫描直到重新捕获。3.3 舵机供电和机械回差的坑这一条是血泪经验很多人代码调通了一上电云台就抖或者追踪时总是慢半拍。八成是供电问题。舵机堵转电流能到1A以上如果和主控共用一路LDO电压会被拉低主控复位、摄像头掉线全来了。正确做法是舵机单独供电共地但不共电源。机械回差是另一个坑。塑料齿轮舵机用久了会有间隙PID输出变化了但云台没动等间隙消除后突然跳一下。解决方法是选金属齿轮舵机或者在PID输出后加一个死区小于死区的变化不输出。死区大小实测给舵机发一个微小角度变化看云台实际开始动的时候PWM变化了多少那个值就是死区。4. 避坑与排查调试现场最常见的五个翻车点4.1 现象OpenMV串口数据主控收不到原因串口波特率不匹配或者TX/RX接反了。OpenMV的UART3默认波特率是115200但有些主控初始化时设成了9600。另外OpenMV的TX要接主控的RXRX接主控的TX很多人按颜色接反了。解决先用USB转TTL单独测OpenMV确认能收到数据。再检查主控串口初始化代码波特率、数据位、停止位都要对上。如果用的是软串口注意引脚是否支持。4.2 现象激光点识别不稳定时有时无原因摄像头自动曝光没锁或者环境光变化导致LAB阈值漂移。另外激光点在白色纸面上反光强在黑色背景上反而弱阈值不能一套用到底。解决锁定auto_gain和auto_whitebal。如果还不行加一个补光灯用恒定光源消除环境光影响。阈值分两套根据背景颜色切换。4.3 现象云台追踪时振荡激光点画圈原因PID的Kp太大或者Kd太小系统相位裕度不够。也有可能是控制周期不稳定dt波动大导致微分项计算错误。解决先降Kp到原来的70%看振荡是否减弱。如果减弱了就是增益问题重新按3.1的步骤调。如果没变化检查控制周期是不是被其他任务打断了把PID计算放到定时器中断里保证dt恒定。4.4 现象追踪慢速目标时跟得上快速目标直接丢原因单环PID的响应带宽不够或者OpenMV帧率太低。25fps意味着每40ms才更新一次目标位置目标移动快了两次更新之间位置变化太大PID以为误差很大输出饱和。解决提高帧率把framesize降到QQVGA160x120帧率能到50fps以上。如果还不行加前馈——根据目标历史位置预测下一帧位置提前给云台指令。参考方案里没做前馈但这是进阶方向。4.5 现象比赛现场跑得好好的换了个场地就废了原因场地光照条件变了背景颜色变了甚至地面反光都会影响识别。这是视觉方案的通病没有万能参数。解决赛前准备一套快速校准流程放一个标准红色目标在场地中心按按键让OpenMV自动扫描当前阈值保存到Flash。上场后先跑校准再跑任务。这个流程参考方案里没写但强烈建议加上。5. 进阶技巧用示波器看PID输出和串口数据对齐调试到后期光看代码和现象已经不够了得用示波器。具体做法把PID输出PWM的一路接到示波器通道1把串口TX接到通道2触发方式设成串口起始位下降沿。这样你能看到每次收到新坐标后PWM是怎么变化的。如果PWM变化滞后串口数据超过一个控制周期说明主控解析串口太慢得优化解析代码比如用DMA接收加空闲中断。如果PWM变化方向反了说明坐标映射的符号错了回去改PAN_RANGE或TILT_RANGE的符号。还有一个技巧把PID的误差值通过DAC输出如果有或者PWM滤波后输出接示波器看误差收敛曲线。正常应该是指数衰减如果等幅振荡说明增益临界如果发散说明系统不稳定。这个习惯我每次调闭环都强制走一遍比盯着云台看靠谱得多。最后说一个验证方法在A4纸上画一个边长10cm的正方形让激光点沿边框走一圈用手机慢动作拍下来回放看激光点有没有偏离边框超过2mm。如果超了先查机械安装是不是歪了再查坐标映射的线性度——像素到角度的映射在边缘可能非线性需要分段标定。希望帮到你。本文还有配套的精品资源点击获取