mirror of
https://github.com/iNavFlight/inav.git
synced 2025-07-18 22:05:15 +03:00
Boilerplate for MAVLink RX
This commit is contained in:
parent
cb2fccb7a0
commit
b51ff817cb
8 changed files with 88 additions and 1 deletions
|
@ -386,6 +386,8 @@ main_sources(COMMON_SRC
|
||||||
rx/ibus.h
|
rx/ibus.h
|
||||||
rx/jetiexbus.c
|
rx/jetiexbus.c
|
||||||
rx/jetiexbus.h
|
rx/jetiexbus.h
|
||||||
|
rx/mavlink.c
|
||||||
|
rx/mavlink.h
|
||||||
rx/msp.c
|
rx/msp.c
|
||||||
rx/msp.h
|
rx/msp.h
|
||||||
rx/msp_override.c
|
rx/msp_override.c
|
||||||
|
|
|
@ -25,7 +25,7 @@ tables:
|
||||||
values: ["NONE", "PPM", "SERIAL", "MSP", "SPI", "UNUSED"]
|
values: ["NONE", "PPM", "SERIAL", "MSP", "SPI", "UNUSED"]
|
||||||
enum: rxReceiverType_e
|
enum: rxReceiverType_e
|
||||||
- name: serial_rx
|
- name: serial_rx
|
||||||
values: ["SPEK1024", "SPEK2048", "SBUS", "SUMD", "SUMH", "XB-B", "XB-B-RJ01", "IBUS", "JETIEXBUS", "CRSF", "FPORT", "SBUS_FAST", "FPORT2", "SRXL2", "GHST"]
|
values: ["SPEK1024", "SPEK2048", "SBUS", "SUMD", "SUMH", "XB-B", "XB-B-RJ01", "IBUS", "JETIEXBUS", "CRSF", "FPORT", "SBUS_FAST", "FPORT2", "SRXL2", "GHST", "MAVLINK"]
|
||||||
- name: rx_spi_protocol
|
- name: rx_spi_protocol
|
||||||
values: ["ELERES"]
|
values: ["ELERES"]
|
||||||
enum: rx_spi_protocol_e
|
enum: rx_spi_protocol_e
|
||||||
|
|
51
src/main/rx/mavlink.c
Normal file
51
src/main/rx/mavlink.c
Normal file
|
@ -0,0 +1,51 @@
|
||||||
|
/*
|
||||||
|
* This file is part of Cleanflight.
|
||||||
|
*
|
||||||
|
* Cleanflight is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* Cleanflight is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
* GNU General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with Cleanflight. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#include <stdbool.h>
|
||||||
|
#include <stdint.h>
|
||||||
|
#include <stdlib.h>
|
||||||
|
#include <string.h>
|
||||||
|
|
||||||
|
#include "platform.h"
|
||||||
|
FILE_COMPILE_FOR_SPEED
|
||||||
|
#ifdef USE_SERIALRX_MAVLINK
|
||||||
|
|
||||||
|
#include "build/build_config.h"
|
||||||
|
#include "build/debug.h"
|
||||||
|
|
||||||
|
#include "common/crc.h"
|
||||||
|
#include "common/maths.h"
|
||||||
|
#include "common/utils.h"
|
||||||
|
|
||||||
|
#include "drivers/time.h"
|
||||||
|
#include "drivers/serial.h"
|
||||||
|
#include "drivers/serial_uart.h"
|
||||||
|
|
||||||
|
#include "io/serial.h"
|
||||||
|
|
||||||
|
#include "rx/rx.h"
|
||||||
|
#include "rx/mavlink.h"
|
||||||
|
|
||||||
|
#define MAVLINK_MAX_CHANNEL 18
|
||||||
|
|
||||||
|
bool mavlinkRxInit(const rxConfig_t *rxConfig, rxRuntimeConfig_t *rxRuntimeConfig)
|
||||||
|
{
|
||||||
|
// TODO
|
||||||
|
return false;
|
||||||
|
}
|
||||||
|
|
||||||
|
#endif
|
20
src/main/rx/mavlink.h
Normal file
20
src/main/rx/mavlink.h
Normal file
|
@ -0,0 +1,20 @@
|
||||||
|
/*
|
||||||
|
* This file is part of Cleanflight.
|
||||||
|
*
|
||||||
|
* Cleanflight is free software: you can redistribute it and/or modify
|
||||||
|
* it under the terms of the GNU General Public License as published by
|
||||||
|
* the Free Software Foundation, either version 3 of the License, or
|
||||||
|
* (at your option) any later version.
|
||||||
|
*
|
||||||
|
* Cleanflight is distributed in the hope that it will be useful,
|
||||||
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||||||
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||||||
|
* GNU General Public License for more details.
|
||||||
|
*
|
||||||
|
* You should have received a copy of the GNU General Public License
|
||||||
|
* along with Cleanflight. If not, see <http://www.gnu.org/licenses/>.
|
||||||
|
*/
|
||||||
|
|
||||||
|
#pragma once
|
||||||
|
|
||||||
|
bool mavlinkRxInit(const struct rxConfig_s *initialRxConfig, struct rxRuntimeConfig_s *rxRuntimeConfig);
|
|
@ -68,6 +68,7 @@
|
||||||
#include "rx/sumh.h"
|
#include "rx/sumh.h"
|
||||||
#include "rx/xbus.h"
|
#include "rx/xbus.h"
|
||||||
#include "rx/ghst.h"
|
#include "rx/ghst.h"
|
||||||
|
#include "rx/mavlink.h"
|
||||||
|
|
||||||
//#define DEBUG_RX_SIGNAL_LOSS
|
//#define DEBUG_RX_SIGNAL_LOSS
|
||||||
|
|
||||||
|
@ -255,6 +256,11 @@ bool serialRxInit(const rxConfig_t *rxConfig, rxRuntimeConfig_t *rxRuntimeConfig
|
||||||
case SERIALRX_GHST:
|
case SERIALRX_GHST:
|
||||||
enabled = ghstRxInit(rxConfig, rxRuntimeConfig);
|
enabled = ghstRxInit(rxConfig, rxRuntimeConfig);
|
||||||
break;
|
break;
|
||||||
|
#endif
|
||||||
|
#ifdef USE_SERIALRX_MAVLINK
|
||||||
|
case SERIALRX_MAVLINK:
|
||||||
|
enabled = mavlinkRxInit(rxConfig, rxRuntimeConfig);
|
||||||
|
break;
|
||||||
#endif
|
#endif
|
||||||
default:
|
default:
|
||||||
enabled = false;
|
enabled = false;
|
||||||
|
|
|
@ -84,6 +84,7 @@ typedef enum {
|
||||||
SERIALRX_FPORT2 = 12,
|
SERIALRX_FPORT2 = 12,
|
||||||
SERIALRX_SRXL2 = 13,
|
SERIALRX_SRXL2 = 13,
|
||||||
SERIALRX_GHST = 14,
|
SERIALRX_GHST = 14,
|
||||||
|
SERIALRX_MAVLINK = 15,
|
||||||
} rxSerialReceiverType_e;
|
} rxSerialReceiverType_e;
|
||||||
|
|
||||||
#define MAX_SUPPORTED_RC_PPM_CHANNEL_COUNT 16
|
#define MAX_SUPPORTED_RC_PPM_CHANNEL_COUNT 16
|
||||||
|
|
|
@ -177,6 +177,7 @@
|
||||||
#define USE_SERIALRX_SUMH
|
#define USE_SERIALRX_SUMH
|
||||||
#define USE_SERIALRX_XBUS
|
#define USE_SERIALRX_XBUS
|
||||||
#define USE_SERIALRX_JETIEXBUS
|
#define USE_SERIALRX_JETIEXBUS
|
||||||
|
#define USE_SERIALRX_MAVLINK
|
||||||
#define USE_SERIALRX_CRSF
|
#define USE_SERIALRX_CRSF
|
||||||
#define USE_PWM_SERVO_DRIVER
|
#define USE_PWM_SERVO_DRIVER
|
||||||
#define USE_SERIAL_PASSTHROUGH
|
#define USE_SERIAL_PASSTHROUGH
|
||||||
|
|
|
@ -1010,6 +1010,10 @@ static bool handleIncoming_MISSION_REQUEST(void)
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static bool handleIncoming_RC_CHANNELS_OVERRIDE(void) {
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
static bool processMAVLinkIncomingTelemetry(void)
|
static bool processMAVLinkIncomingTelemetry(void)
|
||||||
{
|
{
|
||||||
while (serialRxBytesWaiting(mavlinkPort) > 0) {
|
while (serialRxBytesWaiting(mavlinkPort) > 0) {
|
||||||
|
@ -1030,6 +1034,8 @@ static bool processMAVLinkIncomingTelemetry(void)
|
||||||
return handleIncoming_MISSION_REQUEST_LIST();
|
return handleIncoming_MISSION_REQUEST_LIST();
|
||||||
case MAVLINK_MSG_ID_MISSION_REQUEST:
|
case MAVLINK_MSG_ID_MISSION_REQUEST:
|
||||||
return handleIncoming_MISSION_REQUEST();
|
return handleIncoming_MISSION_REQUEST();
|
||||||
|
case MAVLINK_MSG_ID_RC_CHANNELS_OVERRIDE:
|
||||||
|
return handleIncoming_RC_CHANNELS_OVERRIDE();
|
||||||
default:
|
default:
|
||||||
return false;
|
return false;
|
||||||
}
|
}
|
||||||
|
|
Loading…
Add table
Add a link
Reference in a new issue