过重比例导引源程序

原创 2016年08月30日 19:07:47

参考文献:《几种增大空地导弹落角的制导方式比较》

clear
clc

%-----------导弹参数---------
V_m=260;%飞行速度 
X_m=0;  
Y_m=1000; %初始飞行高度  
theta_m=0*pi/180; %弹道倾角 

%----------目标参数---------
V_t=0; %静止目标
X_t=4800;
Y_t=0;
theta_t=0;
dtheta_t=0;
n_t=0;
A_t=0;


R=sqrt((X_m-X_t)^2+(Y_m-Y_t)^2);
q=atan((Y_t-Y_m)/(X_t-X_m));
dR=((X_m-X_t)*(V_m*cos(theta_m)-V_t*cos(theta_t))+(Y_m-Y_t)*(V_m*sin(theta_m)-V_t*sin(theta_t)))/sqrt((X_m-X_t)^2+(Y_m-Y_t)^2);
dq=((X_t-X_m)*(V_t*sin(theta_t)-V_m*sin(theta_m))-(Y_t-Y_m)*(V_t*cos(theta_t)-V_m*cos(theta_m)))/((X_m-X_t)^2+(Y_m-Y_t)^2);

n_m=-q+theta_m;

c=3;
g=9.8;

n=1;
t=0;
dt=0.01;

while (dR<0)

    Am=4*dq*abs(dR)+(c+1)*g*cos(theta_m); %过重补比例导引
    dtheta_m=Am/V_m; %纵向通道:弹道倾角变化函数
    theta_m=theta_m+dtheta_m*dt;
    %----------------------------计算坐标----------------------------
    X_m=X_m+V_m*cos(theta_m)*dt;
    Y_m=Y_m+V_m*sin(theta_m)*dt;
    

    n_m=-q+theta_m; 
    R=sqrt((X_m-X_t)^2+(Y_m-Y_t)^2);
    q=atan((Y_t-Y_m)/(X_t-X_m));
    dR=((X_m-X_t)*(V_m*cos(theta_m)-V_t*cos(theta_t))+(Y_m-Y_t)*(V_m*sin(theta_m)-V_t*sin(theta_t)))/sqrt((X_m-X_t)^2+(Y_m-Y_t)^2);
    dq=((X_t-X_m)*(V_t*sin(theta_t)-V_m*sin(theta_m))-(Y_t-Y_m)*(V_t*cos(theta_t)-V_m*cos(theta_m)))/((X_m-X_t)^2+(Y_m-Y_t)^2);
    
    alpha=Am/g/(0.3*g);%计算攻角
    
    theta_m_store(n)=theta_m;  %保存弹道倾角
    alpha_store(n)=alpha;%保存攻角
    Am_store(n)=Am;   %保存纵向过载
    P_m_store(:,n)=[X_m;Y_m]; %保存拦截弹坐标
    n=n+1;
    t=t+dt;
end
disp('脱靶量为(m):')
R
disp('飞行时间为(s):')
t


figure(1)
plot(P_m_store(1,:),P_m_store(2,:),X_t,Y_t,'r+')
hold on
xlabel('X/m')
ylabel('Y/m')

figure(2)
plot((1:n-1)*dt,Am_store)
hold on
xlabel('time/s')
ylabel('Acceleration/m^2')
title('加速度')

figure(3)
plot((1:n-1)*dt,theta_m_store*180/pi)
hold on
xlabel('time/s')
ylabel('\theta_m/°')
title('弹道倾角')

figure(4)
plot((1:n-1)*dt,alpha_store*180/pi)
hold on
xlabel('time/s')
ylabel('\alpha/°')
title('攻角')


伪谱法如何编程实现?

这两天看论文,大多都是用gpops,没见到自己编程实现伪谱法的,这么难吗?看大家写的论文,好像都明白,但又不是很透。加把劲自己实现吧...
  • appe1943
  • appe1943
  • 2017年06月07日 12:07
  • 491

三维纯比例制导源代码

%具有碰撞角约束的三维纯比例导引律研究 %无人机空中加油自主会合控制器设计 %说明:在仿真中,下标"_m"表示追踪器参数,下标"_t"表示目标参数 clear clc %-------------...
  • appe1943
  • appe1943
  • 2016年10月14日 12:32
  • 631

比例导引+弹道成型导引源程序

参考文献: 《几种增大空地导弹落角的制导方式比较》 《Strategic and tactical missile guidance》 clear clc %-----------导弹参数--...
  • appe1943
  • appe1943
  • 2016年10月14日 12:15
  • 337

wxWidgets初学者导引(1)——前言

针对初学者起步学习困难的实际,提供了一个学习方案,帮助C++初者提升学习能力,用CodeBlocks、wxWidgets、wxSmith开发出C++ GUI(图形用户界面)的应用程序。...
  • sxhelijian
  • sxhelijian
  • 2014年05月18日 17:18
  • 9632

Zarchan弹道成型导引源程序

参考文献:《几种增大空地导弹落角的制导方式比较》 《Strategic and tactical missile guidance》 clear clc %-----------导弹参数----...
  • appe1943
  • appe1943
  • 2016年10月14日 12:13
  • 361

Linux环境编程导引

计算机系统硬件组成   总线 贯穿整个系统的一组电子管道称为总线, 分为:   片内总线   系统总线 数据总线DB 地址总线AB 控制总线CB   外部总线   I/O设备 I/O设备是系统与外界联...
  • u010435294
  • u010435294
  • 2016年09月21日 15:10
  • 83

如何实现App程序安装首次打开的导引图

很多时候,在我们下载一款新的App软件后,都会发现da'k
  • V5V6_neil
  • V5V6_neil
  • 2014年09月07日 12:55
  • 832

TI_BLE软件开发者指导9-GAP

Texas Instruments CC2540/41 Bluetooth® Low Energy Software Developer’s Guide v1.3.2 Document...
  • Into_Wang
  • Into_Wang
  • 2017年02月16日 11:38
  • 292

Linux环境编程导引

计算机系统硬件组成 总线贯穿整个系统的一组电子管道称为总线, 分为:  片内总线  系统总线 数据总线DB 地址总线AB 控制总线CB  外部总线 I/O设备I/O设备是系统与外界联系的通道    键...
  • hanqing280441589
  • hanqing280441589
  • 2015年02月18日 09:04
  • 2015

Linux环境编程导引

计算机系统硬件组成   总线 贯穿整个系统的一组电子管道称为总线, 分为:   片内总线   系统总线 数据总线DB 地址总线AB 控制总线CB ...
  • acpchenpeng
  • acpchenpeng
  • 2015年12月31日 10:09
  • 142
内容举报
返回顶部
收藏助手
不良信息举报
您举报文章:过重比例导引源程序
举报原因:
原因补充:

(最多只允许输入30个字)