PX4开发文档——PX4体系结构概述

基本上翻译的 https://dev.px4.io/master/en/concept/architecture.html

概念

PX4体系结构概述

PX4主要由两层组成:

飞行堆栈flight stack):一个评估和飞行控制系统;

中间件middleware )是一个通用的机器人层,可以支持任何类型的自主机器人,提供内部/外部通信和硬件集成。

所有的PX4构型(airframes)共享一个代码库(包括其他机器人系统,如船,漫游者,潜艇等)。整个系统设计是自动调节的(reactive),这意味着:

  • 所有的功能被划分为可交换和可重用的组件

  • 通信是通过异步消息传递完成的

  • 系统可以处理不同的工作负载

高层次的软件架构(High-Level Software Architecture)

下图提供了PX4构建块的详细概述。图的顶部部分包含中间件块,而下面部分显示飞行堆栈的组件。

PX4_Architecture.png

源代码被分成自包含的模块/程序(如图中monospace字体表示的所示,例如mc_att_control)。

通常,一个构建块恰好对应于一个模块。

在运行时,您可以通过shell中的top命令查看执行了哪些模块,每个模块都可以通过<module_name> start/stop单独启动/停止。虽然top命令是特定于NuttX shell的,但是其他命令也可以在SITL shell (pxh>)中使用。有关这些模块的更多信息,请参阅模块和命令参考(Modules & Commands Reference)。

箭头显示模块之间最重要连接的信息流。实际上,实际连接要比显示的多得多,而且大多数模块都要访问一些数据(例如参数)。

模块通过名为uORB的发布-订阅消息总线相互通信。发布-订阅方案的使用意味着:

  • 系统是reactive的——它是异步的。当新的数据可用是会立刻更新

  • 所有的操作和通信都是完全并行的

  • 系统组件可以以线程安全的方式使用来自任何地方的数据

即使在运行时,这种体系结构也允许快速而轻松地替换这些块中的每一个。

飞行堆栈(Flight Stack)

飞行堆栈是自主无人机的制导、导航和控制算法的集合。它包括固定翼、多旋翼和垂直起降飞机的控制器以及姿态和位置的估计器。

下图显示了飞行堆栈构建块的概述。它包含了完整的流程,从传感器,RC输入和自主飞行控制(导航),到电机或伺服控制(执行器)。

PX4_High-Level_Flight-Stack.png

estimator采用一个或多个传感器输入,组合它们,并计算飞行器的状态。

controller是一种以设定值和测量或估计状态(过程变量)作为输入的组件。它的目标是调整过程变量的值,使其与设定值相匹配。输出是一个修正,最终达到该设定值。例如,位置控制器以位置设定值作为输入,过程变量是当前估计的位置,输出是使车辆向期望位置移动的姿态和推力设定值。

mixer接收force commands(例如向右转),并将其转换为单个电机的命令,同时确保不超过某些限制。这种转换是特定于飞行器类型的,并取决于各种因素,如与重心有关的马达布置,或车辆的转动惯量。

中间件(Middleware)

中间件(middleware)主要由嵌入式传感器的设备驱动程序、与外部世界(伙伴计算机、GCS等)的通信和uORB发布-订阅消息总线组成。

此外,中间件还包括一个模拟层(simulation layer),该层允许PX4飞行代码在桌面操作系统上运行,并在一个模拟的“世界”中控制计算机建模的飞行器。

更新速率( Update Rates)

由于模块等待消息更新,通常驱动程序定义模块更新的速度。大多数IMU驱动程序在1kHz采样数据,整合它和发布与250Hz。系统的其他部分(比如navigator)不需要这么高的更新速度,因此运行速度会慢得多。

可以通过运行uorb top在系统上实时检查消息更新率。

运行环境(Runtime Environment)

PX4运行在各种提供POSIX-API的操作系统上(如Linux、macOS、NuttX或QuRT)。它还应该有某种形式的实时调度(如FIFO)。

模块间通信(使用uORB)基于共享内存。整个PX4中间件运行在单个地址空间,即所有模块之间共享内存。

系统被设计成用最小的代价就可以在单独的地址空间中运行每个模块(需要更改的部分包括uORB, parameter interface, dataman and perf)。

有两种不同的方式执行一个模块:

  • Tasks:模块在自己的任务中运行,具有自己的堆栈和进程优先级。

  • Work queue tasks:该模块运行在一个共享的工作队列上,与队列上的其他模块共享相同的堆栈和工作队列线程优先级。

    • 所有的任务必须协同工作,因为它们不能相互中断。
    • 多个工作队列任务可以在一个队列上运行,并且可以有多个队列。
    • 通过指定将来的固定时间或通过uORB主题更新回调来调度工作队列任务。

    在工作队列上运行模块的优点是它使用更少的RAM,并可能导致更少的任务切换。缺点是不允许工作队列任务对消息进行休眠或轮询,也不允许执行阻塞IO(比如从文件中读取)。长时间运行的任务(执行大量计算)可能也应该在单独的任务中运行,或者至少在单独的工作队列中运行。

在工作队列上运行的任务不会显示在uorb top中(只有工作队列本身可以看到——例如wq:lp_default)。使用work_queue status显示所有活动的工作队列项。

后台任务(Background Tasks)

