【2022_10_17】PX4学习

已于 2022-10-18 11:58:25 修改
阅读量267 收藏
点赞数
文章标签： 学习
于 2022-10-17 21:55:47 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/ssr_acty/article/details/127376562
版权

commander.cpp内
int Commander::custom_command(int argc, char *argv[])
221行
该函数接受所有commander输入的参数，strcmp比较后调用不同的函数
strcmp返回值是0表示相同字符串

比如

if (!strcmp(argv[0], "takeoff")) {
		// switch to takeoff mode and arm
		send_vehicle_command(vehicle_command_s::VEHICLE_CMD_NAV_TAKEOFF);
		send_vehicle_command(vehicle_command_s::VEHICLE_CMD_COMPONENT_ARM_DISARM,
				     static_cast<float>(vehicle_command_s::ARMING_ACTION_ARM),
				     0.f);
		return 0;
	}

这一段对应的是takeoff起飞的conmander命令
调用的所有函数都是send_vehicle_command

static bool send_vehicle_command(const uint32_t cmd, const float param1 = NAN, const float param2 = NAN,
				 const float param3 = NAN,  const float param4 = NAN, const double param5 = static_cast<double>(NAN),
				 const double param6 = static_cast<double>(NAN), const float param7 = NAN)
{
	vehicle_command_s vcmd{};
	vcmd.command = cmd;
	vcmd.param1 = param1;
	vcmd.param2 = param2;
	vcmd.param3 = param3;
	vcmd.param4 = param4;
	vcmd.param5 = param5;
	vcmd.param6 = param6;
	vcmd.param7 = param7;

	uORB::SubscriptionData<vehicle_status_s> vehicle_status_sub{ORB_ID(vehicle_status)};
	vcmd.source_system = vehicle_status_sub.get().system_id;
	vcmd.target_system = vehicle_status_sub.get().system_id;
	vcmd.source_component = vehicle_status_sub.get().component_id;
	vcmd.target_component = vehicle_status_sub.get().component_id;

	uORB::Publication<vehicle_command_s> vcmd_pub{ORB_ID(vehicle_command)};
	vcmd.timestamp = hrt_absolute_time();
	return vcmd_pub.publish(vcmd);
}

调用该函数之后，我们知道飞控的控制分为commander负责事件的处理，由navigator pos_control att_control完成层级的控制，因此在这里commander处理完takeoff这个事件的命令之后应该将一些信息发布给navigator去做

观察这个函数，定义了一个结构体vehicle_command_s vcmd
这是一个uorb msg的实例结构体
它的位置是PX4-Autopilot/build/px4_sitl_default/uORB/topics/vehicle_command.h
有一些参数

函数在对这个msg结构体进行了完整的赋值之后，打了一个时间戳，然后直接发布

发布后该消息会被订阅，之后由谁来处理？

分析导航模块navigator

https://blog.csdn.net/mbdong/article/details/123029120
根据这一篇文章，navigator - 导航模块，根据指定的任务输出导航轨迹
因此我们要实现跟踪，要做的是commander模块不断接收指令，navigator模块不断输出导航轨迹
同时navigator模块只负责输出轨迹，不考虑姿态的问题
要做的

  1. 读通顺commander模块，实现读取实时信号，自动输入commander命令
  2. 修改部分navigator策略，实现对于移动的且移动速度不快的目标不要傻傻地直奔target位置和盘旋

分析盘旋的逻辑
https://blog.csdn.net/shenxingxin/article/details/107703110?ops_request_misc=%257B%2522request%255Fid%2522%253A%2522166601474416782414953227%2522%252C%2522scm%2522%253A%252220140713.130102334…%2522%257D&request_id=166601474416782414953227&biz_id=0&utm_medium=distribute.pc_search_result.none-task-blog-2allsobaiduend~default-1-107703110-null-null.142v58pc_rank_34_2,201v3control_1&utm_term=px4loiter&spm=1018.2226.3001.4187

