三维纯比例制导源代码

最新推荐文章于 2025-05-30 13:21:39 发布

原创

最新推荐文章于 2025-05-30 13:21:39 发布 · 6.8k 阅读

94 ·

CC 4.0 BY-SA版权

文章标签：

#matlab #编程

该博客探讨了具有碰撞角约束的三维纯比例导引律在无人机空中加油自主会合控制器设计中的应用。通过MATLAB代码模拟了弹道倾角和偏角的计算过程，展示了追踪器和目标的运动轨迹，以及相对距离的变化情况。

摘要生成于 C知道，由 DeepSeek-R1 满血版支持，前往体验 >

%具有碰撞角约束的三维纯比例导引律研究
%无人机空中加油自主会合控制器设计
%说明：在仿真中，下标"_m"表示追踪器参数，下标"_t"表示目标参数

clear
clc

%---------------------追踪器参数设置-----------------------
V_m=300; % 单位：m/s，飞行速度
theta_m=45*pi/180;%单位：rad，初始弹道倾角
fea_m=45*pi/180;%单位：rad，初始弹道偏角
X_m=0; %单位：m，位置坐标，X轴
Y_m=0; %单位：m，位置坐标，Y轴
Z_m=0; %单位：m，位置坐标，Z轴

%---------------------目标参数设置-----------------------
V_t=50; %单位：m/s，目标飞行速度
theta_t=0*pi/180;%单位：rad，初始弹道偏角
fea_t=0*pi/180;%单位：rad，初始弹道偏角
X_t=1000; %单位：m，目标位置坐标，X轴
Y_t=1000; %单位：m，目标位置坐标，Y轴
Z_t=0; %单位：m，目标位置坐标，Z轴

%------------------比例导引律参数设置-----------------------
N1=20; %纵向通道导引系数
N2=20;%偏航通道导引系数
g=9.8;

t=0; %单位：s，仿真时刻
dt=0.001;%单位：s，仿真时间步长
n=1;%计数用

R=sqrt((X_m-X_t)^2+(Y_m-Y_t)^2+(Z_m-Z_t)^2);  % 计算弹目相对距离
dR=-1;
while(dR<0)    %当弹目相对距离增大时，仿真停止
    dX_m=V_m*cos(theta_m)*cos(fea_m);
    dY_m=V_m*sin(theta_m);
    dZ_m=-V_m*cos(theta_m)*sin(fea_m);
    dX_t=V_t*cos(theta_t)*cos(fea_t);
    dY_t=V_t*sin(theta_t);
    dZ_t=-V_t*cos(theta_t)*sin(fea_t);
    dR=((X_m-X