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

任务调度系统

系统采用基于时间片的任务调度机制，确保关键任务及时执行：

// 调度器初始化
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;
    
    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) 并减小输出限幅，防止高频震荡。
• 积分策略：引入积分分离，仅在近距离时保留微弱积分项，消除静差并防止过冲。

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;
    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);
    
    Emm_V5_Vel_Control(&MOTOR_X_UART, MOTOR_X_ADDR, x_dir, x_speed_scaled, MOTOR_ACCEL, MOTOR_SYNC_FLAG);
    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;
    
    // 方向判断
    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) {
        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) {
        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\r\n");
        }
    }
    
    // 自动发射超时检查
    if(laser_control.state == LASER_STATE_AUTO_FIRING && laser_control.system_mode != SYSTEM_MODE_3) {
        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：待机模式
  • 电机未使能，激光强制关闭。按下 START 键启动系统。
• 模式 1：定时发射模式
  • Y 轴复位后自动定位发射。无目标追踪，X 轴不运动。
• 模式 2：按键角度模式
  • 预设启动后的转动角度，按下 START 键后自动转动并发射。支持目标追踪。
• 模式 3：增强稳定模式
  • 识别目标立即发射，持续 20 秒。高级滤波算法，抗干扰性强。

防摆动优化策略

系统采用多层防摆动机制，确保高速追踪过程中的稳定性：

1. 渐进式积分管理

if(error_distance < 15.0f) {
    float integral_factor = error_distance / 15.0f;
    if(integral_factor < 0.3f) integral_factor = 0.3f;
    pid_x.iout *= integral_factor;
    pid_y.iout *= integral_factor;
}

2. 自适应变化率限制

if(error_distance < 15.0f) {
    float max_change_x = (error_distance < 6.0f) ? 1.0f : 3.0f;
    float change_x = smooth_x - last_smooth_x;
    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;
}

3. 智能摆动检测与抑制

if(error_distance < 35.0f) {
    static float last_error_x = 0.0f;
    float current_error_x = latest_green_laser_coord.x - latest_red_laser_coord.x;
    
    if((current_error_x * last_error_x < 0) && (fabs(current_error_x) > oscillation_threshold_x)) {
        // 检测到方向变化，增加阻尼
        pid_x.iout *= 0.02f;
    }
    last_error_x = current_error_x;
}

性能测试与优化

在不同距离条件下测试系统追踪精度，均可满足基础部分要求，基本命中靶心（误差仅在 1cm 左右）。针对机械振动和视觉噪声，系统采用多重滤波策略：

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;
}

总结

本项目成功实现了基于 STM32F407 的二维云台激光打靶系统，融合了视觉识别、运动控制和实时调度等多项关键技术。通过自适应 PID 控制与多层防摆动机制，有效解决了非线性误差与机械振动问题。该方案为嵌入式视觉伺服系统的开发提供了完整的参考实践。