基于Rflysim平台的无人机拦截三维比例导引算法仿真

【后厂村路钢铁侠出品】

一、Rflysim简介

RflySim是一套专为科研和教育打造的Pixhawk /PX4MATLAB/Simulink****生态系统或工具链,采用基于模型设计(Model-Based DesignMBD)的思想,可用于无人系统的控制和安全测试。

基于三维比例导引的Rflysim仿真

二、三维比例导引简介

浅入深出的介绍比例导引法原理及分析-CSDN博客

导引导弹概述和相对运动方程-CSDN博客

三维比例制导律matlab代码(含注释)_matlab三维求导-CSDN博客

三、无人机拦截数学建模

3.1常用坐标系定义

地面坐标系OXYZ、无人机坐标系、轨迹坐标系、速度坐标系、视线坐标系

3.2无人机动力学和运动学建模

3.3无人机-目标运动信息计算

四、算法仿真结果

4.1基于差分法matlab仿真二维比例导引

Matlab 复制代码
clear all;
close all;
clc
% 假设sphere_pos和pos_info是已经定义好的变量,其中sphere_pos是一个3x1的数组,pos_info是一个结构体,包含mav_pos字段,也是一个3x1的数组  
sphere_pos = [20, 45];
mav_pos=[0,0];
self.temp1=0
self.temp2=0
self.temp3=0
self.temp4=0
self.K=6;
dt=0.01;
% 计算los向量  
cmd_v=[0,0];
i=1;
pmr=[];
% 计算LOS的横向通道、竖向通道角度 
while i<100000
los = [sphere_pos(1) - mav_pos(1), sphere_pos(2) - mav_pos(2)];
q_x = atan2(los(2), los(1)); % 注意MATLAB中atan2的参数顺序与Python不同  
dqx = q_x - self.temp1;  
self.temp1 = q_x;  

theta_x = atan2(cmd_v(2), cmd_v(1)); % 注意MATLAB中atan2的参数顺序  
self.temp3 = theta_x;  

% 比例导引:计算期望速度角度  
theta_xd = (self.K * dqx) + self.temp3;  

  
% 计算V的横向通道、竖向通道角度  
cmd_v = [cos(theta_xd),sin(theta_xd)];   
cmd_v = cmd_v / norm(cmd_v);  
cmd_v = cmd_v * 4; % 调整速度向量的幅度
mav_pos=mav_pos+(dt.*cmd_v);
i=i+1;
pmr(i,:)=mav_pos;
if los(2)<1
    break;
end
end
plot(pmr(:,1),pmr(:,2),'r')
xlabel('X(m)');ylabel('Y(m)');%给三维图加坐标轴标注
text(0, 0,'\leftarrow起始点');%给目标轨迹加标注
text(sphere_pos(1), sphere_pos(2),'\leftarrow目标飞行器');%给目标轨迹加标注

仿真结果:

4.2基于差分法matlab仿真三维比例导引

三维的仿真代码是两个二维耦合的。

仿真结果:

4.3基于Rflysim仿真结果

基于三维比例导引的Rflysim仿真

仿真侧拍

相关推荐
云卓SKYDROID1 小时前
无人机信号防干扰技术难点分析
无人机·遥控器·高科技·云卓科技
UAV_ckesc7 小时前
无人机 GNSS 天线详细讲解:定位的 “感知神经”
无人机·gnss
UAV_ckesc7 小时前
技术解析:Breeze 80A-M FOC 无人机电调的性能优势与保护机制
无人机·固定翼·无人机电调·无人机动力·南昌长空科技
蜀中廖化12 小时前
Griffin|增强现实数据集|无人机数据集
ar·无人机
Molesidy1 天前
【UAV】基于PX4+Ubuntu24.04.3的无人机制作的开发环境搭建
ubuntu·无人机·px4·gazebo·uav
无线图像传输研究探索1 天前
无定位更安全:5G 高清视频终端的保密场景适配之道
5g·安全·音视频·无人机·5g单兵图传·单兵图传·无人机图传
2zcode1 天前
基于Matlab狭窄空间环境中多无人机自重构V字队形方法研究
重构·无人机
timmy-uav2 天前
MissionPlanner架构梳理之(八)- MAVLink 命令
系统架构·无人机·开源地面站·missionplanner
Coovally AI模型快速验证3 天前
3D目标跟踪重磅突破!TrackAny3D实现「类别无关」统一建模,多项SOTA达成!
人工智能·yolo·机器学习·3d·目标跟踪·无人机·cocos2d
@高蕊3 天前
光伏项目无人机踏勘--如何使用无人机自动航线规划APP
arcgis·无人机