编程语言
首页 > 编程语言> > PX4 飞控源码系统框架介绍

PX4 飞控源码系统框架介绍

作者:互联网

转载自:https://my.oschina.net/u/4394481/blog/3321552

PX4 飞控源码系统框架介绍

osc_ozmm6ila

2019/12/31 17:19

阅读数 618

一、build_px4fmu-v2_default

  编译以后生成的文件:内部主要需要在意的就是topics_temporary_header(所有的任务是要的头文件,在创建任务和使用数据结构时可以从该处检索);topics_temporary_sources(系统中所有的任务函数)

二、Cmake

  配置文件,主要使用 nuttx_px4fmu-v2_default.cmake。该处主要是关于系统使用的文

件的路径配置,在 PX4 系统所有的.CPP 和.C 文件都是通过在该处进行路径包含的。在需

要自己创建私有任务或者 sensor 驱动程序时需要添加到该处。

三、mavlink

  主要负责和地面站QGC通信的协议部分,这部分可以直接调用。分为1.0版本和2.0版本,以后都更新到2.0版本了

四、msg

  uORB manger 的缩写:msg。该部分主要是 PX4 系统的使用的所有的数据结构的集

合部分,各种任务和 sensor 驱动中需要获取的 sensor 数据都在此部分,还包含各种运行状

态的数据结构。其中需要注意的是该文件夹下的 Cmakelists.txt,该文档是整个 msg 部分的

配置部分,类似第二部分的 Cmake 中的配置文件一样,在开发者创建任务或者 sensor 驱

动程序时创建对应的数据结构(***.msg)以后,需要把开发者创建的***.msg 添加到

Cmakelists.txt 中,否则编译时识别不到开发者创建的数据结构。

在该部分创建好以后,直接编译可以自动生成相对应的 C/C++下的标准头文件,即在

第一部分所介绍的 topics_temporary_header,在 PX4 系统的任何一个地方引用所需要的数

据结构,都需要把这个头文件包含进去。

五、NuttX

  PX4 所使用的操作系统,其类似 UCos,关于 OS 的基本概念以及够不部分不在详述。

六、ROMFS

  ROM file_system 的简写,内部的 px4fmu_common 文件夹中的 init.d 是关于 px4 系统

初始上电启动的启动脚本,即一系列的启动过程和系统配置。其中主要的几个部分就是 rcS、

rc.sensors、rc.mc_default、rc.mc_apps 等。

rcS:最先启动的脚本,负责挂载 SD、启动 uORB、配置系统参数等。

rc.sensors:启动 sensors 驱动代码。如果在 src/drivers 中创建私有的 sensor 驱动,

建议放在该部分启动。

rc.mc_default:配置和 PWM***相关的系统参数,内部含有怠速的配置。

rc.mc_apps : 启 动 上 层 application , 如 attitude_estimate 、 attitude_control 、

position_estimate 和 position_control 等。如果在 src/modules 中创建私有的上层 application,

建议放在该部分启动。

七、src

  7.1 drivers

  pixhawk 硬件系统中使用的所有的 sensor 的驱动代码。也包含了 STM32 主控

MCU 的 io 输出控制(PX4IO)和 pwm 的驱动。

  7.2 examples

  PX4 系统给的一些简单的实例,为了便于开发者做二次开发调试测试使用。尤其是 px4_simple_app,内部涉及了如何通过 uORB 机制获取所需要的数据。

   7.3 lib

  标准库。

  7.4 modules

  内部就是上层的应用任务代码实现部分,包含姿态结算、姿态控制、配置结算、

位置控制、落地检测、sensor 初始化、系统配置、uORB、commander 等。其中

commander 内部是实现整个控制模式的代码,包含 pixhawk 灯显控制,飞行模式切

换,解锁上锁等等。

相关算法实现也都是在该部分,比如像验证和控制算法先关(自适应 PID)就可

以在 mc_att_control 中加入自己私有的算法做验证。

