PX4代码解析(2)

最新推荐文章于 2024-04-29 10:50:38 发布
最新推荐文章于 2024-04-29 10:50:38 发布
阅读量4.9k 收藏 63
点赞数 18
分类专栏： PX4 四旋翼 文章标签： PX4 无人机 jmavsim
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/qq_36903625/article/details/120994243
版权

前言

在大致了解PX4代码架构后，我们需要了解PX4的通信机制。在PX4代码架构中，每通信总线主要分为两个部分，一是内部通信总线uORB,即PX4内部进程通信采用的协议，例如PX4内部姿态控制需要获取飞行器姿态，而飞行器姿态是由姿态解算产生，它们之间便是由uorb通信
二是外部通信总线Mavlink，它主要负责飞控端与地面站系统的通信协议，后续会详细讲解，本章主要先了解uorb。本章分为三个部分，先介绍uorb基础，然后结合源码讲解怎么使用uorb，最后实际操作练手

一、uorb基础

关于这一部分，CSDN上有很多大佬对uorb进行了详细的讲解，我写的不一定有他们好，就不献丑了，推荐阅读
1、http://shequ.dimianzhan.com/articles/315
2、https://blog.csdn.net/freeape/article/details/46880637
看完之后，你就会对uorb有一定的了解，说简单点，在uorb中，发送者只管发送消息到消息池中，不管谁去调用，接收者只管去消息池中获得需要的消息，不管消息是谁发布的，示意图如下
在这里插入图片描述
在了解uorb后 ，下面以官方例程开始讲解怎么使用uorb

二、uorb代码讲解

在官方提供的px4代码中，有一个历程就是讲解uorb使用的，首先进入PX4目录下src/example目录，找到px4_simple_app,如下图所示
在这里插入图片描述在px4_simple_app下有一个c文件，直接打开

//需要使用的头文件
#include <px4_platform_common/px4_config.h>
#include <px4_platform_common/tasks.h>
#include <px4_platform_common/posix.h>
#include <unistd.h>
#include <stdio.h>
#include <poll.h>
#include <string.h>
#include <math.h>
#include <uORB/uORB.h>
#include <uORB/topics/sensor_combined.h>
#include <uORB/topics/vehicle_attitude.h>

//声明主函数
__EXPORT int px4_simple_app_main(int argc, char *argv[]);
//主函数
int px4_simple_app_main(int argc, char *argv[])
{
	//在控制台输出Hello Sky
	PX4_INFO("Hello Sky!");

	//定义句柄接收名为sensor_combined的消息
	int sensor_sub_fd = orb_subscribe(ORB_ID(sensor_combined));
	//定义更新频率
	orb_set_interval(sensor_sub_fd, 200);

	//定义结构体变量，并完成初始化
	struct vehicle_attitude_s att;
	memset(&att, 0, sizeof(att));
  //向系统公告自己要发布消息，完成初始化，在系统中创建一个主题，并返回指针
	orb_advert_t att_pub = orb_advertise(ORB_ID(vehicle_attitude), &att);

	/* one could wait for multiple topics with this technique, just using one here */
	px4_pollfd_struct_t fds[] = {
		{ .fd = sensor_sub_fd,   .events = POLLIN },
		/* there could be more file descriptors here, in the form like:
		 * { .fd = other_sub_fd,   .events = POLLIN },
		 */
	};

	int error_counter = 0;

	for (int i = 0; i < 5; i++) {
		/* wait for sensor update of 1 file descriptor for 1000 ms (1 second) */
		//检查1s内是否有数据更新
		//
		int poll_ret = px4_poll(fds, 1, 1000);

		/* handle the poll result */
		//返回值为0，证明1s内数据没有更新
		if (poll_ret == 0) {
			/* this means none of our providers is giving us data */
			PX4_ERR("Got no data within a second");

		} else if (poll_ret < 0) {//返回值为-1，证明出错
			/* this is seriously bad - should be an emergency */
			if (error_counter < 10 || error_counter % 50 == 0) {
				/* use a counter to prevent flooding (and slowing us down) */
				PX4_ERR("ERROR return value from poll(): %d", poll_ret);
			}

			error_counter++;

		} else {//返回值大于0，说明得到数据后还剩poll_ret时间

			if (fds[0].revents & POLLIN) {
				/* obtained data for the first file descriptor */
				//定义sensor_combined的结构体，接收sensor_combined的消息
				struct sensor_combined_s raw;
				/* copy sensors raw data into local buffer */
				//把消息复制出来
				orb_copy(ORB_ID(sensor_combined), sensor_sub_fd, &raw);
				PX4_INFO("Accelerometer:\t%8.4f\t%8.4f\t%8.4f",
					 (double)raw.accelerometer_m_s2[0],
					 (double)raw.accelerometer_m_s2[1],
					 (double)raw.accelerometer_m_s2[2]);

				/* set att and publish this information for other apps
				 the following does not have any meaning, it's just an example
				*/
				//填充到之前公告要发布的话题中
				att.q[0] = raw.accelerometer_m_s2[0];
				att.q[1] = raw.accelerometer_m_s2[1];
				att.q[2] = raw.accelerometer_m_s2[2];
				//发布vehicle_attitude消息
				orb_publish(ORB_ID(vehicle_attitude), att_pub, &att);
			}

			/* there could be more file descriptors here, in the form like:
			 * if (fds[1..n].revents & POLLIN) {}
			 */
		}
	}

	PX4_INFO("exiting");

	return 0;
}

