GAAS的px4_mavros_run.py 代码分析(这也应该是GAAS的基础核心控制部分代码)

2023-12-18 08:08

本文主要是介绍GAAS的px4_mavros_run.py 代码分析(这也应该是GAAS的基础核心控制部分代码),希望对大家解决编程问题提供一定的参考价值,需要的开发者们随着小编来一起学习吧!

 

https://github.com/generalized-intelligence/GAAS/blob/master/software/px4_mavros_scripts/1_px4_mavros_offboard_controller/px4_mavros_run.py

 

这个文件在七月在线的GAAS第9节课有一个比较详细的讲解。当然在第四节课的最后也有简单提到。

 

我似乎明白了,这个文件只是发送控制指令的,你不管是用GPS还是用SLAM,都是用这个文件,这个文件只是发送控制指令的应该,具体SLAM的位置信息应该是其他节点发的,我认为应该是这样,你可以去其他文件找找。

这里可以看到包含了摄像头估计的位置信息的是这个pose,这种话题或者消息应该不是px4_mavros_run.py发布的,px4_mavros_run.py发布的应该是mavros/setpoint_raw/local这个消息

是的,首先我可以确定PX4是完整收到了VSLAM得到的位置信息的,这个在ZN无人机课程里面他都用地面站查看了的,是实时接受到的,GAAS里面也说了,要查看这发布的位置信息是有意义的,当然我估计ZN无人机课程也是参考了GAAS的,而且GAAS它又专门的文件发送控制指令,让它飞到哪个点。我觉得PX4一方面实时接受这个当前的位置信息,一方面也是接受控制指令的。

https://gaas.gitbook.io/guide/software-realization-build-your-own-autonomous-drone/wu-ren-ji-zi-dong-jia-shi-xi-lie-part-3-zai-wu-gps-huan-jing-xia-tong-guo-slam-shi-xian-wei-zhi-gu-j

参照对比古月给的pyhton版的publisher的代码

http://shequ.dimianzhan.com/articles/376

我感觉我可以先把GAAS的这个实现,看后查看它里面所有的消息还有那个计算图,这样就可以完全掌握它的消息走向了!!!!!这样你也就知道PX4到底接受了什么信息。

 

 

 

 

 

 

===============================================================

总体可以看出  px4_mavros_run.py  是非常关键的一个代码,不管是GPS下offboard控制还是SLAM下offboard控制都是用的这个文件,我去看了下这个文件里面出现了比如目标位置,当前位置,这可能就是真正弄清楚offboard的是会给飞控发送的到底是什么消息  这文件里面我还看到了NED  ENU坐标系。

https://github.com/generalized-intelligence/GAAS/blob/master/software/px4_mavros_scripts/1_px4_mavros_offboard_controller/px4_mavros_run.py

ZN无人机看出提供的代码文件里也是有GAAS的这个文件的 px4_mavros_run.py

他应该也是借助了GAAS已经封装好的一些东西来实现,本身GAAS讲课的老师说了很多东西已经给你弄好了,可以很方便地弄。

我可以去看看ZN无人机课程里有没有详细讲这段代码的。

 

 

 

这出出现了publish    cur_target_pose,我觉得这个消息看名字应该是包含当前位置和目标位置信息,这个在这个文件里面多次出现!!!!!!

不对cur_target_pose好像就是当前目标位置

看72行的那个赋值

self.cur_target_pose = self.construct_target(0, 0, self.takeoff_height, self.current_heading)

其实就是把水平坐标(0,0)    takeoff_height应该是起飞高度     current_heading应该是机头朝向,   这四个信息就可以完全确定一个无人机的位置和朝向了,应该就是期望的位置和朝向。

 

 

它的这段初始化代码应该包含了它所有的参数,可以看书,self.local_pose我觉得一个是当前位置,self.cur_target_pose我觉得应该是目标位置

 

 

 

hover是盘旋的一时,所以函数的处理就是把当前位置local_pose的信息直接赋给目标位置cur_target_pose,方向赋值当前方向current_heading也就是不变。

悬停如果就是把当前位置作为目标位置,这样不会产生累计便宜么,没有一个固定的全局目标位置么?

 

 

上面两个给   cur_target_pose   赋值都是用的construct_target()这个函数

 

 

 

降落则是把当前位置local_pose的X,Y赋给cur_target_pose,Z给赋值0.1,方向赋值当前方向也就是不变current_heading

 

当前的位置信息应该都是由接受到的信息得到,这个信息可能是传感器发出的,可能是比如摄像头SLAM后发出的。我是这么理解的。

 

 

callback是回调函数的意思

就是ROS接受到消息之后都会执行的一个回调函数,这也得益于之前看了ROS的基础课程,不然你怎么看得懂,再一次说明打基础的重要性。

python里面注释似乎就是两个三点

看了下这里面回调函数干的都是接受到信息之后把信息值赋给比如当前位置等等的。

 

 

