二维云台激光打靶系统设计
项目背景
在自动化控制领域，视觉伺服系统是实现高精度定位与追踪的关键技术。本项目设计了一套二维云台系统，需具备自动识别目标、控制激光精准命中的功能。
系统总体设计
系统架构
二维云台激光打靶系统
├── 感知层（视觉模块）
│ ├── 摄像头采集
│ └── 目标坐标提取
├── 控制层（主控板）
│ ├── 数据处理
│ ├── PID 控制算法
│ └── 运动规划
├── 执行层（硬件驱动）
│ ├── 步进电机控制
│ ├── 激光发射控制
│ └── 状态反馈
└── 人机交互层
├── 按键控制
├── 状态指示灯
└── 调试输出
工作流程
- 目标识别：视觉模块实时采集图像，提取目标坐标
- 误差计算：计算目标坐标与激光准星的像素误差
- PID 控制：根据误差生成电机控制信号
- 电机驱动：控制双轴步进电机调整云台角度
- 激光发射：当目标稳定在允许误差范围内时触发激光
- 状态反馈：通过指示灯和串口输出系统状态
硬件选型与配置
1. 主控板
- 核心芯片：STM32F407VET6 (ARM Cortex-M4)
- 主频：25MHz 晶振，PLL 倍频至系统时钟
- 外设配置：
- 5 路 UART 串口
- 多路 GPIO 控制
- DMA 数据传输
- TIM 定时器
2. 步进电机
- 型号：Emm42_V5.0 PLC 套餐
- 控制方式：UART 串口通信
- 地址配置：
- X 轴电机：地址 0x01，UART2 通信
- Y 轴电机：地址 0x02，UART4 通信
- 性能参数：
- 最大速度：2000 RPM
- 高精度位置控制
- 内置闭环反馈
3. 视觉模块
- 平台：CanMV K230
- 功能：实时图像采集与矩形识别
- 输出格式：
origin:(x,y)\r\n坐标数据 - 性能：全角度圆形校正，高精度坐标提取
4. 激光笔
- 功率：10mw
- 颜色：蓝紫色
- 特性：可调焦，光束清晰可见
- 安全等级：适合室内使用
5. 继电器
- 控制方式：低电平触发激光笔开关
- 电压：5V
- 功能：实现激光的电子开关控制
- 安全性：电气隔离，防止干扰
硬件连接示意图
摄像头模块 (UART3) → STM32F407
步进电机 X 轴 (UART2) → STM32F407
步进电机 Y 轴 (UART4) → STM32F407
激光控制 (PA8) → 继电器 → 激光笔
按键输入 (PE9/PE11/PB6) → STM32F407
LED 指示灯 (PA3/PA5) → STM32F407
调试串口 (UART1) → 上位机
软件架构设计
模块化软件架构
├── Core/ # STM32 核心驱动
│ ├── Inc/ # 头文件目录
│ └── Src/ # 源文件目录
├── Drivers/ # STM32 HAL 驱动库
├── bsp/ # 板级支持包
│ ├── bsp_system.h # 系统配置
│ ├── schedule.c # 任务调度器
│ ├── key_bsp.c # 按键处理
│ ├── uart_bsp.c # 串口通信
│ ├── step_motor_bsp.c # 步进电机控制
│ ├── pi_bsp.c # PI 控制算法
│ └── laser_bsp.c # 激光控制系统
├── app/ # 应用程序层
│ ├── Emm_V5.c # 步进电机驱动库
│ ├── Emm_V5.h
│ ├── mypid.c # PID 控制器
│ └── mypid.h
└── ringbuffer/ # 环形缓冲区组件
任务调度系统
系统采用基于时间片的任务调度机制，确保关键任务及时执行：
// 调度器初始化
void schedule_init(void){
// 初始化任务列表
task_list[TASK_ID_LASER_CONTROL] = &Laser_Process;
task_list[TASK_ID_KEY_SCAN] = &Key_Scan_Process;
task_list[TASK_ID_VISION_PROC] = &pi_proc;
// ... 其他任务初始化
}
// 调度器主循环
void schedule_run(void){
uint32_t current_time = HAL_GetTick();
// 检查并执行各任务
for(int i = 0; i < TASK_COUNT; i++){
if(current_time - task_last_run[i] >= task_interval[i]){
task_list[i]();
task_last_run[i] = current_time;
}
}
}
视觉数据处理模块
// 摄像头坐标解析函数
int pi_parse_data(char* buffer){
int parsed_x, parsed_y;
int parsed_count;
// 解析 origin 坐标格式
if(strncmp(buffer,"origin:",7)==0){
parsed_count = sscanf(buffer,"origin:(%d,%d)",&parsed_x,&parsed_y);
if(parsed_count != 2) return -2; // 解析失败
// 更新目标坐标
latest_red_laser_coord.x = parsed_x;
latest_red_laser_coord.y = parsed_y;
latest_red_laser_coord.isValid = 1;
my_printf(&huart1,"Origin: (%d,%d)\r\n", parsed_x, parsed_y);
return 0;
}
return -3; // 未知格式
}
关键技术实现
1. 分段式 PID 设计逻辑
由于激光点在画面中的像素误差与电机转角是非线性关系（近处误差 10 像素与远处 10 像素对应的物理偏转角不同），设计了分段式自适应 PID：
- 超远距离 (Error > 100px)：采用大 Kp (2.0) 快速趋近。
- 中近距离 (Error < 15px)：切换至小 Kp (1.0 - 0.5) 并减小输出限幅，防止在目标点附近产生高频震荡。
- 积分策略：引入积分分离，仅在近距离时保留微弱积分项，以消除静差并防止过冲。
// PID 控制器结构体
typedef struct{
float kp; // 比例系数
float ki; // 积分系数
float kd; // 微分系数
float iout; // 积分输出
float last_err; // 上次误差
float out_max; // 输出最大值
} PID_Controller;
// 自适应 PID 控制函数
float adaptive_pid_control(PID_Controller *pid, float target, float current, float error_distance){
float err = target - current;
// 根据误差距离自适应调整参数
if(error_distance > 100.0f) { // 超远距离
pid->kp = 2.0f;
pid->out_max = 25.0f;
} else if(error_distance > 60.0f) { // 远距离
pid->kp = 1.8f;
pid->out_max = 20.0f;
} else if(error_distance > 40.0f) { // 中远距离
pid->kp = 1.5f;
pid->out_max = 16.0f;
} else if(error_distance > 25.0f) { // 中距离
pid->kp = 1.2f;
pid->out_max = 12.0f;
} else if(error_distance > 15.0f) { // 中近距离
pid->kp = 1.0f;
pid->out_max = 5.0f;
} else if(error_distance > 10.0f) { // 近距离
pid->kp = 0.8f;
pid->out_max = 3.0f;
} else { // 极近距离
pid->kp = 0.5f;
pid->out_max = 1.0f;
}
// 积分分离：近距离时减少积分累积
if(error_distance < 15.0f) pid->ki = 0.0001f;
else pid->ki = 0.00015f;
// 计算 PID 输出
float pout = pid->kp * err;
pid->iout += pid->ki * err;
// 积分限幅
if(pid->iout > pid->out_max) pid->iout = pid->out_max;
else if(pid->iout < -pid->out_max) pid->iout = -pid->out_max;
float dout = pid->kd * (err - pid->last_err);
pid->last_err = err;
float output = pout + pid->iout + dout;
// 输出限幅
if(output > pid->out_max) output = pid->out_max;
else if(output < -pid->out_max) output = -pid->out_max;
return output;
}
2. 步进电机精确控制
通过 UART 串口与步进电机驱动器通信，实现精确的角度控制：
// 步进电机控制函数
void Step_Motor_Set_Speed_my(float x_rpm, float y_rpm){
uint8_t x_dir, y_dir;
uint16_t x_speed_scaled, y_speed_scaled;
// 方向判断
x_dir = (x_rpm >= 0.0f) ? 0 : 1; // 0:CW, 1:CCW
y_dir = (y_rpm >= 0.0f) ? 0 : 1;
// 速度换算（0.1RPM 单位）
x_speed_scaled = (uint16_t)(fabs(x_rpm)*10+0.5f);
y_speed_scaled = (uint16_t)(fabs(y_rpm)*10+0.5f);
// X 轴电机控制
Emm_V5_Vel_Control(&MOTOR_X_UART, MOTOR_X_ADDR, x_dir, x_speed_scaled, MOTOR_ACCEL, MOTOR_SYNC_FLAG);
// Y 轴电机控制
Emm_V5_Vel_Control(&MOTOR_Y_UART, MOTOR_Y_ADDR, y_dir, y_speed_scaled, MOTOR_ACCEL, MOTOR_SYNC_FLAG);
}
// 角度旋转控制
void Step_Motor_Rotate_X_Angle(int16_t angle){
uint8_t dir;
uint32_t pulses;
// 角度限制
if(angle > 180) angle = 180;
if(angle < -180) angle = -180;
// 方向判断：CW（右转）为 1，CCW（左转）为 0
if(angle >= 0){
dir = 1; // CW
pulses = (uint32_t)(angle * 150); // 角度转脉冲数
} else {
dir = 0; // CCW
pulses = (uint32_t)((-angle)*150);
}
// 发送位置控制命令
Emm_V5_Pos_Control(&MOTOR_X_UART, MOTOR_X_ADDR, dir, MOTOR_MAX_SPEED, MOTOR_ACCEL, pulses, false, MOTOR_SYNC_FLAG);
}
3. 激光控制系统
实现多模式激光发射策略，包括定时发射、按键触发和自动追踪：
// 激光控制主处理函数
void Laser_Process(void){
uint32_t current_time = HAL_GetTick();
// 模式 1：Y 轴复位后 1.5 秒自动发射
if(laser_control.system_mode == SYSTEM_MODE_1 && laser_control.system_started && !laser_control.mode1_fired && !laser_control.manual_override){
uint32_t elapsed_time = current_time - laser_control.system_start_time;
if(elapsed_time >= MODE1_AUTO_FIRE_DELAY_MS){
laser_control.state = LASER_STATE_AUTO_FIRING;
laser_control.fire_start_time = current_time;
laser_control.mode1_fired = 1;
my_printf(&huart1,"LASER: Mode 1 - Auto fire started after 1.5s!\r\n");
}
}
// 模式 3：目标识别立即发射，持续 20 秒
if(laser_control.system_mode == SYSTEM_MODE_3 && laser_control.system_started && !laser_control.manual_override){
if(laser_control.target_locked && !laser_control.mode3_tracking){
laser_control.mode3_start_time = current_time;
laser_control.mode3_tracking = 1;
laser_control.state = LASER_STATE_AUTO_FIRING;
laser_control.fire_start_time = current_time;
laser_control.mode3_fired = 1;
my_printf(&huart1,"LASER: Mode 3 - Target detected, immediate laser firing started (20s continuous duration)\r\n");
}
}
// 自动发射超时检查
if(laser_control.state == LASER_STATE_AUTO_FIRING && laser_control.system_mode != SYSTEM_MODE_3 && !laser_control.manual_override){
if(current_time - laser_control.fire_start_time >= laser_control.fire_duration_ms){
laser_control.state = LASER_STATE_OFF;
my_printf(&huart1,"LASER: Auto fire completed - OFF\r\n");
}
}
}
系统工作模式
模式 0：待机模式
- 状态：电机未使能，激光强制关闭
- 指示灯：LED1 和 LED2 均灭
- 操作：按下 START 键启动系统
- 适用场景：系统初始化与安全检查
模式 1：定时发射模式
- 功能：Y 轴复位后自动定位发射
- 特点：无目标追踪，X 轴不运动
- 指示灯：LED1 亮，LED2 灭
- 触发条件：Y 轴回零完成后
- 适用场景：固定目标打靶与基础测试
模式 2：按键角度模式
- 功能：先通过角度按键预设启动后的转动角度，按下 START 键后自动转动并发射
- 特点：支持目标追踪，双轴运动
- 指示灯：LED1 灭，LED2 亮
- 触发条件：按下 START 键开始计时
- 适用场景：移动目标静态打靶
模式 3：增强稳定模式
- 功能：识别目标立即发射，持续 20 秒
- 特点：高级滤波算法，抗干扰性强
- 指示灯：LED1 和 LED2 均亮
- 触发条件：目标进入稳定区域
- 适用场景：复杂环境下高精度动态追踪打靶
防摆动优化策略
系统采用多层防摆动机制，确保高速追踪过程中的稳定性：
1. 渐进式积分管理
// 平衡的积分管理 - 保持响应性同时防止过冲
if(error_distance < 15.0f) { // 只在很近距离才管理积分
// 渐进式积分减少，保持响应性
float integral_factor = error_distance / 15.0f; // 0 to 1
if(integral_factor < 0.3f) integral_factor = 0.3f; // 最少保留 30% 积分
pid_x.iout *= integral_factor; // 适度减少积分
pid_y.iout *= integral_factor;
}
// 只在极近距离才大幅减少积分
if(error_distance < 8.0f){
pid_x.iout *= 0.5f; // 保留 50% 积分
pid_y.iout *= 0.5f;
}
2. 自适应变化率限制
// 简化的变化率限制，提高响应速度
if(error_distance < 15.0f){
float max_change_x, max_change_y;
if(error_distance < 6.0f){
max_change_x = 1.0f; // 允许较大变化率
max_change_y = 1.0f;
} else {
max_change_x = 3.0f; // 允许更大变化率
max_change_y = 3.0f;
}
float change_x = smooth_x - last_smooth_x;
float change_y = smooth_y - last_smooth_y;
// 独立应用变化率限制
if(change_x > max_change_x) smooth_x = last_smooth_x + max_change_x;
if(change_x < -max_change_x) smooth_x = last_smooth_x - max_change_x;
if(change_y > max_change_y) smooth_y = last_smooth_y + max_change_y;
if(change_y < -max_change_y) smooth_y = last_smooth_y - max_change_y;
}
3. 智能摆动检测与抑制
// 摆动检测与抑制逻辑
if(error_distance < 35.0f){
static float last_error_x = 0.0f, last_error_y = 0.0f;
static uint8_t direction_changes_x = 0, direction_changes_y = 0;
float current_error_x = latest_green_laser_coord.x - latest_red_laser_coord.x;
float current_error_y = latest_green_laser_coord.y - latest_red_laser_coord.y;
// 检测 X 轴方向变化
if((current_error_x * last_error_x < 0) && (fabs(current_error_x) > oscillation_threshold_x)){
direction_changes_x++;
// 根据摆动严重程度采取不同抑制措施
if(direction_changes_x > 3){
my_printf(&huart1,"X-AXIS SEVERE OSCILLATION - Emergency damping\r\n");
pid_x.iout *= 0.005f; // 激进抑制
} else if(direction_changes_x > 2){
my_printf(&huart1,"X-AXIS MODERATE OSCILLATION - Strong damping\r\n");
pid_x.iout *= 0.02f; // 强力抑制
}
}
}
性能测试与优化
1. 追踪精度测试
在不同距离条件下测试系统追踪精度，均可在满足基础部分要求的前提下，基本命中靶心（误差仅在 1cm 左右）。
2. 稳定性提升
针对机械振动和视觉噪声，系统采用多重滤波策略：
// 自适应坐标滤波
float adaptive_filtering(float raw_value, float filtered_value, float movement_magnitude){
float filter_alpha;
if(movement_magnitude > 50.0f) filter_alpha = 0.4f; // 大运动，快速响应
else if(movement_magnitude > 20.0f) filter_alpha = 0.25f; // 中等运动，平衡响应
else if(movement_magnitude > 10.0f) filter_alpha = 0.15f; // 小运动，较强滤波
else filter_alpha = 0.1f; // 微小运动，强滤波
return filtered_value * (1.0f - filter_alpha) + raw_value * filter_alpha;
}
创新点总结
1. 软硬件协同优化
- 硬件层面：选用高性能开发板 + 步进电机 + 视觉模块，实现高性能硬件基础
- 软件层面：自适应 PID+ 防摆动优化 + 多模式控制，提供智能控制策略
2. 多模式工作系统
- 4 种工作模式适应不同应用场景
- 灵活的人机交互设计
- 状态可视化反馈
3. 高效防摆动策略
- 多层防摆动机制
- 自适应变化率限制
- 智能摆动检测与抑制
4. 模块化系统设计
- 清晰的软件架构
- 可复用的功能模块
- 易于扩展和维护
总结
本项目成功实现了基于 STM32F407 的二维云台激光打靶系统，融合了视觉识别、运动控制和实时调度等多项关键技术。通过本项目的实践，不仅为电子设计竞赛提供了完整解决方案，也为嵌入式视觉伺服系统的开发积累了宝贵经验。希望本项目能为相关领域的开发者提供有益的参考。