比较重要的注释已经在代码中标注，下面解释一下几个比较重要的点
1.在代码中我们看到了vehicle_attitude_s，sensor_combined_s的结构体，有人会好奇这些结构体怎么产生的。实际上，这些结构体是由我们之前定义好的msg编译产生，即系统根据你之前定义的消息自动生成。打开PX4目录，进入其中msg文件夹，你会看到许多以.msg结尾的文件，如下图
在这里插入图片描述
我们可以在其中找到sensor_combined.msg文件，打开文件

uint64 timestamp				# time since system start (microseconds)

int32 RELATIVE_TIMESTAMP_INVALID = 2147483647	# (0x7fffffff) If one of the relative timestamps is set to this value, it means the associated sensor values are invalid

# gyro timstamp is equal to the timestamp of the message
float32[3] gyro_rad			# average angular rate measured in the XYZ body frame in rad/s over the last gyro sampling period
uint32 gyro_integral_dt		# gyro measurement sampling period in us

int32 accelerometer_timestamp_relative	# timestamp + accelerometer_timestamp_relative = Accelerometer timestamp
float32[3] accelerometer_m_s2		# average value acceleration measured in the XYZ body frame in m/s/s over the last accelerometer sampling period
uint32 accelerometer_integral_dt	# accelerometer measurement sampling period in us

uint8 CLIPPING_X = 1
uint8 CLIPPING_Y = 2
uint8 CLIPPING_Z = 4
uint8 accelerometer_clipping            # bitfield indicating if there was any accelerometer clipping (per axis) during the sampling period

我们可以看到其中定义的消息，结合之前的代码，可以看到px4_simple_app这个例子实际上是取出sensor_combined的加速度数据，并把它以vehicle_attitude话题发布出去，不过这些消息都是系统定义好的，后面会介绍怎么定义和使用自己的消息。
2.代码讲解完毕，但该代码一般情况下不会运行，因为飞控板上的资源非常少，一般是不编译的。控制是否编译的文件在board/px4中（若是V1.11之前的版本可能在cmake文件中），如下
在这里插入图片描述
这些不同文件夹是针对不同硬件的编译配置，打开以fmu开头的文件夹或者sitl，你会发现以.cmake结尾的文件，例如sitl，该文件夹主要主管仿真的相关配置
在这里插入图片描述在这些以.cmake结尾的文件中，我们常用default.cmake，打开文件

