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

相关文章

SpringBoot中四种AOP实战应用场景及代码实现

《SpringBoot中四种AOP实战应用场景及代码实现》面向切面编程(AOP)是Spring框架的核心功能之一,它通过预编译和运行期动态代理实现程序功能的统一维护,在SpringBoot应用中,AO... 目录引言场景一:日志记录与性能监控业务需求实现方案使用示例扩展:MDC实现请求跟踪场景二:权限控制与

慢sql提前分析预警和动态sql替换-Mybatis-SQL

《慢sql提前分析预警和动态sql替换-Mybatis-SQL》为防止慢SQL问题而开发的MyBatis组件,该组件能够在开发、测试阶段自动分析SQL语句,并在出现慢SQL问题时通过Ducc配置实现动... 目录背景解决思路开源方案调研设计方案详细设计使用方法1、引入依赖jar包2、配置组件XML3、核心配

Java NoClassDefFoundError运行时错误分析解决

《JavaNoClassDefFoundError运行时错误分析解决》在Java开发中,NoClassDefFoundError是一种常见的运行时错误,它通常表明Java虚拟机在尝试加载一个类时未能... 目录前言一、问题分析二、报错原因三、解决思路检查类路径配置检查依赖库检查类文件调试类加载器问题四、常见

Python中的Walrus运算符分析示例详解

《Python中的Walrus运算符分析示例详解》Python中的Walrus运算符(:=)是Python3.8引入的一个新特性,允许在表达式中同时赋值和返回值,它的核心作用是减少重复计算,提升代码简... 目录1. 在循环中避免重复计算2. 在条件判断中同时赋值变量3. 在列表推导式或字典推导式中简化逻辑

SpringBoot请求参数接收控制指南分享

《SpringBoot请求参数接收控制指南分享》:本文主要介绍SpringBoot请求参数接收控制指南,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐教... 目录Spring Boot 请求参数接收控制指南1. 概述2. 有注解时参数接收方式对比3. 无注解时接收参数默认位置

利用Python调试串口的示例代码

《利用Python调试串口的示例代码》在嵌入式开发、物联网设备调试过程中,串口通信是最基础的调试手段本文将带你用Python+ttkbootstrap打造一款高颜值、多功能的串口调试助手,需要的可以了... 目录概述:为什么需要专业的串口调试工具项目架构设计1.1 技术栈选型1.2 关键类说明1.3 线程模

Python Transformers库(NLP处理库)案例代码讲解

《PythonTransformers库(NLP处理库)案例代码讲解》本文介绍transformers库的全面讲解,包含基础知识、高级用法、案例代码及学习路径,内容经过组织,适合不同阶段的学习者,对... 目录一、基础知识1. Transformers 库简介2. 安装与环境配置3. 快速上手示例二、核心模

Java的栈与队列实现代码解析

《Java的栈与队列实现代码解析》栈是常见的线性数据结构,栈的特点是以先进后出的形式,后进先出,先进后出,分为栈底和栈顶,栈应用于内存的分配,表达式求值,存储临时的数据和方法的调用等,本文给大家介绍J... 目录栈的概念(Stack)栈的实现代码队列(Queue)模拟实现队列(双链表实现)循环队列(循环数组

Spring Security+JWT如何实现前后端分离权限控制

《SpringSecurity+JWT如何实现前后端分离权限控制》本篇将手把手教你用SpringSecurity+JWT搭建一套完整的登录认证与权限控制体系,具有很好的参考价值,希望对大家... 目录Spring Security+JWT实现前后端分离权限控制实战一、为什么要用 JWT?二、JWT 基本结构

一文带你搞懂Python中__init__.py到底是什么

《一文带你搞懂Python中__init__.py到底是什么》朋友们,今天我们来聊聊Python里一个低调却至关重要的文件——__init__.py,有些人可能听说过它是“包的标志”,也有人觉得它“没... 目录先搞懂 python 模块(module)Python 包(package)是啥?那么 __in