分析commander具体有哪些命令和含义
https://blog.csdn.net/borbz/article/details/78007453?ops_request_misc=%257B%2522request%255Fid%2522%253A%2522166601463116782414991890%2522%252C%2522scm%2522%253A%252220140713.130102334…%2522%257D&request_id=166601463116782414991890&biz_id=0&utm_medium=distribute.pc_search_result.none-task-blog-2allsobaiduend~default-2-78007453-null-null.142v58pc_rank_34_2,201v3control_1&utm_term=posctl&spm=1018.2226.3001.4187

分析由QGC生成的传入飞控的plan文件
重点是mission后面
cruiseSpeed 巡航速度
firmwareType固件类型
hoverspeed悬停速度

然后是一堆items，就是各个航点的基本信息
每一个航点分为两个{}，由两部分结构体提供一个航点的信息

params部分最后三个参数是
经纬度和高度

比如第一个航点,command命令是22，对应是takeoff

{
    "fileType": "Plan",
    "geoFence": {
        "circles": [
        ],
        "polygons": [
        ],
        "version": 2
    },
    "groundStation": "QGroundControl",
    "mission": {
        "cruiseSpeed": 15,
        "firmwareType": 12,
        "hoverSpeed": 5,
        "items": [
            {
                "AMSLAltAboveTerrain": 50,
                "Altitude": 50,
                "AltitudeMode": 0,
                "autoContinue": true,
                "command": 22,
                "doJumpId": 1,
                "frame": 3,
                "params": [
                    0,
                    0,
                    0,
                    null,
                    47.397757116360204,
                    8.54802567938998,
                    50
                ],
                "type": "SimpleItem"
            },
            {
                "AMSLAltAboveTerrain": 50,
                "Altitude": 50,
                "AltitudeMode": 0,
                "autoContinue": true,
                "command": 16,
                "doJumpId": 2,
                "frame": 3,
                "params": [
                    0,
                    0,
                    0,
                    null,
                    47.395834920202326,
                    8.548141558196932,
                    50
                ],
                "type": "SimpleItem"
            },
            {
                "autoContinue": true,
                "command": 189,
                "doJumpId": 3,
                "frame": 2,
                "params": [
                    0,
                    0,
                    0,
                    0,
                    0,
                    0,
                    0
                ],
                "type": "SimpleItem"
            },
            {
                "AMSLAltAboveTerrain": 25,
                "Altitude": 25,
                "AltitudeMode": 0,
                "autoContinue": true,
                "command": 31,
                "doJumpId": 4,
                "frame": 3,
                "params": [
                    1,
                    50,
                    0,
                    1,
                    47.39580995751514,
                    8.545613891100459,
                    25
                ],
                "type": "SimpleItem"
            },
            {
                "AMSLAltAboveTerrain": 0,
                "Altitude": 0,
                "AltitudeMode": 0,
                "autoContinue": true,
                "command": 21,
                "doJumpId": 5,
                "frame": 3,
                "params": [
                    25,
                    0,
                    0,
                    null,
                    47.39757125904106,
                    8.545589014690734,
                    0
                ],
                "type": "SimpleItem"
            }
        ],
        "plannedHomePosition": [
            47.397742,
            8.545594,
            489
        ],
        "vehicleType": 1,
        "version": 2
    },
    "rallyPoints": {//召集点
        "points": [
        ],
        "version": 2
    },
    "version": 1
}

PX4-Autopilot/src/modules/flight_mode_manager/tasks/AutoFollowTarget/FlightTaskAutoFollowTarget.cpp