px4_add_board(
	PLATFORM posix
	VENDOR px4
	MODEL sitl
	LABEL default
	TESTING
	DRIVERS
		#barometer # all available barometer drivers
		#batt_smbus
		camera_capture
		camera_trigger
		#differential_pressure # all available differential pressure drivers
		#distance_sensor # all available distance sensor drivers
		gps
		#imu # all available imu drivers
		#magnetometer # all available magnetometer drivers
		pwm_out_sim
		#telemetry # all available telemetry drivers
		tone_alarm
		#uavcan
	MODULES
		airspeed_selector
		attitude_estimator_q
		camera_feedback
		commander
		dataman
		ekf2
		events
		fw_att_control
		fw_pos_control_l1
		land_detector
		landing_target_estimator
		#load_mon
		local_position_estimator
		logger
		mavlink
		mc_att_control
		mc_hover_thrust_estimator
		mc_pos_control
		mc_rate_control
		navigator
		rc_update
		replay
		rover_pos_control
		sensors
		#sih
		simulator
		temperature_compensation
		vmount
		vtol_att_control
		uuv_att_control

	SYSTEMCMDS
		#config
		#dumpfile
		dyn
		esc_calib
		led_control
		mixer
		motor_ramp
		motor_test
		#mtd
		#nshterm
		param
		perf
		pwm
		reboot
		sd_bench
		shutdown
		tests # tests and test runner
		#top
		topic_listener
		tune_control
		ver
		work_queue
	EXAMPLES
		dyn_hello # dynamically loading modules example
		fixedwing_control # Tutorial code from https://px4.io/dev/example_fixedwing_control
		hello
		my_demoapp
		#hwtest # Hardware test
		#matlab_csv_serial
		px4_mavlink_debug # Tutorial code from http://dev.px4.io/en/debug/debug_values.html
		px4_simple_app # Tutorial code from http://dev.px4.io/en/apps/hello_sky.html
		rover_steering_control # Rover example app
		uuv_example_app
		work_item
	)

set(config_sitl_viewer jmavsim CACHE STRING "viewer for sitl")
set_property(CACHE config_sitl_viewer PROPERTY STRINGS "jmavsim;none")

set(config_sitl_debugger disable CACHE STRING "debugger for sitl")
set_property(CACHE config_sitl_debugger PROPERTY STRINGS "disable;gdb;lldb")

# If the environment variable 'replay' is defined, we are building with replay
# support. In this case, we enable the orb publisher rules.
set(REPLAY_FILE "$ENV{replay}")
if(REPLAY_FILE)
	message(STATUS "Building with uorb publisher rules support")
	add_definitions(-DORB_USE_PUBLISHER_RULES)

	message(STATUS "Building without lockstep for replay")
	set(ENABLE_LOCKSTEP_SCHEDULER no)
else()
	set(ENABLE_LOCKSTEP_SCHEDULER yes)
endif()

你会看到一些比较熟悉的字母，例如DRIVERS，MODULES等，这正是我们src目录下的文件，而跟在这些文件夹之后的正是目录下的源代码，其实这份编译文件我已经修改过，在EXAMPLES下有px4_simple_app

三、px4_simple_app代码结果展示

验证代码结果，你可以将代码下载到支持PX4的硬件中，也可以采用jMavSim，gazebo等仿真软件进行半物理仿真，操作步骤如下
1.按上一章的讲解找到boards/px4/sitl文件夹，修改default.camke文件，在EXAMPLES下添加px4_simple_app
2.保存，在PX4目录下输入代码make px4_sitl_default jmavsim，等待编译成功
3.当出现下面界面就说明编译成功
在这里插入图片描述4.这时返回终端窗口，输入help，你会看到可以运行的代码，你会在其中找到px4_simple_app
在这里插入图片描述5.在终端输入px4_simple_app，会有以下结果
在这里插入图片描述
下章介绍如何在msg中添加自己的消息，并在PX4源码中添加自己的程序

超级菜狗
关注
  • 18
    点赞
  • 踩
  • 63
    收藏
    觉得还不错? 一键收藏
  • 6
    评论
