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

2023-05-16

 

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写的,只要基础控制模块建立起来,再往上做复杂的高级功能就好多了。

 

本文内容由网友自发贡献,版权归原作者所有,本站不承担相应法律责任。如您发现有涉嫌抄袭侵权的内容,请联系:hwhale#tublm.com(使用前将#替换为@)

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

随机推荐