ssr_acty
关注
2022年山东广播电视大学开放教育C语言程序设计课程综合练习题.doc
11-19
`是一个空语句，`a=17`是一个赋值语句，`x+y`是一个表达式但不是语句，而`cout是一个输出语句，打印一个换行符。 10. **循环执行次数**：`while(int i=0) i--；`这个循环会立即结束，因为初始化语句`int i=0`会使得...
PX4学习笔记
记录老板的每次pua，分享领导每天的毒鸡汤...
10-04 9975
目录网址Pixhawk、PX4、APM 、 ArduPilot关系硬件照片、示意图逻辑图 集多旋翼控制框架软件框架辅助工具、软件说明（误区）裸机运行基于OS运行例子可执行程序、应用、源码（代码）、进程、线程源码、固件的区分Pixhawk的启动流程大概逻辑 网址 PX4原生固件及其地面站网址 https://github.com/PX4 http://px4.io/ https://github.com/mavlink/qgroundcontrol 原生固件代码：C++，构架清晰，容易维护修改，多进程 目
PX4项目学习::（一）项目架构
one__leaf的博客
12-20 2238
下图所示为PX4的软件顶层架构。我们可以将上图从中间分成两个看，其中右边为传感器采集（GPS、optical_flow、inertial_sensors）回来的数据，，​ px4的控制部分程序，采用的是分层设计。
PX4源码学习（一）：结构概述
Kunfly的博客
10-08 2753
最近在做PX4固件的移植开发工作，由于之前没有这方面开发经验，加之PX4源码又比较庞杂，所以想要通过一点一点的学习梳理和实践，使这部分工作能够尽快开展起来。博客中如有错误，恳请大家指正，同时欢迎小伙伴们一起交流学习。 PX4飞控源码系统框架介绍： 注：本篇内容中所编译的PX4 固件版本为v1.11，以 px4_fmu-v2_default 为例。 一、boards 各种不同的飞控板硬件配置文件。 二、px4_fmu-v2_default 编译后生成的文件，其路径为：Firmware/ bul
PX4系统学习
qq_43096525的博客
03-23 1391
PX4系统学习扑翼飞行器的硬件组成飞控板电调电调的分类舵机2如何改变文本的样式插入链接与图片如何插入一段漂亮的代码片创建一个表格设定内容居中、居左、居右SmartyPants创建一个自定义列表如何创建一个注脚注释也是必不可少的KaTeX数学公式新的甘特图功能，丰富你的文章UML 图表FLowchart流程图导出与导入导出导入 扑翼飞行器的硬件组成 要了解学会二次开发首先要知道，手头的飞行器的硬件结构。以及各个部分的结构是有何种作用的，这样才能在根本上了解编程逻辑，才能真正捋清楚程序的逻辑。 飞控板 飞控板即
无人机PX4学习（1）
Obliviate11的博客
06-14 1616
无人机PX4个人学习笔记（零基础）
一中高二数学10月月考试题(腾飞卷)理(2021-2022学年).pdf
02-26
10. **抛物线的焦半径公式**：在抛物线y²=2px中，点P到焦点的距离等于到准线x=-p/2的距离，即|PF|=x+p/2。题目中点P到焦点F和点A的距离之和最小，发生在PA垂直于准线时，最小值为|AF|-p/2，AF=√((3-p/2)²+2²)。 ...
2021-2022计算机二级等级考试试题及答案No.524.docx
11-02
7. CSS的border-width属性用于设置边框宽度，选项D `border-width: 10px 1px 5px 20px` 按照上右下左的顺序设置了不同的边框宽度。 8. CAD代表计算机辅助设计，是计算机技术在设计领域的应用。 9. HTML中，INPUT...
2021-2022计算机二级等级考试试题及答案No.16932.docx
10-29
17. 边框宽度的设置，上边框10像素、下边框5像素、左边框20像素、右边框1像素的CSS样式是`border-width: 10px 1px 5px 20px`（正确答案：D）。 18. 函数的定义不可以嵌套，但函数的调用可以嵌套（正确答案：B）。 ...
2021-2022计算机二级等级考试试题及答案No.1357.docx
10-27
20. CSS中设置不均匀边框宽度的样式是`border-width: 10px 1px 5px 20px;`，按照上右下左的顺序。 以上就是对计算机二级考试中部分题目的解析，涵盖数据库操作、编程语法、GUI设计、网络应用、文档处理等多个方面。...
PX4学习笔记（1）
qq_45362336的博客
02-08 764
PX4依赖环境搭建、gazebo模拟环境安装步骤
PX4学习笔记（3）
qq_45362336的博客
02-17 2249
PX4编写第一个程序，编译并仿真
px4学习笔记——实时操作系统以及NUTTX
Goodideaer的博客
10-10 1468
一 、操作系统应该具有的功能有: 任务调度： 任务调度其实是个程序，它决定哪个程序在什么时候使用CPU。（windows系统可以同时运行多个程序，这是因为多个程序在轮流使用CPU，但是由于切换的速度很快，我们感觉多个程序是在同时运行的。） 内存管理： 程序运行的时候是从磁盘加载到内存中运行的，程序的运行需要内存，多个程序同时运行时内存怎么利用，各个程序利用的多少，利用的位置，利用完成后的释放等等，需要一个叫内存管理的程序来控制。 文件系统： 文件系统用来整理文件，就是windows的文件目录结构，当然不同系
PX4项目学习::（一）项目架构：：软件简明架构
one__leaf的博客
02-01 947
飞行控制栈是自主无人机的制导、导航和控制算法的集合。它包括固定翼、多旋翼和垂直起降机身的控制器以及姿态和位置估算。中间件主要由嵌入式传感设备驱动，控制驱动，以及消息通信接口组成。除此之外，还引入了模拟层做各种模型模拟及仿真。
PX4模块设计之二十二：FlightModeManager模块
lida2003的专栏
08-13 1087
FlightModeManager主要就是控制飞行模式的。startstop。
【PX4学习笔记】01.PX4硬件基础
最新发布
(●'◡'●)
02-19 3676
pixhawk接口图以及引脚说明​ “负-正-信”。辅助通道（控制舵机那种）与主通道。V4版本的硬件不再有正负​ 🚶PX4FMU主处理器和PX4IO从处理器。Bootloader加载主从处理器IMPORTANT]1.PX4FMU主处理器，主要用于数据获取、计算、控制等核心代码2.PX4IO从处理器，主要用于输出带电机、电调、接收机、SBUS等NOTE]1.Bootloader主要用于连接IMU等硬件以及初始化PX4、APM固件。
PX4-入门基础篇
kjb655的博客
09-14 3777
PX4基础部分详解
PX4项目学习::（五）项目启动流程（从上电开始）
one__leaf的博客
02-01 2070
启动脚本是一个神奇的东西，它能够识别出你对应的飞机类型，加载对应的混控器，选择对应的姿态、位置估计程序以及控制程序，初始化你需要的驱动程序。下面来分析下。
prometheus_px4安装
07-28
要安装prometheus_px4，您需要按照以下步骤进行操作： 1. 首先，将示例中的{your_prometheus_px4_path}替换为prometheus_px4的安装路径。在终端中执行以下命令： ``` cd {your_prometheus_px4_path}/prometheus_px4 ``` 2. 接下来，执行以下命令以更新子模块和安装必要的依赖项： ``` git submodule update --init --recursive pip3 install --user toml empy jinja2 packaging ``` 3. 然后，编译prometheus_px4。执行以下命令： ``` make amovlab_sitl_default gazebo_p450 ``` 请注意，这些步骤假设您已经在Ubuntu 18.04上安装了ROS，并且已经解决了与OpenCV版本相关的任何问题。如果您遇到任何问题，请根据您的具体情况进行调整和解决。 #### 引用[.reference_title] - *1* *2* *3* [ubuntu18.04安装阿木实验室prometheus](https://blog.csdn.net/m0_46541304/article/details/129461905)[target="_blank" data-report-click={"spm":"1018.2226.3001.9630","extra":{"utm_source":"vip_chatgpt_common_search_pc_result","utm_medium":"distribute.pc_search_result.none-task-cask-2~all~insert_cask~default-1-null.142^v91^control_2,239^v3^insert_chatgpt"}} ] [.reference_item] [ .reference_list ]
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

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

抵扣说明：

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

余额充值