专栏目录
px4代码解析(3)
qq_36903625的博客
11-03 3628
书接上文
PX4模块设计之二：uORB消息代理
lida2003的专栏
07-07 2154
uORB(Micro Object Request Broker，微对象请求代理器)是PX4中非常重要且关键的一个模块，通过异步publish/subscribe的消息传递方式，用于各个模块之间的数据交互。这个使我想到了11年的时候，接触的CORBA, Common Object Request Broker。度娘了一圈（包括Google），发现这个uORB是PX4的特殊模块，也没有被抽象出来（比如：Nuttx，MAVLink，Coap，Mqtt等能独立抽象出来）。其实对象模型更多考虑是解耦（松耦合模块设计
PX4开源飞控--开发环境搭建 编译仿真及烧录
最新发布
zhoubiaodi的博客
04-29 1924
PIXHAWK是应用较广的开源飞控硬件平台，PX4是开源飞控软件平台，可以烧写到PIXHAWK这款硬件板上。PX4飞控软件平台（PX4专为PIXHAWK开发的），它提供了一个虚拟环境，可以用来验证无人机的飞控算法，也可以连接开源硬件PIXHAWK。
基础实验篇 | uORB消息读写与自定义实验(三)
FEISILAB(飞思实验室）
08-04 285
uORB是PX4/Pixhawk系统中非常重要且关键的模块之一，是用于无人机模块间通信的协议机制。本篇将详细介绍uORB并详细拆解uORB消息读写与自定义实验流程（三）。
UORB 理解与总结
weixin_42334782的博客
04-02 2512
UORB是用来在各个进程之间进行通信的，分为如下几个步骤： 发布数据 1,首先公告主题： orb_advert_t orb_advertise(const struct orb_metadata *meta, const void *data) 相当于注册，只能有一次 2，发布数据： int orb_publish(const struct orb_metadata *meta, orb_adv...
Pixhawk uORB通信
linuxarmsummary的专栏
12-07 1万+
Pixhawk 飞控系统是基于ARM的四轴以上飞行器的飞行控制器， 它的前身是PX4-IMU，Pixhawk 把之前的IMU进行了完整的重构，最新版本是2.4.3。而对应的Pixhawk 1.x版本与2.x版本的区别在于，I/O板与FMU是否整合在一起。 uORB是Pixhawk系统中非常重要且关键的一个模块，它肩负了整个系统的数据传输任务，所有的传感器数据、GPS、PPM信号等都要从芯片
PX4模块设计之四：MAVLink简介
lida2003的专栏
07-09 3036
基于PX4开源软件框架简明简介的框架设计，逐步分析内部模块功能设计。前面了解了三种消息中间件中的一种uORB消息中间件，接下来看下MAVLink中间件。PX4使用MAVLink与QGroundControl(或者其他地面站软件)，并且也用于飞控以外的伴飞电脑和摄像头通信与控制。目前，MAVLink作为轻量级的通信协议，已被广泛应用与无人机系统。随着应用的拓展，基于该协议定义了一系列标准的消息和微服务用于飞控系统内的数据交互。PX4开源代码将mavlink作为一个submodule集成到/src/module
PX4 的 ECL EKF 公式推导及代码解析.pdf
09-05
PX4 采用 ECL(Estimation and Control Library，估计与控制库）通过 EKF 来进行多传感器信息融合，对此部分进行详细分析。
PX4源码解读
09-30
对开源飞控自己的理解，适合新入门阅读，有很高的借鉴意义！
px4飞控磁罗盘校准算法理论与代码结合解读
08-09
px4飞控磁罗盘校准算法理论与代码结合解读，有分析图解，有代码注释，有理论有实践
PX4飞控中利用EKF估计姿态角代码详解 .rar
04-15
PX4飞控中利用EKF估计姿态角代码详解
PX4源码解读——传感器校正（陀螺仪）.pdf
10-17
该文档从陀螺仪的数学模型，校正流程，px4源码解读三个方面讲解了px4传感器校正代码
PX4代码解析：振动分析
weixin_44616080的博客
08-24 1523
一、前言 前面的文章主要都是一些理论知识为主，很多读者朋友看了之后可能会有点枯燥，里面很多公式看起来也比较晦涩，今天起给大家讲一讲如何用开源飞控PX4飞好一架飞机，飞机主要以多旋翼和垂起固定翼为主。 使用开源飞控PX4来调试一套无人机是一个较为复杂的过程，不过前期的电机电调选型、桨叶的配套，电池的设计这些内容都不是我擅长的内容，如果有需求的话以后有机会请我专业的朋友给大家来写一写这方面的内容。我要...
PX4位置估计源码分析
qq_34994476的博客
01-08 1370
写在前面 源码版本：1.6.0rc1 源码位置：Firmware-1.6.0rc1\src\modules\position_estimator_inav\position_estimator_inav_main.cpp 整体框架： 整个算法的核心思想是由地理坐标系下的加速度通过积分，来获得速度、位置信息；经过2次修正产生可利用的信息，第一次是利用传感器计算修正系数产生加速度的偏差修正加速度，第二次是利用修正系数修正位置；最后可利用速度经过加速度修正，可利用的位置经过了加速度和位置修正。加速度的修正过程是
uORB消息的收发 c++中的使用
qq_44600572的博客
02-01 451
PX4-Autopilot/msg/ 这个目录下定义了所有uORB消息的格式
PX4源码开发人员文档（一）——软件架构
逐鹿中原
09-13 1万+
Pixhawk是一款由PX4开源项目设计并由3DR公司制造生产的高级自动驾驶仪系统。发现网上找不到相关源码的中文教程，于是笔者在学习的同时，顺手翻译了PX4官网上的开发人员文档，在此逐一发布，希望能够给更多的人带去方便。
PX4与Ardupilot的入门基础知识（第一章：架构与启动过程）
热门推荐
陌城烟雨
08-12 2万+
目录 目录 摘要 1.px4与apm的区别与联系 2.px4与apm每个文件夹的作用 摘要 本节主要记录自己学px4的代码架构与Ardupilot代码架构地方对比文档，欢迎批评指正。 （1）px4与apm固件的区别与联系 （2）px4与apm每个文件夹的作用 （3）px4与apm无人机的启动过程 1.px4与apm的区别与联系 ...
pixhawk 整体架构的认识
czyv587的博客
06-10 2万+
PX4自动驾驶仪软件可分为三大部分：实时操作系统、中间件和飞行控制栈。 1.NuttX实时操作系统 提供POSIX-style的用户操作环境(如printf(), pthreads,/dev/ttyS1,open(),write(),poll(),ioctl())，进行底层的任务调度。 2.PX4中间件 PX4中间件运行于操作系统之上，提供设备驱动和一个微对象请求代理（micro obje
PX4应用实例3：px4_simple_app
xiaoshuai537的博客
04-02 1709
1. 打开src/examples/px4_simple_app/px4_simple_app.c #include #include #include #include #include #include #include #include #include #include #include __EXPORT int px4_simple_app_main(int
postMessage 使用
06-07
`postMessage` 方法可以用于在不同的窗口或 iframe 之间进行安全的跨域通信。它能够向指定窗口发送一个消息，并且在接收窗口中设置一个监听器来接收该消息。 `postMessage` 方法的基本语法如下： ```javascript otherWindow.postMessage(message, targetOrigin, [transfer]); ``` 其中，`otherWindow` 表示指定的窗口或 iframe，`message` 表示要发送的消息，`targetOrigin` 表示接收消息的窗口的源（如果不指定，表示不限制源），`transfer` 表示要传递的数据（可选）。 例如，下面的代码可以向指定的窗口发送一个消息： ```javascript var otherWindow = window.open('http://example.com/'); otherWindow.postMessage('Hello, world!', 'http://example.com'); ``` 在上面的代码中，我们首先使用 `window.open` 方法打开了一个新的窗口，并将其引用赋值给了 `otherWindow` 变量。然后，我们使用 `postMessage` 方法向该窗口发送了一个消息。由于指定的源为 `http://example.com`，因此只有来自 `http://example.com` 源的窗口才能接收到该消息。 接收窗口可以使用以下代码来监听消息： ```javascript window.addEventListener('message', function(event) { if (event.origin !== 'http://example.com') { return; } console.log(event.data); }); ``` 在上面的代码中，我们使用 `addEventListener` 方法向当前窗口添加了一个监听器，用于监听 `message` 事件。当接收到事件时，我们首先检查消息的源是否为 `http://example.com`，如果不是，则直接返回。否则，我们就可以使用 `event.data` 属性来获取消息内容，并进行相应的处理。 需要注意的是，`postMessage` 方法虽然可以进行跨域通信，但也存在一定的安全风险。因此，在使用时需要仔细考虑安全问题，并避免发生跨站点脚本（XSS）攻击等问题。

“相关推荐”对你有帮助么？

  • 非常没帮助
  • 没帮助
  • 一般
  • 有帮助
  • 非常有帮助
提交
评论 6
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值