当前位置：首页 > news >正文

Ubuntu20.04下Px4使用UORB发布消息

news 2025/8/16 6:59:57

1 .msg文件夹定义数据类型及变量名

文件位置如图，在PX4-Autopilot/msg文件夹下，笔者创建的文件名为gps_msg.msg

gps_msg.msg内容如下

uint64 timestamp # 时间戳
float32 latitude
float32 longitude

float32 altitude

同时，在CMakeLists.txt中添加gps_msg.msg

2 .编译
终端打开PX4-Autopilot，运行命令

make px4_fmu-v3_default

开始编译，用于生成.h头文件

编译结束

一开始用的fmu-v3发现没有生成.h文件

换成了

make px4_fmu-v4_default

生成的gps_msg.h位置和内容如图

3. 创建新模块

在PX4的src/modules目录下创建一个新文件夹，比如笔者此处命名为alxx 。

在alxx文件夹下创建CMakeList.txt文件，内容如下

px4_add_module(
#下面添加文件夹名字
MODULE examples__alxx
#下面添加线程名字
MAIN x

SRCS
#添加文件夹里面.cpp文件
01gps_msg.cpp

DEPENDS
)

将自己的模块名（笔者的是alxx）添加进default.cmake文件下，笔者使用的是fmu-v4编译的，所以到PX4-Autopilot/boards/px4/fmu-v4里面的default.cmake文件中进行添加

4.cpp文件内容的编写

#include <uORB/uORB.h>
#include <uORB/topics/gps_msg.h> // 引入想要发布的消息类型的头文件
#include <drivers/drv_hrt.h>//包含函数hrt_absolute_time()
#include <uORB/Publication.hpp> //用于创建一个 uORB 发布器
#include <systemlib/mavlink_log.h> //使用mavlink_log_critical()函数

using namespace std;

extern "C" __EXPORT int x_main(int argc, char *argv[]);//主函数告诉编译器使用 C 语言的方式来处理特定的函数或代码块。
int x_thread(int argc, char *argv[]);//线程

static bool thread_running = false;//线程运行标志
static bool thread_should_exit = false;//线程结束标志
static orb_advert_t mavlink_log_pub = 0; //使用 &mavlink_log_pub
static int daemon_task;

class main_task01//主函数命名
{
public:
void run();
private:

};

void main_task01::run()
{
// 创建一个 gps_msg_s 结构体并初始化消息数据
gps_msg_s gps_msg{};
gps_msg.timestamp = hrt_absolute_time();
gps_msg.latitude = 37.7749;
gps_msg.longitude = -122.4194;
gps_msg.altitude = 11.0f;

// 创建一个 uORB 发布器，发布 gps_msg 消息
uORB::Publication<gps_msg_s> gps_msg_pub{ORB_ID(gps_msg)};

PX4_INFO("alxx使用C++发布了Uorb消息");//终端打印消息
while (true) {
// 发布消息
gps_msg_pub.publish(gps_msg);
}

}

int x_main(int argc, char *argv[])
{
/*检查传递给程序的命令行参数数量，如果参数数量小于2，使用 mavlink_log_critical 函数向 mavlink_log_pub
发布一条关于“[lxx]mission command”的严重级别日志消息。*/
if (argc < 2) {
mavlink_log_critical(&mavlink_log_pub, "[lxx]mission command");
}
if (!strcmp(argv[1], "start")) {
if (thread_running) {
/*检查 thread_running 是否为真，如果是，它会发布一条关于 "[lxx]already running" 的严重级别日志消息。*/
mavlink_log_critical(&mavlink_log_pub, "[lxx]already running");
}
thread_should_exit = false; //表示线程不应该退出。
thread_running = true; //表示线程正在运行
daemon_task = px4_task_spawn_cmd("x",
SCHED_DEFAULT,
SCHED_PRIORITY_MAX - 5,
3000,
x_thread, //启动一个新任务（x_thread），可能是为了执行特定的线程函数，并传递其他参数。
&argv[2]);
return 0;
}
if (!strcmp(argv[1], "stop")) {
thread_should_exit = true;
}
mavlink_log_critical(&mavlink_log_pub, "unrecognized command");
return 0;
}

int x_thread(int argc, char *argv[])
{
main_task01 x;
x.run();
return 0;
}

终端打开PX4-Autopilot，再编译

make px4_fmu-v4_default

5.运行

运行仿真语句

make px4_sitl_default jmavsim

报错，因为make前面多打了空格

重新输入后

可以打开仿真

鼠标光标定位到终端最下方，输入“help”

还有PX4-Autopilot/boards/px4/sitl里面的default.cmake 也要添加alxx

再编译

make px4_fmu-v4_default

启动仿真

make px4_sitl_default jmavsim

运行

help

笔者定义的线程是x，在最后

运行

x start

输出.msg文件里定义的数据

listener gps_msg

6.添加自启动

文件所在位置：PX4-Autopilot/ROMFS/px4fmu_common/init.d

打开文件 rc.mc_apps

翻至最下方，在最下方添加自己的线程名 start ，笔者定义的线程是x，所以在最下方添加的内容如下

保存文件。终端打开px4源码，先清空之前编译的内容。

在Linux中，make clean 是一个常用于管理源代码编译过程的命令。这个命令通常定义在Makefile文件中，是make工具的一个标准目标。make clean的主要作用是清除之前编译过程中产生的所有编译和链接产物，比如对象文件（.o文件）、编译生成的可执行文件以及其他中间文件。这样做的目的是为了确保下一次编译是从一个干净的状态开始，避免由于旧的编译产物导致的潜在问题。

在进行源代码的编译时，尤其是在进行多次编译或者修改了源代码后，使用make clean可以保证新的编译不会受到之前编译产物的影响，从而减少编译错误和问题。然而，需要注意的是，执行make clean后，之前编译生成的所有文件都会被删除，所以在执行这个命令之前要确保不再需要这些文件。