导弹控制率设计-比例导引法的Matlab与Simulink实现

Bmflutes

已于 2023-06-05 15:47:49 修改

阅读量2.6k

点赞数 24

文章标签： matlab 数学建模

于 2023-06-04 01:32:30 首次发布

本文链接：https://blog.csdn.net/weixin_46268065/article/details/131027867

版权

文章介绍了利用比例导引法进行导弹控制的设计，通过Matlab和Simulink模拟飞行器追踪目标的过程。在Simulink中，输入目标速度和飞行角度，经过积分运算求得位移，再通过角度微分计算控制量。最终，使用X-YGraph绘制轨迹并在Matlab中进行图形化展示，当目标与飞行器位移差超过阈值时显示追踪状态。

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

导弹控制率设计-比例导引法的Matlab与Simulink实现

基本原理

利用 $\dot{q} = k \dot\epsilon$ 其中 $q$ 为目标与观测点的夹角， $\epsilon$ 为飞行器与观测点的夹角

$q$ 可用目标与观测点的 $X$ 方向距离， $Y$ 方向距离进行表示， $\epsilon$ 同理。

Simulink实现

输入目标的速度 $V$ ，飞行角度 $\theta$ ,利用积分器分别对 $V_x,V_y$ 进行积分求得 $S_x,S_y$ ,反解出此时的角度
求解角度

对角度进行微分求得 $\dot{q}$ ,并设定增益值，求得 $\dot{\epsilon}$ 在这里插入图片描述

积分后输入飞行器的飞行角度控制中，求得飞行的 $X, Y$ 方向速度，积分得到 $X, Y$ 方向的位移在这里插入图片描述

利用X-Y Graph绘制相应的曲线。
在这里插入图片描述

利用OUT输出至workspace，进行绘图重现

输出的为目标位移与飞行器位移
在这里插入图片描述

注：

此处设置目标角度为0，沿 $X$ 轴方向飞行
积分初值对应的起始位置点
由于飞机速度快，基本会飞到目标前面

Matlab 进行绘图重现

实现效果

在这里插入图片描述

源代码

 
 %读取数据
x1= out.yout{1}.Values.Data;
y1=out.yout{2}.Values.Data;
x2 = out.yout{3}.Values.Data;
y2 = out.yout{4}.Values.Data;
%绘制图像
for t =1:1:1000
    xlim([0,1500]);
    ylim([0,2700]) ;
    if (abs(x1(t)-x2(t))+abs(y1(t)-y2(t))>40) %设定跟踪阈值
        scatter(x1(t),y1(t),5,'k','*');   
        hold on 
        grid on
        scatter(x2(t),y2(t),10,'r','o');   
        legend(' Target' ,'UAV') ;
        xlabel('X');
        ylabel('Y');
        pause(0.00000001);  
        title('Tracing Guidance');
    else
        warndlg('Target Ready！！','Warning');%显示完成
        break
    end
end