PX4代码解析(2)

最新推荐文章于 2024-06-26 21:55:32 发布
最新推荐文章于 2024-06-26 21:55:32 发布
阅读量5.5k 收藏 69
点赞数 21
分类专栏： 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源码中添加自己的程序

超级菜狗
关注
专栏目录
从零开始学习PX4源码6(uORB)
陌城烟雨
10-10 269
本节主要讲义px4-uorb的原理及如何添加一个自定义的uorb消息，并发布出和订阅查看信息。后续所用到的软硬件资源：固件版本1.14.2，硬件赫星：cubeorangeuORB（Micro Object Request Broker，微对象请求代理器）是PX4/Pixhawk系统中非常重要且关键的一个模块，它肩负了整个系统的数据传输任务，所有的传感器数据、GPS、PPM信号、遥控器、姿态控制等等都要从芯片获取后通过uORB进行传输到各个模块进行计算处理。
PX4从放弃到精通（六）：PX4姿态控制代码解析
超维空间科技的博客
01-07 7188
文章目录前言一、期望姿态生成二、姿态角控制1.引入库2.读入数据总结 前言 PX4固件版本1.11.0 代码位置 一、期望姿态生成 代码在mc_att_control_main.cpp中，具体如下． void MulticopterAttitudeControl::generate_attitude_setpoint(const Quatf &q, float dt, bool reset_yaw_sp) { vehicle_attitude_setpoint_s attitude_setpo
PX4代码解析(4)
qq_36903625的博客
03-05 4158
一、引言 二
PX4源码解读
09-30
对开源飞控自己的理解，适合新入门阅读，有很高的借鉴意义！
PX4代码解析(6)
qq_36903625的博客
11-30 3894
上一节介绍了PX4姿态估计调用函数的流程，这一节分享一下我对PX4姿态解算的解读.首先，要理解PX4姿态解算的程序，要先从传感器的特性入手，这里主要介绍的传感器有加速度计，磁力计，陀螺仪.
PX4代码解析(1)
qq_36903625的博客
10-26 9159
前言 做pixhawk飞控有一段时间了，但在学习过程中遇到许多困难，目前网上找不到比较完整的PX4学习笔记，我打算结合自己理解，写写自己对PX4源码的理解，不一定对，只是希望与各位大佬交流交流，同时梳理一下无人机知识。 目前打算分享以下几个内容：代码架构；通信协议；姿态解算算法，控制算法。先这样，后面想到再加。本章先来聊聊px4代码结构 一、代码整体结构 既然要聊px4代码结构，那就先把px4代码结构图放出来,因为px4源码仍然在不断更新迭代，因此老版本与新版本目录结构可能有些不同，我的代码解析参考版本为V
px4代码解析(3)
qq_36903625的博客
11-03 4188
书接上文
PX4代码分析-(一)代码工程结构
Vincent的博客
08-12 785
PX4代码工程结构分析
PX4 的 ECL EKF 公式推导及代码解析.pdf
09-05
PX4无人机系统是一种开源的飞行控制软件，它使用ECL（Estimation and Control Library）进行状态估计和控制，而ECL中利用EKF（扩展卡尔曼滤波器）进行传感器信息的融合。EKF是一种用于非线性动态系统的状态估计方法...
PX4代码解析：振动分析
weixin_44616080的博客
08-24 1604
一、前言 前面的文章主要都是一些理论知识为主，很多读者朋友看了之后可能会有点枯燥，里面很多公式看起来也比较晦涩，今天起给大家讲一讲如何用开源飞控PX4飞好一架飞机，飞机主要以多旋翼和垂起固定翼为主。 使用开源飞控PX4来调试一套无人机是一个较为复杂的过程，不过前期的电机电调选型、桨叶的配套，电池的设计这些内容都不是我擅长的内容，如果有需求的话以后有机会请我专业的朋友给大家来写一写这方面的内容。我要...
px4飞控磁罗盘校准算法理论与代码结合解读
08-09
在这篇文章中，代码解析的文件是ardupilot\libraries\AP_Compass:CompassCalibrator.cpp，该文件中包含了PX4磁罗盘校准算法的实现代码。为了理解这些代码，作者张钦彦在王冲的指导下，提供了一系列的图解和注释来...
PX4代码结构分析
最新发布
Vincent的博客
06-26 423
总结一下，这两种方式是将一些共用的功能通过modleBase进行了提炼，封装成了公共的，减少了代码量。说一下他们的使用场景。在姿态控制控制、姿态估计这种底层的，必须要的应用时候，一般采用第一种启动方式。对于navigator这种上层的应用，有时候进程挂了，不产生严重影响的应用，则可以采用第二种方式。
PX4代码分析-(二)commander代码分析
Vincent的博客
10-22 4323
commander位于Firmware/src/modules/commander文件夹中。该部分主要负责对地面站、遥控器以及其它部分发布的cmd命令，包括vehicle_command::VEHICLE_CMD_DO_SET_MODE、VEHICLE_CMD_DO_SET_HOME和VEHICLE_CMD_NAV_GUIDED_ENABLE、VEHICLE_CMD_NAV_TAKEOFF等命令（从名称差不多就能知道相应的命令对应的功能）。 该部分主要是完成无人机任务模式的切换，比如从loi...
px4原生源码学习-(1)
热门推荐
lyonlui的博客
12-10 1万+
接触px4代码有几天了，想把自己所学所想记录下来.   px4就不过多介绍了，算得上目前使用的最广泛的开源飞控了。为什么说”px4原生代码学习呢”，这还得追溯到被大疆干死的3DR，3DR想做消费级无人机，但苦于团队难建，所以索性就纠集起那几个著名的开源飞控团队，让大家一起搞一起发财（熟知还是被大疆搞死），但还是留下了这个宝贵的开源飞控遗产。这些开源团队中出名的当数APM团队和pixhawk团队，
PX4代码解析（5）
qq_36903625的博客
03-12 4252
一、前言 我所讨论的PX4代码是基于v1.11版本，该版本与之前的版本有不少不同，其中一个比较大的区别在于新版本大部分用到了C++中模板，使得代码没有以前那么容易理解，因此我在后面介绍PX4的姿态估计，控制等重要算法代码时会介绍一部分类与模板的知识，方便大家理解代码。 接下来几章我将讨论我对PX4代码姿态估计的理解，主要的文件是PX4_Firmware/src/modules/attitude_estimator_q/attitude_estimator_q_main.cpp，我的理解不一定正确，一家之言，
PX4水下机器人源码分析
超维空间科技的博客
05-28 1445
PX4Autopilotmain\ROMFS\px4fmu_common\init.d\airframes路径下这个脚本设置了BlueROV2（重型配置）的各种参数和初始化步骤，包括电池设置、通信设置、机架和旋翼配置以及PWM输出功能的映射。通过这些设置，可以确保机器人在启动时加载正确的配置，并按照预期的方式运行param2202710237.879818000BAT1_V_DIV1140.33param78CA_R_REV255param1-1000.50.3。
PX4-代码剖析-启动顺序与日志参数说明
Chasing的博客
05-10 2960
PX4的启动流程基本和之前版本的一致，有微小改动，如下图所示。本文主要查看其中姿态控制部分。 其中姿态部分根据在上图中所在位置为 因此在px4代码中（版本号为1.11）中，查看对应的RCS文件中的内容，为（此处稍有不同） 跳转进去查看为（注，该文件中根据不同的机型，选择不同的对应启动程序，下图仅选择旋翼飞机）： 再次跳转，找到rc.mp_apps即可，如下图所示： 上图中左边以数字开头...
pixhawk&&px4代码分析
07-10
px4代码分析，EKF2算法；Mag
六、PX4(v1.14)多旋翼姿态控制代码(mc_att_control)分析
Vincent的博客
06-23 529
在PX4旋翼机的位置控制中会计算出期望的姿态，该姿态是以四元数的方式给出的。四元数表示的不仅仅是pitch和roll,同时包含了yaw轴的期望。由于pitch和roll的控制是通过旋翼机的倾斜来实现的，yaw轴的控制是通过不同电机差速运动产生的反扭矩来实现的，因此yaw轴的控制比pitch和roll的控制更难、控制的反馈更慢、消耗电机的转速更多。鉴于以上原因，对pitch和roll与yaw的分离可以实现更好的控制。
PX4代码分析-（三）Navigator代码分析
Vincent的博客
08-20 647
PX4代码分析-Navigator代码分析
评论 6
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值