这个文件里面所有的Publish   subscriber  服务应该都写在这里了

 

 

 

2021.2.24

我现在再来看这个应该是能看出一些头绪的,应该和普罗米修斯类似我觉得,它这定义了一个类叫 Px4Controller,这个含义很明显了

然后看它下面订阅的消息和发布的消息,订阅的飞控内部的状态信息,发布的是 mavros/setpoint_raw/local ,这很明显就是设置期望位置的嘛,和普罗米修斯的一样。

对比看看普罗米修斯的 state_from_mavros.h   command_to_mavros.h  也是这几个消息

 

看来这就是GAAS最为关键核心的代码,就犹如普罗米修斯的控制模块,犹如px4_command,只不过他们是用python写的,XTDrone也是用python写的,只要基础控制模块建立起来,再往上做复杂的高级功能就好多了。

 

这篇关于GAAS的px4_mavros_run.py 代码分析(这也应该是GAAS的基础核心控制部分代码)的文章就介绍到这儿,希望我们推荐的文章对编程师们有所帮助!



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

相关文章

基于Python开发Windows屏幕控制工具

《基于Python开发Windows屏幕控制工具》在数字化办公时代,屏幕管理已成为提升工作效率和保护眼睛健康的重要环节,本文将分享一个基于Python和PySide6开发的Windows屏幕控制工具,... 目录概述功能亮点界面展示实现步骤详解1. 环境准备2. 亮度控制模块3. 息屏功能实现4. 息屏时间

Python如何去除图片干扰代码示例

《Python如何去除图片干扰代码示例》图片降噪是一个广泛应用于图像处理的技术,可以提高图像质量和相关应用的效果,:本文主要介绍Python如何去除图片干扰的相关资料,文中通过代码介绍的非常详细,... 目录一、噪声去除1. 高斯噪声(像素值正态分布扰动)2. 椒盐噪声(随机黑白像素点)3. 复杂噪声(如伪

Java Spring ApplicationEvent 代码示例解析

《JavaSpringApplicationEvent代码示例解析》本文解析了Spring事件机制,涵盖核心概念(发布-订阅/观察者模式)、代码实现(事件定义、发布、监听)及高级应用(异步处理、... 目录一、Spring 事件机制核心概念1. 事件驱动架构模型2. 核心组件二、代码示例解析1. 事件定义

Python实例题之pygame开发打飞机游戏实例代码

《Python实例题之pygame开发打飞机游戏实例代码》对于python的学习者,能够写出一个飞机大战的程序代码,是不是感觉到非常的开心,:本文主要介绍Python实例题之pygame开发打飞机... 目录题目pygame-aircraft-game使用 Pygame 开发的打飞机游戏脚本代码解释初始化部

Python包管理工具核心指令uvx举例详细解析

《Python包管理工具核心指令uvx举例详细解析》:本文主要介绍Python包管理工具核心指令uvx的相关资料,uvx是uv工具链中用于临时运行Python命令行工具的高效执行器,依托Rust实... 目录一、uvx 的定位与核心功能二、uvx 的典型应用场景三、uvx 与传统工具对比四、uvx 的技术实

Java中Map.Entry()含义及方法使用代码

《Java中Map.Entry()含义及方法使用代码》:本文主要介绍Java中Map.Entry()含义及方法使用的相关资料,Map.Entry是Java中Map的静态内部接口,用于表示键值对,其... 目录前言 Map.Entry作用核心方法常见使用场景1. 遍历 Map 的所有键值对2. 直接修改 Ma

MyBatis Plus 中 update_time 字段自动填充失效的原因分析及解决方案(最新整理)

《MyBatisPlus中update_time字段自动填充失效的原因分析及解决方案(最新整理)》在使用MyBatisPlus时,通常我们会在数据库表中设置create_time和update... 目录前言一、问题现象二、原因分析三、总结:常见原因与解决方法对照表四、推荐写法前言在使用 MyBATis

从基础到进阶详解Pandas时间数据处理指南

《从基础到进阶详解Pandas时间数据处理指南》Pandas构建了完整的时间数据处理生态,核心由四个基础类构成,Timestamp,DatetimeIndex,Period和Timedelta,下面我... 目录1. 时间数据类型与基础操作1.1 核心时间对象体系1.2 时间数据生成技巧2. 时间索引与数据

Python主动抛出异常的各种用法和场景分析

《Python主动抛出异常的各种用法和场景分析》在Python中,我们不仅可以捕获和处理异常,还可以主动抛出异常,也就是以类的方式自定义错误的类型和提示信息,这在编程中非常有用,下面我将详细解释主动抛... 目录一、为什么要主动抛出异常?二、基本语法:raise关键字基本示例三、raise的多种用法1. 抛

github打不开的问题分析及解决

《github打不开的问题分析及解决》:本文主要介绍github打不开的问题分析及解决,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录一、找到github.com域名解析的ip地址二、找到github.global.ssl.fastly.net网址解析的ip地址三