Food/FoodDelivery
3
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity

【类 型】：feat

Browse Source 
【原  因】：飞控mavlink发送 ADSB数据
【过  程】：
【影  响】：

# 类型 包含:
# feat：新功能（feature）
# fix：修补bug
# docs：文档（documentation）
# style： 格式（不影响代码运行的变动）
# refactor：重构（即不是新增功能，也不是修改bug的代码变动）
# test：增加测试
# chore：构建过程或辅助工具的变动
This commit is contained in:
air 2025-06-19 22:18:07 +08:00
parent 43dfbc91b2
commit 212a9e5da1
2 changed files with 308 additions and 247 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

2
FoodDelivery.ino
View File

@ -5,7 +5,7 @@
//char* password = "63587839ab"; //wifi密码 //char* password = "63587839ab"; //wifi密码
char* ssid = "flicube"; //wifi帐号 char* ssid = "flicube"; //wifi帐号
char* password = "fxmf0622"; //wifi密码 char* password = "fxmf0622"; //wifi密码
char* mqttServer = "szdot.top"; //mqtt地址 char* mqttServer = "wxsky.com"; //mqtt地址
int mqttPort = 1883; //mqtt端口 int mqttPort = 1883; //mqtt端口
char* mqttName = "admin"; //mqtt帐号 char* mqttName = "admin"; //mqtt帐号
char* mqttPassword = "123456"; //mqtt密码 char* mqttPassword = "123456"; //mqtt密码

189
FoodDeliveryBase.cpp
View File

