基于 STM32F407 与 K230 的二维云台激光打靶系统设计

软件架构设计

模块化软件架构

├── 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. 模块化系统设计：清晰的软件架构，可复用的功能模块，易于扩展和维护。

项目开源与资源共享

• 工程文件开源地址：https://gitee.com/haisheer/laser-target-system
• 主控板拓展版地址：https://oshwhub.com/yumo2003/sky-star-extension-board

资源包含完整源代码（STM32 工程文件，Python 视觉处理脚本）、开发文档（系统设计说明，API 接口文档）及 3D 打印文件（适配张大头步进电机的二维云台 3D 结构）。初学者建议先阅读 README.md 了解系统架构，开发者可直接使用现有代码框架进行二次开发。

总结

本项目成功实现了基于 STM32F407 的二维云台激光打靶系统，融合了视觉识别、运动控制和实时调度等多项关键技术。通过本项目的实践，不仅为电子设计竞赛提供了完整解决方案，也为嵌入式视觉伺服系统的开发积累了宝贵经验。