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

相关文章

Go标准库常见错误分析和解决办法

《Go标准库常见错误分析和解决办法》Go语言的标准库为开发者提供了丰富且高效的工具,涵盖了从网络编程到文件操作等各个方面,然而,标准库虽好,使用不当却可能适得其反,正所谓工欲善其事,必先利其器,本文将... 目录1. 使用了错误的time.Duration2. time.After导致的内存泄漏3. jsO

springboot循环依赖问题案例代码及解决办法

《springboot循环依赖问题案例代码及解决办法》在SpringBoot中,如果两个或多个Bean之间存在循环依赖(即BeanA依赖BeanB,而BeanB又依赖BeanA),会导致Spring的... 目录1. 什么是循环依赖?2. 循环依赖的场景案例3. 解决循环依赖的常见方法方法 1:使用 @La

使用C#代码在PDF文档中添加、删除和替换图片

《使用C#代码在PDF文档中添加、删除和替换图片》在当今数字化文档处理场景中,动态操作PDF文档中的图像已成为企业级应用开发的核心需求之一,本文将介绍如何在.NET平台使用C#代码在PDF文档中添加、... 目录引言用C#添加图片到PDF文档用C#删除PDF文档中的图片用C#替换PDF文档中的图片引言在当

Kotlin 作用域函数apply、let、run、with、also使用指南

《Kotlin作用域函数apply、let、run、with、also使用指南》在Kotlin开发中,作用域函数(ScopeFunctions)是一组能让代码更简洁、更函数式的高阶函数,本文将... 目录一、引言:为什么需要作用域函数?二、作用域函China编程数详解1. apply:对象配置的 “流式构建器”最

C#使用SQLite进行大数据量高效处理的代码示例

《C#使用SQLite进行大数据量高效处理的代码示例》在软件开发中,高效处理大数据量是一个常见且具有挑战性的任务,SQLite因其零配置、嵌入式、跨平台的特性,成为许多开发者的首选数据库,本文将深入探... 目录前言准备工作数据实体核心技术批量插入:从乌龟到猎豹的蜕变分页查询:加载百万数据异步处理:拒绝界面

用js控制视频播放进度基本示例代码

《用js控制视频播放进度基本示例代码》写前端的时候,很多的时候是需要支持要网页视频播放的功能,下面这篇文章主要给大家介绍了关于用js控制视频播放进度的相关资料,文中通过代码介绍的非常详细,需要的朋友可... 目录前言html部分:JavaScript部分:注意:总结前言在javascript中控制视频播放

Spring Boot 3.4.3 基于 Spring WebFlux 实现 SSE 功能(代码示例)

《SpringBoot3.4.3基于SpringWebFlux实现SSE功能(代码示例)》SpringBoot3.4.3结合SpringWebFlux实现SSE功能,为实时数据推送提供... 目录1. SSE 简介1.1 什么是 SSE?1.2 SSE 的优点1.3 适用场景2. Spring WebFlu

java之Objects.nonNull用法代码解读

《java之Objects.nonNull用法代码解读》:本文主要介绍java之Objects.nonNull用法代码,具有很好的参考价值,希望对大家有所帮助,如有错误或未考虑完全的地方,望不吝赐... 目录Java之Objects.nonwww.chinasem.cnNull用法代码Objects.nonN

Spring事务中@Transactional注解不生效的原因分析与解决

《Spring事务中@Transactional注解不生效的原因分析与解决》在Spring框架中,@Transactional注解是管理数据库事务的核心方式,本文将深入分析事务自调用的底层原理,解释为... 目录1. 引言2. 事务自调用问题重现2.1 示例代码2.2 问题现象3. 为什么事务自调用会失效3

SpringBoot实现MD5加盐算法的示例代码

《SpringBoot实现MD5加盐算法的示例代码》加盐算法是一种用于增强密码安全性的技术,本文主要介绍了SpringBoot实现MD5加盐算法的示例代码,文中通过示例代码介绍的非常详细,对大家的学习... 目录一、什么是加盐算法二、如何实现加盐算法2.1 加盐算法代码实现2.2 注册页面中进行密码加盐2.