玩转四旋翼无人机（DJI ROS SDK开发包及使用方法)

本文主要介绍Onboard-SDK-ROS的代码设计思想和使用方法，该软件包主要用来完成M100的开发等。
该软件包的主要有3个部分
1. 核心的API部分dji-sdk-lib，用于串口通信，建立各种任务的线程，读取信息的线程。
2. 用于封装核心API为ROS接口的dji_sdk
3. 简单的demo，给出了dji_sdk的使用方法。

Onboard-SDK，顾名思义，这个包是用来给机载的系统用的。飞机记载的系统（如manifold,tk1 etc）中运行了的dji_sdk_node，该节点就是要把DJI飞机的状态信息和飞机的控制导航等功能封装。为什么要封装之后会介绍，所有的控制和信息都是从一个串口读写的，封装的过程我们定义了一些类，类的定义在文件dji_sdk_node.h中。这些类是不需要用来创建实例化的，我们不要调用或者使用这些累的成员和成员函数。因为我们在类的内部把这些变量转化为message和service，使用ros的message和service等机制将这些状态和服务发布出去，因此定义为了私有变量。另外如果我们想要完成飞机的控制、导航和查看飞机的状态等等，可以构造另一个ros节点，订阅相应的topic，service等，这样该节点既可以运行在飞机机载的处理器上，也可以在地面站的PC上，这样每个节点对应一个进程，他们是分离的。这就使用ros封装的便利性。我们自己构造的这个ros节点可以包含dji-drone.h文件，因为该文件已经订阅了了飞机的各种功能服务和状态变量，这样我们又看到了刚才被定义为私有化的那些变量以及那些导航控制的功能函数，因此这些变量现在定义为了public，上层的应用程序还要使用他们。所以ROS的message和service机制可以看做一个编码器和解码器把相应的功能编码并传输至另外一个线程，这样我们能够很方便的使用多进程，部署多个多机器等等。这里给一张大疆的说明文档中的图帮助大家理解。链接在这里

设计模式

所有的控制和信息都是从一个串口读写的，因此在解析串口的API的里边上边做了一个Adapter，将原来的cpp的接口转换为ROS的订阅广播机制。
因此构造了三种ROS 通信机制分别是messages, services, actionlib. 第一种用来广播飞机的状态数据，第二种用来对飞机完成任务的控制。第三种同样是任务控制，但是增加了任务的监控。

dji_sdk

构造了一个节点，名字叫这个DJISDKNode，成员变量有飞机的状态信息，如位姿，加速度，速度等；信息发布者，上述飞机的状态信息通过ros的广播发布出去。服务提供者；飞机的位置姿态控制服务，速度控制服务。action提供者，功能同服务提供这类似，增加了反馈和监控。
我们首先来看该节点的构造函数

init_publishers(nh);
init_services(nh);
init_actions(nh);

首先是初始化发布者，服务提供者和action提供者。发布者主要是初始化需要广播的内容飞机的状态如激活状态，位姿，速度，磁罗盘，GPS数据等。服务提供者主要是初始化一些serviceServer
代码如下

activation_service = nh.advertiseService("dji_sdk/activation", &DJISDKNode::activation_callback, this);
attitude_control_service = nh.advertiseService("dji_sdk/attitude_control", &DJISDKNode::attitude_control_callback, this);
camera_action_control_service = nh.advertiseService("dji_sdk/camera_action_control",&DJISDKNode::camera_action_control_callback, this);
drone_task_control_service = nh.advertiseService("dji_sdk/drone_task_control", &DJISDKNode::drone_task_control_callback, this);
gimbal_angle_control_service = nh.advertiseService("dji_sdk/gimbal_angle_control", &DJISDKNode::gimbal_angle_control_callback, this);
gimbal_speed_control_service = nh.advertiseService("dji_sdk/gimbal_speed_control", &DJISDKNode::gimbal_speed_control_callback, this);
global_position_control_service = nh.advertiseService("dji_sdk/global_position_control", &DJISDKNode::global_position_control_callback, this);
local_position_control_service = nh.advertiseService("dji_sdk/local_position_control", &DJISDKNode::local_position_control_callback,