8月9日，我决定把这篇文章置顶了，我i现在回看这篇文章和最开始看又不一样了。现在是我对MAVROS有了一定了解之后
告诉了我MAVROS wiki是MAVROS最好的地方。
而且告诉你MAVROS订阅和发布的消息类型都规定好了。
===========================
这个我觉得讲得很详细，如何通过mavros去控制pixhawk mavros就是mavlink的一个封装 用mavros使无人机进入offboard模式，不是在地面站去设置的，这个我看了这篇文章才明白。
其实发现操控Pixahwk似乎并不难，应该又很多开发者已经开发了这方面的功能，这可能是acfly抵不上的，怪不得他们选Pixhawk来做无人机SLAM，有很多现成的东西可以用，比如mavros已经封装好了mavlink。
怪不得，阿木，智能无人机，GAAS，都是用的pixhawk来做SLAM，而不是用一些个人开发的飞控。pixhawk也应该有全球开发者的支持。
我发觉这些是大家的常规操作，可能基本是弄无人机+SLAM的基本方案，哪有双目保密可言呢，大家基本都是这样弄的，都是Pixhawk 都是offboard 都是mavros 都是TX2 是痛无人机+SLAM的基础常规操作，就像你弄无人机驾驶用ROS一样。只可惜你不知道，也没人带你，所以只能买课了。
现在再让我用T265去做我觉得可能思路也会清晰许多，至少mavros控制pxihawk这块我觉得是有点把握的。T265本身之前也知道怎么获取位置信息了。
这里面说到的Macros和piahawk连接的方法感觉和智能无人机课程里说到的一样。
这是智能无人机课程的。，它的第二个地址是地面站的，是用来让mavros和地面站通信的。
这是这篇文章的
https://blog.csdn.net/zhengyuxin0507/article/details/80357405
zheng_zju 2018-05-17 22:53:30 9173 收藏 37
最后发布:2018-05-17 22:53:30首发:2018-05-17 22:53:30
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/zhengyuxin0507/article/details/80357405
版权
一直拖了这么久没有更新，怪我太懒啦~~~ 今天要特别感谢舒仔仔同学，我的好队友帮我写了这篇博文。这篇文章主要讲了如何通过mavros来控制pixhawk。硬件逻辑是这样子，我们先搞一个odroid（土豪上TX2），再用usb线将odroid与pixhawk连接。所以，odroid发送控制指令来控制pixhawk飞行。pixhawk与外界的通信协议是mavlink。ROS下面有个包叫mavros，说到底就是mavlink的封装，用起来非常简单。话不多说，上正文。
mavros安装：
使用apt-get安装即可：
sudo apt-get install ros-kinetic-mavros ros-kinetic-mavros-extras ros‐kinetic‐control‐toolbox
我所安装的ros版本是kinetic。
其安装过程非常简单，在网上查询使用方法却说得很笼统，大多是按照官方教程，但实际上并没有详细的讲如何使用。
1. 官方例程：
参考：https://dev.px4.io/zh/ros/mavros_offboard.html
在ROS包中创建offb_node.cpp文件（具体怎么建立ROS包，可参考ROS的Wiki教程，写得很详细），并粘贴下面内容：
/**
* @file offb_node.cpp
* @brief offboard example node, written with mavros version 0.14.2, px4 flight
* stack and tested in Gazebo SITL
*/
#include <ros/ros.h>
#include <geometry_msgs/PoseStamped.h>
#include <mavros_msgs/CommandBool.h>
#include <mavros_msgs/SetMode.h>
#include <mavros_msgs/State.h>
mavros_msgs::State current_state;
void state_cb(const mavros_msgs::State::ConstPtr& msg){
current_state = *msg;
}
int main(int argc, char **argv)
{
ros::init(argc, argv, "offb_node");
ros::NodeHandle nh;
ros::Subscriber state_sub = nh.subscribe<mavros_msgs::State>
("mavros/state", 10, state_cb);
ros::Publisher local_pos_pub = nh.advertise<geometry_msgs::PoseStamped>
("mavros/setpoint_position/local", 10);
ros::ServiceClient arming_client = nh.serviceClient<mavros_msgs::CommandBool>
("mavros/cmd/arming");
ros::ServiceClient set_mode_client = nh.serviceClient<mavros_msgs::SetMode>
("mavros/set_mode");
//the setpoint publishing rate MUST be faster than 2Hz
ros::Rate rate(20.0);
// wait for FCU connection
while(ros::ok() && current_state.connected){
ros::spinOnce();
rate.sleep();
}
geometry_msgs::PoseStamped pose;
pose.pose.position.x = 0;
pose.pose.position.y = 0;
pose.pose.position.z = 2;
//send a few setpoints before starting
for(int i = 100; ros::ok() && i > 0; --i){
local_pos_pub.publish(pose);
ros::spinOnce();
rate.sleep();
}
mavros_msgs::SetMode offb_set_mode;
offb_set_mode.request.custom_mode = "OFFBOARD";
mavros_msgs::CommandBool arm_cmd;
arm_cmd.request.value = true;
ros::Time last_request = ros::Time::now();
while(ros::ok()){
if( current_state.mode != "OFFBOARD" &&
(ros::Time::now() - last_request > ros::Duration(5.0))){
if( set_mode_client.call(offb_set_mode) &&
offb_set_mode.response.mode_sent){
ROS_INFO("Offboard enabled");
}
last_request = ros::Time::now();
} else {
if( !current_state.armed &&
(ros::Time::now() - last_request > ros::Duration(5.0))){
if( arming_client.call(arm_cmd) &&
arm_cmd.response.success){
ROS_INFO("Vehicle armed");
}
last_request = ros::Time::now();
}
}
local_pos_pub.publish(pose);
ros::spinOnce();
rate.sleep();
}
return 0;
}
该程序的主要功能是：使无人机缓慢飞到2米的高度。
这是一段复制上去就可以直接用的程序，但想要理解深刻，需要对ROS有一定的了解，在了解后，才能看懂下面的内容。下面将对代码的每一部分进行分析，使其能够实现自己想要实现的功能。
需要注意的是：对于用于发送接收的mavros的结构体变量的使用，最好还是查看mavros包中的变量定义，这有助于灵活的对代码进行调整。
2. 消息的订阅和发布
首先讲述一下以上程序所实现的功能。首先使飞机进入offboard模式，再进行解锁，最后发布指令使飞机飞到2米的高度。这一系列功能的实现就用到了ROS强大的发布订阅机制。
可以参照这两个网页：
http://wiki.ros.org/mavros
https://404warehouse.net/2015/12/20/autopilot-offboard-control-using-mavros-package-on-ros/
这两个网站上都详细说明了mavros可发布和订阅的消息以及变量类型，举例说明：
2.1 消息订阅（注意：所订阅的消息需要有回调函数去接收它）：
可以看到截图中清楚地写明了订阅消息所需要地信息，那为什么这里是发布呢？这是因为这是站在mavros的角度看的呀~
//回调函数
mavros_msgs::State current_state;
void state_cb(const mavros_msgs::State::ConstPtr& msg){
current_state = *msg;
}
//消息订阅
ros::Subscriber state_sub = nh.subscribe <mavros_msgs::State> ("mavros/state", 10, state_cb); 2.2 消息发布：
ros::Publisher local_pos_pub = nh.advertise<geometry_msgs::PoseStamped>
("mavros/setpoint_position/local", 10);
geometry_msgs::PoseStamped pose;
pose.pose.position.x = 0;
pose.pose.position.y = 0;
pose.pose.position.z = 2;
//消息发布
local_pos_pub.publish(pose);
同理，在下面截图中也有非常清楚的说明：
上面的代码意思是将坐标从初始点飞到2米的高度，同时该结构体中还有另外4个给定姿态的量，就是四元数，x，y，z，w。从下面这张图可以看出：
使用方法嘛~~~
pose.pose.quaternion.x = 0;
pose.pose.quaternion.y = 0;
pose.pose.quaternion.z = 0;
pose.pose.quaternion.w = 0;想好你的姿态，换算成四元数复制进去就好啦~
所以！mavros的维基是入手mavros控制的最好的教程，不然看其它的都没有用，当然首先还是要掌握ROS的发布订阅机制才行。
发布消息的时候有一点需要注意：
local_pos_pub.publish(pose);都看得出来，这一句是发布消息的。那是不是有人问，怎么一段代码里发布了这么多遍？
这在上面的链接里也写得很清楚，我们所使用的pixhawk需要以至少2Hz的频率接收消息，否则将会从offboard模式切回RTL模式。
开始的一段，是为了告诉pixhawk有消息要传过来啦~
中间在切换状态和arm的时候，是为了保持其pixhawk接收寄存器里有值，通俗点嘛，就是既然我要用offboard模式了，你总得先告诉我要怎么搞吧，不然刚切过去那会怎么办呢？随意嘛？哈哈~
那当其正常运行的时候，当然要通过发布消息来尽情的控制你的小飞机啦~
3 怎么和pixhawk连接？
Emm，很简单，直接用USB就可以哈哈~
新打开一个终端，运行：
roslaunch mavros px4.launch fcu_url:=/dev/ttyACM0;再把上面offboard的节点运行起来就可以啦~
当然，要想搞实物，需要先仿真，下面一节我们就来讲讲仿真怎么搞~
参考文献：
1. http://wiki.ros.org/mavros
2. https://404warehouse.net/2015/12/20/autopilot-offboard-control-using-mavros-package-on-ros/