px4_task_spawn_cmd()用于启动新的任务(NuttX)或线程(POSIX - Linux/macOS),运行独立于调用(父)任务:

independent_task = px4_task_spawn_cmd(
    "commander",                    // Process name
    SCHED_DEFAULT,                  // Scheduling type (RR or FIFO)
    SCHED_PRIORITY_DEFAULT + 40,    // Scheduling priority
    3600,                           // Stack size of the new task or thread
    commander_thread_main,          // Task (or thread) main function
    (char * const *)&argv[0]        // Void pointer to pass to the new task
                                    // (here the commandline arguments).
    );

OS-Specific Information

NuttX

NuttX是在飞行控制板上运行PX4的主要RTOS。它是开源的(BSD许可),轻量级,高效和非常稳定。

模块作为任务执行:它们有自己的文件描述符列表,但是它们共享一个地址空间。任务仍然可以启动一个或多个共享文件描述符列表的线程。

每个任务/线程都有一个固定大小的堆栈,并且有一个定期任务检查所有堆栈是否有足够的剩余空间(基于堆栈着色)。

Linux/macOS

在Linux或macOS上,PX4运行在单个进程中,模块运行在它们自己的线程中(在NuttX上,任务和线程没有区别)。

最后编辑于
©著作权归作者所有,转载或内容合作请联系作者
  • 序言:七十年代末,一起剥皮案震惊了整个滨河市,随后出现的几起案子,更是在滨河造成了极大的恐慌,老刑警刘岩,带你破解...
    沈念sama阅读 218,546评论 6 507
  • 序言:滨河连续发生了三起死亡事件,死亡现场离奇诡异,居然都是意外死亡,警方通过查阅死者的电脑和手机,发现死者居然都...
    沈念sama阅读 93,224评论 3 395
  • 文/潘晓璐 我一进店门,熙熙楼的掌柜王于贵愁眉苦脸地迎上来,“玉大人,你说我怎么就摊上这事。” “怎么了?”我有些...
    开封第一讲书人阅读 164,911评论 0 354
  • 文/不坏的土叔 我叫张陵,是天一观的道长。 经常有香客问我,道长,这世上最难降的妖魔是什么? 我笑而不...
    开封第一讲书人阅读 58,737评论 1 294
  • 正文 为了忘掉前任,我火速办了婚礼,结果婚礼上,老公的妹妹穿的比我还像新娘。我一直安慰自己,他们只是感情好,可当我...
    茶点故事阅读 67,753评论 6 392
  • 文/花漫 我一把揭开白布。 她就那样静静地躺着,像睡着了一般。 火红的嫁衣衬着肌肤如雪。 梳的纹丝不乱的头发上,一...
    开封第一讲书人阅读 51,598评论 1 305
  • 那天,我揣着相机与录音,去河边找鬼。 笑死,一个胖子当着我的面吹牛,可吹牛的内容都是我干的。 我是一名探鬼主播,决...
    沈念sama阅读 40,338评论 3 418
  • 文/苍兰香墨 我猛地睁开眼,长吁一口气:“原来是场噩梦啊……” “哼!你这毒妇竟也来了?” 一声冷哼从身侧响起,我...
    开封第一讲书人阅读 39,249评论 0 276
  • 序言:老挝万荣一对情侣失踪,失踪者是张志新(化名)和其女友刘颖,没想到半个月后,有当地人在树林里发现了一具尸体,经...
    沈念sama阅读 45,696评论 1 314
  • 正文 独居荒郊野岭守林人离奇死亡,尸身上长有42处带血的脓包…… 初始之章·张勋 以下内容为张勋视角 年9月15日...
    茶点故事阅读 37,888评论 3 336
  • 正文 我和宋清朗相恋三年,在试婚纱的时候发现自己被绿了。 大学时的朋友给我发了我未婚夫和他白月光在一起吃饭的照片。...
    茶点故事阅读 40,013评论 1 348
  • 序言:一个原本活蹦乱跳的男人离奇死亡,死状恐怖,灵堂内的尸体忽然破棺而出,到底是诈尸还是另有隐情,我是刑警宁泽,带...
    沈念sama阅读 35,731评论 5 346
  • 正文 年R本政府宣布,位于F岛的核电站,受9级特大地震影响,放射性物质发生泄漏。R本人自食恶果不足惜,却给世界环境...
    茶点故事阅读 41,348评论 3 330
  • 文/蒙蒙 一、第九天 我趴在偏房一处隐蔽的房顶上张望。 院中可真热闹,春花似锦、人声如沸。这庄子的主人今日做“春日...
    开封第一讲书人阅读 31,929评论 0 22
  • 文/苍兰香墨 我抬头看了看天上的太阳。三九已至,却和暖如春,着一层夹袄步出监牢的瞬间,已是汗流浃背。 一阵脚步声响...
    开封第一讲书人阅读 33,048评论 1 270
  • 我被黑心中介骗来泰国打工, 没想到刚下飞机就差点儿被人妖公主榨干…… 1. 我叫王不留,地道东北人。 一个月前我还...
    沈念sama阅读 48,203评论 3 370
  • 正文 我出身青楼,却偏偏与公主长得像,于是被迫代替她去往敌国和亲。 传闻我的和亲对象是个残疾皇子,可洞房花烛夜当晚...
    茶点故事阅读 44,960评论 2 355