%具有碰撞角约束的三维纯比例导引律研究
%无人机空中加油自主会合控制器设计
%说明:在仿真中,下标"_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&#x
三维纯比例制导源代码
最新推荐文章于 2025-05-26 11:46:14 发布