下面是关于 module 里面的 application 介绍。

  7.4.1、 attitude_estimator_ekf:使用 EKF 算是实现姿态结算。

  7.4.2、 attitude_estimator_q:使用 mahony 的互补滤波算法实现姿态结算。

  7.4.3、 commander:整个系统的过程实现,比如起飞前的各 sensor 的校准算法实现、

安全开关是否使能、飞行模式的切换、pixhawk 硬件上的显示灯的颜色定义等

等。

  7.4.4、 gpio_led:IO 控制 led 的驱动。

  7.4.5、 land_detector:飞行过程中使用 land 模式降落或者受到降落时的落地监测部

分,内部会监测 z 轴速度和加速度等,具体实现请详细阅读源代码。

  7.4.6、 local_position_estimator:常说的 LPE 算法实现位置结算,类似最简单的 KF,

一个预测,一个修正。

  7.4.7、 logger:关于 log 日志的读写函数。

  7.4.8、 mavlink:和地面站通信的通信协议,结合地面站 QGC 源代码配合修改,或者

仅仅调用 mavlink 内部的 API 接口,即可通过无线信号把所需要的数据显示在

地面站 QGC 上,此方法是一种实时监测“目标数据”的方法。

  7.4.9、 mc_att_control:姿态控制的算法实现,主要就是姿态的内外环 PID 控制,外

环角度控制、内环角速度控制。

  7.4.10、 mc_pos_control:位置控制的算法实现,主要就是位置的内外环 PID 控制,外

环速度控制、内环加速度控制。

  7.4.11、 sdlog2:SD 卡的 log 日志读写部分,在 SD 卡中看到的所有数据都是通过该部

分写进去的,平时做 log 日志分析也是查看的这个内部的数据,所以,假如想

监测某个“目标数据”,也可以由此处写到 SD 卡中然后在做相应的分析。

  7.4.12、 sensors:关于各种 sensors 的相关函数。

  7.4.13、 systemlib:系统所需要的参数列表。

  7.4.14、 uORB:IPC 通信机制。首先就是需要了解如何使用它进行进程间通信,了解

整个系统中的数据流流向。

八、Makefile:

最终的编译命令等,通过 shellscript 写的,可以自行对其修改成自己需要的。

九、

 如下介绍对应于上面的红色标识

1、编译以后生成的固件,烧录进飞控即可。内部会有一些需要用到的头文件和.cp文件p。

2、mavlink协议部分,负责地面站通信的库文件都在此。

3、msg是负责进程间通信的消息集合,在自己创建私有任务时需要再次文件内部添加需要的数据结构。

4、Nutt是飞控所用的OS,这个不做系统移植不需要深入研究。我们所做的都是OS之上的。

5、ROMFS内部是启动文件,配置需要启动哪些任务与启动顺序,还有一些就是关于系统默认的一些配置。具体配置哪些需要阅读启动脚本了解。

6、SRC内部就是所有的sensor驱动和各种任务,比如姿态解算和姿态控制、位置解算和位置控制等等。

7、makefile内部是常用的命令行指令集合。

下面主要介绍一下SRC文件夹里面的东西

 

 

 1、drivers:所使用到的所有的sensor驱动程序都在此处。(如果添加sensor,注意该处)

2、顾名思义,实现代码,创建私有任务时可以参考。

3、Lib库,很多矩阵运算相关的数学库。

4、重点,飞行模式,姿态解算,姿态控制,位置结算,位置控制,落地检测等任务都在该modules里面。(飞控相关算法都在该处)

下面介绍重点modules

 

 

 1、姿态解算的代码实现部分

2、落地检测的代码实现部分

3、姿态控制的代码实现部分

4、位置控制的代码实现部分

5、位置解算的代码实现部分

6、各种sensors的初始化部分

7、uORB:进程间通信所用

标签:mc,sensor,系统,PX4,源码,7.4,部分,飞控
来源: https://blog.csdn.net/sinat_16643223/article/details/115032367