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使用Akshare与Streamlit实现股票估值分析教程(图文代码)

《python使用Akshare与Streamlit实现股票估值分析教程(图文代码)》入职测试中的一道题,要求:从Akshare下载某一个股票近十年的财务报表包括,资产负债表,利润表,现金流量表,保存... 目录一、前言二、核心知识点梳理1、Akshare数据获取2、Pandas数据处理3、Matplotl

Django开发时如何避免频繁发送短信验证码(python图文代码)

《Django开发时如何避免频繁发送短信验证码(python图文代码)》Django开发时,为防止频繁发送验证码,后端需用Redis限制请求频率,结合管道技术提升效率,通过生产者消费者模式解耦业务逻辑... 目录避免频繁发送 验证码1. www.chinasem.cn避免频繁发送 验证码逻辑分析2. 避免频繁

精选20个好玩又实用的的Python实战项目(有图文代码)

《精选20个好玩又实用的的Python实战项目(有图文代码)》文章介绍了20个实用Python项目,涵盖游戏开发、工具应用、图像处理、机器学习等,使用Tkinter、PIL、OpenCV、Kivy等库... 目录① 猜字游戏② 闹钟③ 骰子模拟器④ 二维码⑤ 语言检测⑥ 加密和解密⑦ URL缩短⑧ 音乐播放

python panda库从基础到高级操作分析

《pythonpanda库从基础到高级操作分析》本文介绍了Pandas库的核心功能,包括处理结构化数据的Series和DataFrame数据结构,数据读取、清洗、分组聚合、合并、时间序列分析及大数据... 目录1. Pandas 概述2. 基本操作:数据读取与查看3. 索引操作:精准定位数据4. Group

Spring Boot集成/输出/日志级别控制/持久化开发实践

《SpringBoot集成/输出/日志级别控制/持久化开发实践》SpringBoot默认集成Logback,支持灵活日志级别配置(INFO/DEBUG等),输出包含时间戳、级别、类名等信息,并可通过... 目录一、日志概述1.1、Spring Boot日志简介1.2、日志框架与默认配置1.3、日志的核心作用

Python使用Tenacity一行代码实现自动重试详解

《Python使用Tenacity一行代码实现自动重试详解》tenacity是一个专为Python设计的通用重试库,它的核心理念就是用简单、清晰的方式,为任何可能失败的操作添加重试能力,下面我们就来看... 目录一切始于一个简单的 API 调用Tenacity 入门:一行代码实现优雅重试精细控制:让重试按我

深度解析Spring Security 中的 SecurityFilterChain核心功能

《深度解析SpringSecurity中的SecurityFilterChain核心功能》SecurityFilterChain通过组件化配置、类型安全路径匹配、多链协同三大特性,重构了Spri... 目录Spring Security 中的SecurityFilterChain深度解析一、Security

MySQL中EXISTS与IN用法使用与对比分析

《MySQL中EXISTS与IN用法使用与对比分析》在MySQL中,EXISTS和IN都用于子查询中根据另一个查询的结果来过滤主查询的记录,本文将基于工作原理、效率和应用场景进行全面对比... 目录一、基本用法详解1. IN 运算符2. EXISTS 运算符二、EXISTS 与 IN 的选择策略三、性能对比

MySQL 内存使用率常用分析语句

《MySQL内存使用率常用分析语句》用户整理了MySQL内存占用过高的分析方法,涵盖操作系统层确认及数据库层bufferpool、内存模块差值、线程状态、performance_schema性能数据... 目录一、 OS层二、 DB层1. 全局情况2. 内存占js用详情最近连续遇到mysql内存占用过高导致

深度解析Nginx日志分析与499状态码问题解决

《深度解析Nginx日志分析与499状态码问题解决》在Web服务器运维和性能优化过程中,Nginx日志是排查问题的重要依据,本文将围绕Nginx日志分析、499状态码的成因、排查方法及解决方案展开讨论... 目录前言1. Nginx日志基础1.1 Nginx日志存放位置1.2 Nginx日志格式2. 499