@ -3,7 +3,8 @@
/** /**
* @description: 初始化 * @description: 初始化
*/ */
FoodCube::FoodCube(char* userSsid, char* userPassword, char* userMqttServer, int userMqttPort, char* userMqttName, char* userMqttPassword, uint8_t userMavlinkSerial, uint8_t userVoiceSerial, char* userUdpServerIP, uint32_t userUdpServerPort) { FoodCube::FoodCube(char *userSsid, char *userPassword, char *userMqttServer, int userMqttPort, char *userMqttName, char *userMqttPassword, uint8_t userMavlinkSerial, uint8_t userVoiceSerial, char *userUdpServerIP, uint32_t userUdpServerPort)
{
/*初始化*/ /*初始化*/
ssid = userSsid; // wifi帐号 ssid = userSsid; // wifi帐号
password = userPassword; // wifi密码 password = userPassword; // wifi密码
@ -17,7 +18,8 @@ FoodCube::FoodCube(char* userSsid, char* userPassword, char* userMqttServer, int
udpServerPort = userUdpServerPort; // 云台相机端口 udpServerPort = userUdpServerPort; // 云台相机端口
// 初始化飞控通讯串口 波特率 // 初始化飞控通讯串口 波特率
switch (mavlinkSerial) { //初始化指定 串口号 switch (mavlinkSerial)
{ // 初始化指定 串口号
case 0: case 0:
Serial.begin(57600); Serial.begin(57600);
break; break;
@ -29,7 +31,8 @@ FoodCube::FoodCube(char* userSsid, char* userPassword, char* userMqttServer, int
break; break;
} }
// 初始化声音模块串口 波特率 // 初始化声音模块串口 波特率
switch (voiceSerial) { //初始化指定 串口号 switch (voiceSerial)
{ // 初始化指定 串口号
case 0: case 0:
Serial.begin(115200); Serial.begin(115200);
break; break;
@ -47,59 +50,74 @@ FoodCube::FoodCube(char* userSsid, char* userPassword, char* userMqttServer, int
* @description: 日志打印 * @description: 日志打印
* @param {*} val 输出的信息 * @param {*} val 输出的信息
*/ */
void FoodCube::log(String val) { void FoodCube::log(String val)
{
Serial.print(val); Serial.print(val);
} }
void FoodCube::log(char* val) { void FoodCube::log(char *val)
{
Serial.print(val); Serial.print(val);
} }
void FoodCube::log(int val) { void FoodCube::log(int val)
{
Serial.print(val); Serial.print(val);
} }
void FoodCube::log(IPAddress val) { void FoodCube::log(IPAddress val)
{
Serial.print(val); Serial.print(val);
} }
void FoodCube::log(bool val) { void FoodCube::log(bool val)
{
Serial.print(val); Serial.print(val);
} }
void FoodCube::logln(String val) { void FoodCube::logln(String val)
{
Serial.println(val); Serial.println(val);
} }
void FoodCube::logln(char* val) { void FoodCube::logln(char *val)
{
Serial.println(val); Serial.println(val);
} }
void FoodCube::logln(int val) { void FoodCube::logln(int val)
{
Serial.println(val); Serial.println(val);
} }
void FoodCube::logln(IPAddress val) { void FoodCube::logln(IPAddress val)
{
Serial.println(val); Serial.println(val);
} }
void FoodCube::logln(bool val) { void FoodCube::logln(bool val)
{
Serial.print(val); Serial.print(val);
} }
/** /**
*@description: 取值 设置值 *@description: 取值 设置值
*/ */
bool FoodCube::getIsInit() { bool FoodCube::getIsInit()
{
return isInit; return isInit;
} }
void FoodCube::setIsInit(bool b) { void FoodCube::setIsInit(bool b)
{
isInit = b; isInit = b;
} }
String FoodCube::getMacAdd() { String FoodCube::getMacAdd()
{
return macAdd; return macAdd;
} }
/** /**
* @description: 连接wifi * @description: 连接wifi
*/ */
void FoodCube::connectWifi() { void FoodCube::connectWifi()
{
// 设置wifi帐号密码 // 设置wifi帐号密码
WiFi.begin(ssid, password); WiFi.begin(ssid, password);
// 连接wifi // 连接wifi
logln("Connecting Wifi..."); logln("Connecting Wifi...");
while (WiFi.status() != WL_CONNECTED) { while (WiFi.status() != WL_CONNECTED)
{
log("."); log(".");
delay(150); delay(150);
} }
@ -123,9 +141,11 @@ void FoodCube::connectWifi() {
* @description: 连接mqtt * @description: 连接mqtt
* @param {String} topicSub 订阅主题 * @param {String} topicSub 订阅主题
*/ */
void FoodCube::connectMqtt(String topicSub) { void FoodCube::connectMqtt(String topicSub)
{
/*尝试连接mqtt*/ /*尝试连接mqtt*/
if (mqttClient->connect(macAdd.c_str(), mqttName, mqttPassword)) { if (mqttClient->connect(macAdd.c_str(), mqttName, mqttPassword))
{
logln("MQTT Server Connected."); logln("MQTT Server Connected.");
log("Server Address: "); log("Server Address: ");
logln(mqttServer); logln(mqttServer);
@ -135,7 +155,9 @@ void FoodCube::connectMqtt(String topicSub) {
// 订阅主题 PS:连接上mqtt服务器 订阅主题 收到信息触发回调函数 receiveCallback // 订阅主题 PS:连接上mqtt服务器 订阅主题 收到信息触发回调函数 receiveCallback
subscribeTopic(topicSub, 1); subscribeTopic(topicSub, 1);
playText("服务器,已连接"); playText("服务器,已连接");
} else { }
else
{
// 失败返回状态码 // 失败返回状态码
log("MQTT Server Connect Failed. Client State:"); log("MQTT Server Connect Failed. Client State:");
logln(mqttClient->state()); logln(mqttClient->state());
@ -147,10 +169,14 @@ void FoodCube::connectMqtt(String topicSub) {
* @description: 写在loop函数里 检测mqtt连接情况 并保持心跳 * @description: 写在loop函数里 检测mqtt连接情况 并保持心跳
* @param {String} topicSub 订阅主题 * @param {String} topicSub 订阅主题
*/ */
void FoodCube::mqttLoop(String topicSub) { void FoodCube::mqttLoop(String topicSub)
if (mqttClient->connected()) { //检测 如果开发板成功连接服务器 {
if (mqttClient->connected())
{ // 检测 如果开发板成功连接服务器
mqttClient->loop(); // 保持心跳 mqttClient->loop(); // 保持心跳
} else { // 如果开发板未能成功连接服务器 }
else
{ // 如果开发板未能成功连接服务器
connectMqtt(topicSub); // 则尝试连接服务器 connectMqtt(topicSub); // 则尝试连接服务器
} }
} }
@ -160,7 +186,8 @@ void FoodCube::mqttLoop(String topicSub) {
* @param {String} topicString 主题名称 * @param {String} topicString 主题名称
* @param {int} Qos 1：重要 ps:响应时间快 * @param {int} Qos 1：重要 ps:响应时间快
*/ */
void FoodCube::subscribeTopic(String topicString, int Qos = 1) { void FoodCube::subscribeTopic(String topicString, int Qos = 1)
{
// 处理主题字符串 // 处理主题字符串
topicString = topicString + "/" + macAdd; topicString = topicString + "/" + macAdd;
char subTopic[topicString.length() + 1]; char subTopic[topicString.length() + 1];
@ -174,7 +201,8 @@ void FoodCube::subscribeTopic(String topicString, int Qos = 1) {
* @param {String} topicString 主题名称 * @param {String} topicString 主题名称
* @param {String} messageString 发布的内容 * @param {String} messageString 发布的内容
*/ */
void FoodCube::pubMQTTmsg(String topicString, String messageString) { void FoodCube::pubMQTTmsg(String topicString, String messageString)
{
// 处理主题字符串 // 处理主题字符串
topicString = topicString + "/" + macAdd; topicString = topicString + "/" + macAdd;
char publishTopic[topicString.length() + 1]; char publishTopic[topicString.length() + 1];
@ -192,9 +220,11 @@ void FoodCube::pubMQTTmsg(String topicString, String messageString) {
* @param {int} len 命令帧 的长度 * @param {int} len 命令帧 的长度
* @param {uint8_t} swSerial 串口选择 * @param {uint8_t} swSerial 串口选择
*/ */
void FoodCube::SWrite(uint8_t buf[], int len, uint8_t swSerial) { void FoodCube::SWrite(uint8_t buf[], int len, uint8_t swSerial)
{
// 通过串口发送 // 通过串口发送
switch (swSerial) { //初始化指定 串口号 switch (swSerial)
{ // 初始化指定 串口号
case 0: case 0:
Serial.write(buf, len); Serial.write(buf, len);
break; break;
@ -207,12 +237,12 @@ void FoodCube::SWrite(uint8_t buf[], int len, uint8_t swSerial) {
} }
} }
/** /**
* @description: 声音播放 * @description: 声音播放
* @param {String} str 播放内容 * @param {String} str 播放内容
*/ */
void FoodCube::playText(String str) { void FoodCube::playText(String str)
{
/*消息长度*/ /*消息长度*/
int len = str.length(); // 修改信息长度 消息长度 int len = str.length(); // 修改信息长度 消息长度
// if (len >= 3996) { //限制信息长度 超长的不播放 // if (len >= 3996) { //限制信息长度 超长的不播放
@ -232,10 +262,12 @@ void FoodCube::playText(String str) {
command[index++] = 0x01; command[index++] = 0x01;
command[index++] = 0x04; command[index++] = 0x04;
/*帧命令 消息段*/ /*帧命令 消息段*/
for (int i = 0; i < str.length(); i++) { for (int i = 0; i < str.length(); i++)
{
command[index++] = (int)str[i]; command[index++] = (int)str[i];
} }
for (int i = 0; i < sizeof(command); i++) { for (int i = 0; i < sizeof(command); i++)
{
log(command[i]); log(command[i]);
log(" "); log(" ");
} }
@ -248,28 +280,33 @@ void FoodCube::playText(String str) {
* @description: 检查声音模块是否空闲 * @description: 检查声音模块是否空闲
* @return {uint8_t} 0x4E 78:系统忙 0x4F 79:系统空闲 * @return {uint8_t} 0x4E 78:系统忙 0x4F 79:系统空闲
*/ */
uint8_t FoodCube::chekVoiceMcu() { uint8_t FoodCube::chekVoiceMcu()
{
uint8_t serialData; uint8_t serialData;
uint8_t check[] = {0xFD, 0x00, 0x01, 0x21}; // 检查命令帧 uint8_t check[] = {0xFD, 0x00, 0x01, 0x21}; // 检查命令帧
SWrite(check, sizeof(check), voiceSerial); // 发送检查指令 SWrite(check, sizeof(check), voiceSerial); // 发送检查指令
switch (voiceSerial) { switch (voiceSerial)
{
case 0: case 0:
{ {
while (Serial.available()) { // 当串口接收到信息后 while (Serial.available())
{ // 当串口接收到信息后
serialData = Serial.read(); // 将接收到的信息使用read读取 serialData = Serial.read(); // 将接收到的信息使用read读取
} }
} }
break; break;
case 1: case 1:
{ {
while (Serial1.available()) { // 当串口接收到信息后 while (Serial1.available())
{ // 当串口接收到信息后
serialData = Serial1.read(); // 将接收到的信息使用read读取 serialData = Serial1.read(); // 将接收到的信息使用read读取
} }
} }
break; break;
case 2: case 2:
{ {
while (Serial2.available()) { // 当串口接收到信息后 while (Serial2.available())
{ // 当串口接收到信息后
serialData = Serial2.read(); // 将接收到的信息使用read读取 serialData = Serial2.read(); // 将接收到的信息使用read读取
} }
} }
@ -282,7 +319,8 @@ uint8_t FoodCube::chekVoiceMcu() {
/** /**
* @description: 声音模块停止合成 * @description: 声音模块停止合成
*/ */
void FoodCube::stopVoice() { void FoodCube::stopVoice()
{
uint8_t stop[] = {0xFD, 0x00, 0x01, 0x22}; // 停止合成命令帧 uint8_t stop[] = {0xFD, 0x00, 0x01, 0x22}; // 停止合成命令帧
SWrite(stop, sizeof(stop), voiceSerial); // 发送检查指令 SWrite(stop, sizeof(stop), voiceSerial); // 发送检查指令
} }
@ -292,11 +330,13 @@ void FoodCube::stopVoice() {
* @param {uint8_t[]} 命令帧 数组 * @param {uint8_t[]} 命令帧 数组
* @param {int} len 命令帧 的长度 * @param {int} len 命令帧 的长度
*/ */
uint16_t FoodCube::CRC16_cal(uint8_t* ptr, uint32_t len, uint16_t crc_init) { uint16_t FoodCube::CRC16_cal(uint8_t *ptr, uint32_t len, uint16_t crc_init)
{
uint16_t crc, oldcrc16; uint16_t crc, oldcrc16;
uint8_t temp; uint8_t temp;
crc = crc_init; crc = crc_init;
while (len-- != 0) { while (len-- != 0)
{
temp = (crc >> 8) & 0xff; temp = (crc >> 8) & 0xff;
oldcrc16 = crc16_tab[*ptr ^ temp]; oldcrc16 = crc16_tab[*ptr ^ temp];
crc = (crc << 8) ^ oldcrc16; crc = (crc << 8) ^ oldcrc16;
@ -305,7 +345,8 @@ uint16_t FoodCube::CRC16_cal(uint8_t* ptr, uint32_t len, uint16_t crc_init) {
return (crc); return (crc);
} }
void FoodCube::crc_check_16bites(uint8_t* pbuf, uint32_t len, uint16_t* p_result) { void FoodCube::crc_check_16bites(uint8_t *pbuf, uint32_t len, uint16_t *p_result)
{
uint16_t crc_result = 0; uint16_t crc_result = 0;
crc_result = CRC16_cal(pbuf, len, 0); crc_result = CRC16_cal(pbuf, len, 0);
*p_result = crc_result; *p_result = crc_result;
@ -315,14 +356,16 @@ void FoodCube::crc_check_16bites(uint8_t* pbuf, uint32_t len, uint16_t* p_result
* @param {uint8_t[]} 命令帧 数组 * @param {uint8_t[]} 命令帧 数组
* @param {int} len 命令帧 的长度 * @param {int} len 命令帧 的长度
*/ */
void FoodCube::udpSendToCamera(uint8_t* p_command, uint32_t len) { void FoodCube::udpSendToCamera(uint8_t *p_command, uint32_t len)
{
uint16_t result = 0; uint16_t result = 0;
uint16_t *p_result = &result; uint16_t *p_result = &result;
// 计算校检码 // 计算校检码
crc_check_16bites(p_command, len, p_result); crc_check_16bites(p_command, len, p_result);
// 加上校检码 // 加上校检码
uint8_t bytes[2 + len]; uint8_t bytes[2 + len];
for (int i = 0; i < len; i++) { for (int i = 0; i < len; i++)
{
bytes[i] = p_command[i]; bytes[i] = p_command[i];
} }
bytes[len] = static_cast<uint8_t>(result); // 低位 互换 bytes[len] = static_cast<uint8_t>(result); // 低位 互换
@ -339,24 +382,27 @@ void FoodCube::udpSendToCamera(uint8_t* p_command, uint32_t len) {
* @param {uint8_t} n 第几位 从0开始 * @param {uint8_t} n 第几位 从0开始
* @param {uint8_t} isOne 1:设置成1 0:设置成0 * @param {uint8_t} isOne 1:设置成1 0:设置成0
*/ */
String FoodCube::setNBit(String str, uint8_t n, uint8_t i) { String FoodCube::setNBit(String str, uint8_t n, uint8_t i)
{
char buf[10]; char buf[10];
uint16_t val = (uint8_t)str.toInt(); uint16_t val = (uint8_t)str.toInt();
if (i) { if (i)
{
val |= (1u << n); // 按位设置成1 val |= (1u << n); // 按位设置成1
} else { }
else
{
val &= ~(1u << n); // 按位设置成0 val &= ~(1u << n); // 按位设置成0
} }
sprintf(buf, "%d", val); sprintf(buf, "%d", val);
return buf; return buf;
} }
/** /**
* @description: 向飞控请求 指定数据 * @description: 向飞控请求 指定数据
*/ */
void FoodCube::mav_request_data() { void FoodCube::mav_request_data()
{
mavlink_message_t msg; mavlink_message_t msg;
uint8_t buf[MAVLINK_MAX_PACKET_LEN]; uint8_t buf[MAVLINK_MAX_PACKET_LEN];
// 以下注释 把数据流组合到一起 // 以下注释 把数据流组合到一起
@ -376,7 +422,8 @@ void FoodCube::mav_request_data() {
const int maxStreams = 1; // 遍历次数 （下面组合的长度） const int maxStreams = 1; // 遍历次数 （下面组合的长度）
const uint8_t MAVStreams[maxStreams] = {MAV_DATA_STREAM_ALL}; // 请求的数据流组合 放到一个对象 后面进行遍历 const uint8_t MAVStreams[maxStreams] = {MAV_DATA_STREAM_ALL}; // 请求的数据流组合 放到一个对象 后面进行遍历
const uint16_t MAVRates[maxStreams] = {0x01}; // 设定发送频率 分别对应上面数据流 ps:0X01 1赫兹 既每秒发送一次 const uint16_t MAVRates[maxStreams] = {0x01}; // 设定发送频率 分别对应上面数据流 ps:0X01 1赫兹 既每秒发送一次
for (int i = 0; i < maxStreams; i++) { for (int i = 0; i < maxStreams; i++)
{
// 向飞控发送请求 // 向飞控发送请求
mavlink_msg_request_data_stream_pack(2, 200, &msg, 1, 0, MAVStreams[i], MAVRates[i], 1); mavlink_msg_request_data_stream_pack(2, 200, &msg, 1, 0, MAVStreams[i], MAVRates[i], 1);
int len = mavlink_msg_to_send_buffer(buf, &msg); int len = mavlink_msg_to_send_buffer(buf, &msg);
@ -388,22 +435,27 @@ void FoodCube::mav_request_data() {
* @description: 解析mavlink数据流 * @description: 解析mavlink数据流
* @param {pFun} pFun 拿到缓存数据之后 解析数据执行回调 * @param {pFun} pFun 拿到缓存数据之后 解析数据执行回调
*/ */
void FoodCube::comm_receive(void (*pFun)(uint8_t)) { void FoodCube::comm_receive(void (*pFun)(uint8_t))
switch (mavlinkSerial) { {
switch (mavlinkSerial)
{
case 0: case 0:
while (Serial.available() > 0) { // 判断串口缓存 是否有数据 while (Serial.available() > 0)
{ // 判断串口缓存 是否有数据
uint8_t c = Serial.read(); // 从缓存拿到数据 uint8_t c = Serial.read(); // 从缓存拿到数据
pFun(c); pFun(c);
} }
break; break;
case 1: case 1:
while (Serial1.available() > 0) { // 判断串口缓存 是否有数据 while (Serial1.available() > 0)
{ // 判断串口缓存 是否有数据
uint8_t c = Serial1.read(); // 从缓存拿到数据 uint8_t c = Serial1.read(); // 从缓存拿到数据
pFun(c); pFun(c);
} }
break; break;
case 2: case 2:
while (Serial2.available() > 0) { // 判断串口缓存 是否有数据 while (Serial2.available() > 0)
{ // 判断串口缓存 是否有数据
uint8_t c = Serial2.read(); // 从缓存拿到数据 uint8_t c = Serial2.read(); // 从缓存拿到数据
pFun(c); pFun(c);
} }
@ -415,7 +467,8 @@ void FoodCube::comm_receive(void (*pFun)(uint8_t)) {
* @description: 写入航点 第一步 “向飞控发送航点数量” * @description: 写入航点 第一步 “向飞控发送航点数量”
* @param {uint8_t} taskcount 航点数量 * @param {uint8_t} taskcount 航点数量
*/ */
void FoodCube::mav_mission_count(uint8_t taskcount) { void FoodCube::mav_mission_count(uint8_t taskcount)
{
mavlink_message_t msg; // mavlink协议信息(msg) mavlink_message_t msg; // mavlink协议信息(msg)
uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存 uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存
// 设置飞行模式的数据包 // 设置飞行模式的数据包
@ -440,7 +493,8 @@ void FoodCube::mav_mission_count(uint8_t taskcount) {
* @param {double} y * @param {double} y
* @param {double} z * @param {double} z
*/ */
void FoodCube::mav_mission_item(int8_t seq, uint8_t frame, uint8_t command, uint8_t current, uint8_t autocontinue, double param1, double param2, double param3, double param4, double x, double y, double z) { void FoodCube::mav_mission_item(int8_t seq, uint8_t frame, uint8_t command, uint8_t current, uint8_t autocontinue, double param1, double param2, double param3, double param4, double x, double y, double z)
{
mavlink_message_t msg; // mavlink协议信息(msg) mavlink_message_t msg; // mavlink协议信息(msg)
uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存 uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存
// 写入航点数据包 // 写入航点数据包
@ -453,7 +507,8 @@ void FoodCube::mav_mission_item(int8_t seq, uint8_t frame, uint8_t command, uint
/** /**
* @description: 向飞控发送 设置模式指令 * @description: 向飞控发送 设置模式指令
*/ */
void FoodCube::mav_set_mode(uint8_t SysState) { void FoodCube::mav_set_mode(uint8_t SysState)
{
mavlink_message_t msg; // mavlink协议信息(msg) mavlink_message_t msg; // mavlink协议信息(msg)
uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存 uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存
// 设置飞行模式的数据包 // 设置飞行模式的数据包
@ -468,7 +523,8 @@ void FoodCube::mav_set_mode(uint8_t SysState) {
* @param {uint8_t} controlType 3:加解锁模式控制 * @param {uint8_t} controlType 3:加解锁模式控制
* @param {uint16_t} param[] * @param {uint16_t} param[]
*/ */
void FoodCube::mav_command(uint8_t controlType, uint16_t param[]) { void FoodCube::mav_command(uint8_t controlType, uint16_t param[])
{
mavlink_message_t msg; // mavlink协议信息(msg) mavlink_message_t msg; // mavlink协议信息(msg)
uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存 uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存
// 设置飞行模式的数据包 // 设置飞行模式的数据包
@ -476,12 +532,14 @@ void FoodCube::mav_command(uint8_t controlType, uint16_t param[]) {
cmd.target_system = 1; cmd.target_system = 1;
cmd.target_component = 1; cmd.target_component = 1;
cmd.confirmation = 0; cmd.confirmation = 0;
if (controlType == 3) { //飞机加解锁 if (controlType == 3)
{ // 飞机加解锁
cmd.command = MAV_CMD_COMPONENT_ARM_DISARM; cmd.command = MAV_CMD_COMPONENT_ARM_DISARM;
cmd.param1 = param[0]; // 0:加锁 1：解锁 cmd.param1 = param[0]; // 0:加锁 1：解锁
cmd.param2 = param[1]; // 0:符合条件加解锁 21196:强制加解锁 cmd.param2 = param[1]; // 0:符合条件加解锁 21196:强制加解锁
} }
if (controlType == 6) { //测试起飞 if (controlType == 6)
{ // 测试起飞
float p = (float)param[0]; float p = (float)param[0];
cmd.command = MAV_CMD_NAV_TAKEOFF; cmd.command = MAV_CMD_NAV_TAKEOFF;
cmd.param1 = 0; cmd.param1 = 0;
@ -492,10 +550,12 @@ void FoodCube::mav_command(uint8_t controlType, uint16_t param[]) {
cmd.param6 = 0; cmd.param6 = 0;
cmd.param7 = p; // 起飞高度 cmd.param7 = p; // 起飞高度
} }
if (controlType == 8) { //降落 if (controlType == 8)
{ // 降落
cmd.command = MAV_CMD_NAV_LAND; cmd.command = MAV_CMD_NAV_LAND;
} }
if (controlType == 11) { //磁罗盘校准 if (controlType == 11)
{ // 磁罗盘校准
cmd.command = MAV_CMD_DO_START_MAG_CAL; cmd.command = MAV_CMD_DO_START_MAG_CAL;
cmd.param1 = 0; cmd.param1 = 0;
cmd.param2 = 1; cmd.param2 = 1;
@ -510,7 +570,8 @@ void FoodCube::mav_command(uint8_t controlType, uint16_t param[]) {
* @description: 油门控制 * @description: 油门控制
* @param {uint16_t} chan[] 四个通道 * @param {uint16_t} chan[] 四个通道
*/ */
void FoodCube::mav_channels_override(uint16_t chan[]) { void FoodCube::mav_channels_override(uint16_t chan[])
{
mavlink_message_t msg; // mavlink协议信息(msg) mavlink_message_t msg; // mavlink协议信息(msg)
uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存 uint8_t buf[MAVLINK_MAX_PACKET_LEN]; // 发送的缓存
// 控制油门 // 控制油门