一、基于xtdrone的仿真无人机学习:定点飞行 (用ego_planner

2024-03-17 13:40

本文主要是介绍一、基于xtdrone的仿真无人机学习:定点飞行 (用ego_planner,希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

 参考三维运动规划 · 语雀

零·基础知识

MAVROS(MAVLink to ROS)是一个ROS(Robot Operating System)节点,用于在ROS系统中与PX4飞控系统进行通信。
它通过将MAVLink消息转换为ROS消息,实现了ROS系统与无人机之间的数据交换和控制。

PX4 SITL(Software-in-the-Loop)仿真环境中,无人机模型通过PX4飞控软件进行仿真。
通过在仿真环境中运行PX4 SITL,可以在计算机上模拟无人机的飞行和姿态控制。


在这个launch文件中,MAVROS节点和PX4 SITL仿真环境中的无人机扮演着以下角色:
1、
MAVROS节点:负责接收来自无人机的传感器数据(如GPS、IMU等)和状态信息,并将其转换为ROS消息。同时,它也负责接收来自ROS系统的控制指令,并将其转发给无人机。
2、
PX4 SITL仿真环境中的无人机:由PX4飞控软件仿真的无人机模型。它接收来自MAVROS节点的控制指令,并根据指令模拟无人机的飞行和姿态控制。同时,它还将传感器数据和状态信息发送给MAVROS节点,以便在ROS系统中进行处理和显示。


"/xtdrone/iris_0/cmd" 这个话题是用来向 ROS 中连接的无人机发送控制指令的。在 ROS 中,所有的通信都是通过发布者(publisher)和订阅者(subscriber)之间的消息传递来完成的。

一个发布者节点会将无人机的控制指令发布到 "/xtdrone/iris_0/cmd" 这个话题上,并且无人机上运行的订阅者节点将监听该话题以接收并执行这些指令。这通常涉及到无人机的移动、悬停、转向等操作,具体取决于发布到该话题上的指令。

键盘控制
该节点通过接收键盘输入来控制飞行器的前进、后退、左移、右移、上升、下降以及旋转等动作
按下"w"键会增加飞行器的前进速度,按下"x"键会减小飞行器的前进速度。其他按键也有类似的功能。


查看该话题   无人机的姿态(速度和角度)
rostopic echo /xtdrone/iris_cmd_vel_flu 

ego_planner
ego_planner需要输入深度图+相机位姿或是点云,这里以深度图+相机位姿的组合为例进行仿真
相机位姿由VINS-Fusion计算得到。

这是一些ROS话题,用于机器人的控制和状态估计。

/xtdrone/iris_0/cmd
/xtdrone/iris_0/cmd_accel_enu
/xtdrone/iris_0/cmd_accel_flu
/xtdrone/iris_0/cmd_pose_enu
/xtdrone/iris_0/cmd_pose_flu
/xtdrone/iris_0/cmd_vel_enu
/xtdrone/iris_0/cmd_vel_flu
/xtdrone/iris_0/planning/bspline
/xtdrone/iris_0/planning/data_display
/xtdrone/iris_0/planning/pos_cmd
/xtdrone/iris_0/vins_estimator/odometry
/xtdrone/leader/cmd
/xtdrone/leader/cmd_vel_flu

具体说明如下:

/xtdrone/iris_0/planning/bspline:该话题用于发布来自路径规划器的B样条曲线路径信息,用于控制机器人的运动。

/xtdrone/iris_0/planning/data_display:该话题用于在RViz中显示机器人的路径规划器数据信息,以便进行调试和验证。

/xtdrone/iris_0/planning/pos_cmd:该话题用于发布机器人的位置控制指令,通过订阅该话题,机器人可以按照指定的位置移动到目标点。

/xtdrone/iris_0/vins_estimator/odometry:该话题用于发布机器人的运动状态信息,包括机器人的位置、速度和姿态等数据,通过订阅该话题,用户可以获取机器人的实时状态信息。

ego_planner 可以读取几个全局目标点然后规划路径,目的是无人机每到达一个目标点后旋转九十度,然后执行完所有目标点后回家(家里坐标(0,0,0))

一、定点飞行

思路:将ego_planner一条轨迹拆成多个轨迹,编写脚本分段执行任务

拆分成三段

二、旋转

用键盘控制无人机飞行
在一个终端运行(启动gazebo,出现了场景和飞机)

cd ~/PX4_Firmware
roslaunch px4 indoor1.launch



Gazebo启动后,在另一个终端运行(启动通信脚本,iris代表子机型,0代表飞机的编号,与0号iris建立通信)

cd ~/XTDrone/communication/
python multirotor_communication.py iris 0



与0号iris建立通信后,在另一个终端运行(启动键盘控制脚本,iris代表机型,1代表飞机的个数,vel代表速度控制)

cd ~/XTDrone/control/keyboard
python multirotor_keyboard_control.py iris 1 vel

通过查看键盘控制无人机的话题消息
可知

root@d10fba288ba3:/# rostopic info /xtdrone/iris_0/cmd_vel_flu
Type: geometry_msgs/Twist

Publishers: 
 * /iris_multirotor_keyboard_control (http://d10fba288ba3:35643/)

Subscribers: 
 * /iris_0_communication (http://d10fba288ba3:38861/)


因此
/xtdrone/iris_0/cmd_vel_flu 话题使用的消息类型是 geometry_msgs/Twist。

在终端中执行以下命令,将指定的消息内容发布到该话题:

rostopic pub /xtdrone/iris_0/cmd_vel_flu geometry_msgs/Twist "linear:
  x: 0.0
  y: 0.0
  z: 0.0
angular:
  x: 0.0
  y: 0.0
  z: 0.33"

但是该消息内容只会执行一次,所以要编写个py脚本循环发布旋转消息
 

xuanzhuan.py

#!/usr/bin/env python
# -*- coding: utf-8 -*-
import rospy
from geometry_msgs.msg import Twistdef main():rospy.init_node('command_publisher')# 创建一个发布者,指定要发布的话题和消息类型pub = rospy.Publisher('/xtdrone/iris_0/cmd_vel_flu', Twist, queue_size=10)# 创建一个 Twist 对象,用于填充指令消息的内容cmd_vel = Twist()cmd_vel.angular.z = 1.57  # 设置角速度rate = rospy.Rate(220)  # 设置发布频率为 250Hzcount = 0  # 计数器while not rospy.is_shutdown()and count<240:pub.publish(cmd_vel)  # 发布指令消息rate.sleep()count+=1if __name__ == '__main__':try:main()except rospy.ROSInterruptException:pass

三、执行任务

现在只需要将这些任务用脚本依次执行就行了

先依照三维运动规划 · 语雀

启动仿真

然后执行脚本

echo "Start a Tmux session!"# 创建一个名为 "ego_planner" 的 Tmux 会话
tmux new -d -s ego_plannerecho "Start ego_planner_1!"# 向 Tmux 会话发送命令,并输入一个回车以启动 "roslaunch" 命令
tmux send-keys -t ego_planner "roslaunch ego_planner single_uav.launch" ENTER sleep 22echo "Start Rotating!"
tmux send-keys -t ego_planner "C-c" ENTER
sleep 2
tmux send-keys -t ego_planner "python xuanzhuan.py" ENTER 
sleep 6echo "Start ego_planner_2!"
# 向 Tmux 会话发送命令,并输入一个回车以启动 "roslaunch" 命令
tmux send-keys -t ego_planner "roslaunch ego_planner single_uav_2.launch" ENTER 
sleep 15echo "Start Rotating!"
tmux send-keys -t ego_planner "C-c" ENTER
sleep 2
tmux send-keys -t ego_planner "python xuanzhuan.py" ENTER 
sleep 6echo "Start GOhome!!"
# 向 Tmux 会话发送命令,并输入一个回车以启动 "roslaunch" 命令
tmux send-keys -t ego_planner "roslaunch ego_planner single_uav_3.launch" ENTER 

完成任务

这篇关于一、基于xtdrone的仿真无人机学习:定点飞行 (用ego_planner的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



http://www.chinasem.cn/article/819129

相关文章

HarmonyOS学习(七)——UI(五)常用布局总结

自适应布局 1.1、线性布局(LinearLayout) 通过线性容器Row和Column实现线性布局。Column容器内的子组件按照垂直方向排列,Row组件中的子组件按照水平方向排列。 属性说明space通过space参数设置主轴上子组件的间距,达到各子组件在排列上的等间距效果alignItems设置子组件在交叉轴上的对齐方式,且在各类尺寸屏幕上表现一致,其中交叉轴为垂直时,取值为Vert

Ilya-AI分享的他在OpenAI学习到的15个提示工程技巧

Ilya(不是本人,claude AI)在社交媒体上分享了他在OpenAI学习到的15个Prompt撰写技巧。 以下是详细的内容: 提示精确化:在编写提示时,力求表达清晰准确。清楚地阐述任务需求和概念定义至关重要。例:不用"分析文本",而用"判断这段话的情感倾向:积极、消极还是中性"。 快速迭代:善于快速连续调整提示。熟练的提示工程师能够灵活地进行多轮优化。例:从"总结文章"到"用

【前端学习】AntV G6-08 深入图形与图形分组、自定义节点、节点动画(下)

【课程链接】 AntV G6:深入图形与图形分组、自定义节点、节点动画(下)_哔哩哔哩_bilibili 本章十吾老师讲解了一个复杂的自定义节点中,应该怎样去计算和绘制图形,如何给一个图形制作不间断的动画,以及在鼠标事件之后产生动画。(有点难,需要好好理解) <!DOCTYPE html><html><head><meta charset="UTF-8"><title>06

学习hash总结

2014/1/29/   最近刚开始学hash,名字很陌生,但是hash的思想却很熟悉,以前早就做过此类的题,但是不知道这就是hash思想而已,说白了hash就是一个映射,往往灵活利用数组的下标来实现算法,hash的作用:1、判重;2、统计次数;

【专题】2024飞行汽车技术全景报告合集PDF分享(附原数据表)

原文链接: https://tecdat.cn/?p=37628 6月16日,小鹏汇天旅航者X2在北京大兴国际机场临空经济区完成首飞,这也是小鹏汇天的产品在京津冀地区进行的首次飞行。小鹏汇天方面还表示,公司准备量产,并计划今年四季度开启预售小鹏汇天分体式飞行汽车,探索分体式飞行汽车城际通勤。阅读原文,获取专题报告合集全文,解锁文末271份飞行汽车相关行业研究报告。 据悉,业内人士对飞行汽车行业

零基础学习Redis(10) -- zset类型命令使用

zset是有序集合,内部除了存储元素外,还会存储一个score,存储在zset中的元素会按照score的大小升序排列,不同元素的score可以重复,score相同的元素会按照元素的字典序排列。 1. zset常用命令 1.1 zadd  zadd key [NX | XX] [GT | LT]   [CH] [INCR] score member [score member ...]

【机器学习】高斯过程的基本概念和应用领域以及在python中的实例

引言 高斯过程(Gaussian Process,简称GP)是一种概率模型,用于描述一组随机变量的联合概率分布,其中任何一个有限维度的子集都具有高斯分布 文章目录 引言一、高斯过程1.1 基本定义1.1.1 随机过程1.1.2 高斯分布 1.2 高斯过程的特性1.2.1 联合高斯性1.2.2 均值函数1.2.3 协方差函数(或核函数) 1.3 核函数1.4 高斯过程回归(Gauss

【学习笔记】 陈强-机器学习-Python-Ch15 人工神经网络(1)sklearn

系列文章目录 监督学习:参数方法 【学习笔记】 陈强-机器学习-Python-Ch4 线性回归 【学习笔记】 陈强-机器学习-Python-Ch5 逻辑回归 【课后题练习】 陈强-机器学习-Python-Ch5 逻辑回归(SAheart.csv) 【学习笔记】 陈强-机器学习-Python-Ch6 多项逻辑回归 【学习笔记 及 课后题练习】 陈强-机器学习-Python-Ch7 判别分析 【学

系统架构师考试学习笔记第三篇——架构设计高级知识(20)通信系统架构设计理论与实践

本章知识考点:         第20课时主要学习通信系统架构设计的理论和工作中的实践。根据新版考试大纲,本课时知识点会涉及案例分析题(25分),而在历年考试中,案例题对该部分内容的考查并不多,虽在综合知识选择题目中经常考查,但分值也不高。本课时内容侧重于对知识点的记忆和理解,按照以往的出题规律,通信系统架构设计基础知识点多来源于教材内的基础网络设备、网络架构和教材外最新时事热点技术。本课时知识

线性代数|机器学习-P36在图中找聚类

文章目录 1. 常见图结构2. 谱聚类 感觉后面几节课的内容跨越太大,需要补充太多的知识点,教授讲得内容跨越较大,一般一节课的内容是书本上的一章节内容,所以看视频比较吃力,需要先预习课本内容后才能够很好的理解教授讲解的知识点。 1. 常见图结构 假设我们有如下图结构: Adjacency Matrix:行和列表示的是节点的位置,A[i,j]表示的第 i 个节点和第 j 个