1. 项目概述
作为一名无人机控制系统的开发者,我最近在AirSim仿真环境中实现了一套完整的四旋翼无人机控制系统。这个项目基于PX4飞控的核心算法,结合浙大开源代码进行了改进,删除了硬件相关部分和状态机结构,专注于控制算法的实现与优化。
系统采用串级控制结构,包含位置环、速度环、姿态环和角速度环,最终输出PWM信号控制无人机。输入数据包括IMU(100Hz)、里程计(100Hz,由GPS和IMU通过卡尔曼滤波融合得到)以及来自Ego-planner的目标点/轨迹。输出为0~1范围的PWM信号,控制频率为50Hz。
需要模型API调用? 免费领10W Token,多模型网关一键接入 Claude、DeepSeek 等主流模型。
2. 系统架构设计
2.1 控制模块划分
整个控制系统采用经典的串级控制架构,分为四个主要环节:
- 位置/速度环:处理目标位置与当前状态的偏差,生成期望加速度
- 姿态环:将期望加速度转换为机体姿态(四元数表示)
- 角速度环:控制机体达到期望姿态的旋转速率
- PWM输出:将控制指令分配到四个电机
这种分层设计的好处是每层只需关注单一控制目标,简化了参数整定过程,同时保证了系统的稳定性。
2.2 通信与接口
系统通过AirSim API与仿真环境交互。AirSim启动后会开启一个本地server,控制器通过这个server获取传感器数据并发送控制指令。开发环境为Ubuntu 20.04和ROS1。
注意:AirSim使用NED坐标系(北-东-下),而ROS通常使用ENU坐标系(东-北-上)。这个差异会导致很多问题,特别是在姿态控制环节,需要特别注意坐标转换。
3. 控制器实现详解
3.1 位置/速度环控制
位置环采用P控制,将位置误差转换为目标速度:
cpp复制Eigen::Vector3d pos_err = pos_sp - odom.p;
Eigen::Vector3d target_vel = vel_sp + Kp_pos.cwiseProduct(pos_err);
速度环采用PID控制,增加了积分项以消除稳态误差:
cpp复制// 积分项更新 (限幅防饱和)
for (int i=0; i<3; i++) {
vel_int_(i) += Ki_vel(i) * vel_err(i) * dt;
vel_int_(i) = std::max(-Max_I_vel(i), std::min(Max_I_vel(i), vel_int_(i)));
}
// 计算期望加速度 (P + I + 前馈)
Eigen::Vector3d target_acc = acc_sp + Kp_vel.cwiseProduct(vel_err) + vel_int_;
参数选择依据:
- 位置环带宽设为0.95 rad/s
- 速度环带宽设为2.5 rad/s
- 积分限幅防止积分饱和(约等于允许的最大持续侧向加速度补偿)
3.2 姿态环控制
姿态环采用四元数表示,核心是将期望加速度方向转换为机体姿态:
cpp复制// 根据期望加速度方向,计算目标机体姿态
Eigen::Vector3d z_b_des = target_acc.normalized();
Eigen::Vector3d x_c_des(std::cos(yaw_sp), std::sin(yaw_sp), 0.0);
Eigen::Vector3d y_b_des = z_b_des.cross(x_c_des).normalized();
Eigen::Vector3d x_b_des = y_b_des.cross(z_b_des).normalized();
Eigen::Matrix3d R_des;
R_des << x_b_des, y_b_des, z_b_des;
u.q = Eigen::Quaterniond(R_des);
关键修复:AirSim与ROS的坐标系差异导致姿态控制反向的问题。解决方案是在计算完目标四元数
