Ghost support (#7900)
This commit is contained in:
Executable
+89
@@ -0,0 +1,89 @@
|
||||
/*
|
||||
* Copyright (C) OpenTX
|
||||
*
|
||||
* Based on code named
|
||||
* th9x - http://code.google.com/p/th9x
|
||||
* er9x - http://code.google.com/p/er9x
|
||||
* gruvin9x - http://code.google.com/p/gruvin9x
|
||||
*
|
||||
* License GPLv2: http://www.gnu.org/licenses/gpl-2.0.html
|
||||
*
|
||||
* This program is free software; you can redistribute it and/or modify
|
||||
* it under the terms of the GNU General Public License version 2 as
|
||||
* published by the Free Software Foundation.
|
||||
*
|
||||
* This program 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.
|
||||
*/
|
||||
|
||||
#include "opentx.h"
|
||||
|
||||
// Range for pulses (channels output) is [-1024:+1024]
|
||||
uint8_t createGhostChannelsFrame(uint8_t * frame, int16_t * pulses)
|
||||
{
|
||||
static uint8_t lastGhostFrameId = GHST_UL_RC_CHANS_HS4_5TO8;
|
||||
uint8_t ghostUpper4Offset = 0;
|
||||
|
||||
switch (lastGhostFrameId) {
|
||||
case GHST_UL_RC_CHANS_HS4_5TO8:
|
||||
ghostUpper4Offset = 0;
|
||||
break;
|
||||
case GHST_UL_RC_CHANS_HS4_9TO12:
|
||||
ghostUpper4Offset = 4;
|
||||
break;
|
||||
case GHST_UL_RC_CHANS_HS4_13TO16:
|
||||
ghostUpper4Offset = 8;
|
||||
break;
|
||||
}
|
||||
|
||||
uint8_t * buf = frame;
|
||||
*buf++ = GHST_ADDR_MODULE;
|
||||
*buf++ = GHST_UL_RC_CHANS_SIZE;
|
||||
uint8_t * crc_start = buf;
|
||||
*buf++ = lastGhostFrameId;
|
||||
|
||||
// first 4 high speed, 12 bit channels (11 relevant bits with openTx)
|
||||
uint32_t bits = 0;
|
||||
uint8_t bitsavailable = 0;
|
||||
for (int i = 0; i < 4; i++) {
|
||||
uint32_t value = limit(0, GHST_RC_CTR_VAL_12BIT + (((pulses[i]) << 3) / 5), 2 * GHST_RC_CTR_VAL_12BIT);
|
||||
bits |= value << bitsavailable;
|
||||
bitsavailable += GHST_CH_BITS_12;
|
||||
while (bitsavailable >= 8) {
|
||||
*buf++ = bits;
|
||||
bits >>= 8;
|
||||
bitsavailable -= 8;
|
||||
}
|
||||
}
|
||||
|
||||
// second 4 lower speed, 8 bit channels
|
||||
for (int i = 4; i < 8; ++i) {
|
||||
*buf++ = limit(0, GHST_RC_CTR_VAL_8BIT + (((pulses[i + ghostUpper4Offset]) >> 1) / 5), 2 * GHST_RC_CTR_VAL_8BIT);
|
||||
}
|
||||
|
||||
*buf++ = crc8(crc_start, GHST_UL_RC_CHANS_SIZE - 1);
|
||||
|
||||
switch (lastGhostFrameId) {
|
||||
case GHST_UL_RC_CHANS_HS4_5TO8:
|
||||
lastGhostFrameId = GHST_UL_RC_CHANS_HS4_9TO12;
|
||||
break;
|
||||
case GHST_UL_RC_CHANS_HS4_9TO12:
|
||||
lastGhostFrameId = GHST_UL_RC_CHANS_HS4_13TO16;
|
||||
break;
|
||||
case GHST_UL_RC_CHANS_HS4_13TO16:
|
||||
lastGhostFrameId = GHST_UL_RC_CHANS_HS4_5TO8;
|
||||
break;
|
||||
}
|
||||
|
||||
return buf - frame;
|
||||
}
|
||||
|
||||
void setupPulsesGhost()
|
||||
{
|
||||
if (telemetryProtocol == PROTOCOL_TELEMETRY_GHOST) {
|
||||
uint8_t * pulses = extmodulePulsesData.ghost.pulses;
|
||||
extmodulePulsesData.ghost.length = createGhostChannelsFrame(pulses, &channelOutputs[g_model.moduleData[EXTERNAL_MODULE].channelsStart]);
|
||||
}
|
||||
}
|
||||
@@ -29,11 +29,11 @@ enum ModuleType {
|
||||
MODULE_TYPE_DSM2,
|
||||
MODULE_TYPE_CROSSFIRE,
|
||||
MODULE_TYPE_MULTIMODULE,
|
||||
MODULE_TYPE_R9M_PXX1,
|
||||
MODULE_TYPE_R9M_PXX2,
|
||||
MODULE_TYPE_R9M_LITE_PXX1,
|
||||
MODULE_TYPE_R9M_LITE_PXX2,
|
||||
MODULE_TYPE_R9M_LITE_PRO_PXX1, // Doesn't exist
|
||||
MODULE_TYPE_R9M_PXX1, // R9M
|
||||
MODULE_TYPE_R9M_PXX2, // R9M ACCESS
|
||||
MODULE_TYPE_R9M_LITE_PXX1, //R9MLite
|
||||
MODULE_TYPE_R9M_LITE_PXX2, //R9MLP
|
||||
MODULE_TYPE_GHOST, // Replaces MODULE_TYPE_R9M_LITE_PRO_PXX1 which doesn't exist
|
||||
MODULE_TYPE_R9M_LITE_PRO_PXX2,
|
||||
MODULE_TYPE_SBUS,
|
||||
MODULE_TYPE_XJT_LITE_PXX2,
|
||||
|
||||
@@ -33,6 +33,7 @@
|
||||
#endif
|
||||
|
||||
#define CROSSFIRE_CHANNELS_COUNT 16
|
||||
#define GHOST_CHANNELS_COUNT 12
|
||||
|
||||
#if defined(MULTIMODULE)
|
||||
// When using packed, the pointer in here end up not being aligned, which clang and gcc complain about
|
||||
@@ -150,6 +151,18 @@ inline bool isModuleCrossfire(uint8_t idx)
|
||||
}
|
||||
#endif
|
||||
|
||||
#if defined(GHOST)
|
||||
inline bool isModuleGhost(uint8_t idx)
|
||||
{
|
||||
return idx == EXTERNAL_MODULE && g_model.moduleData[EXTERNAL_MODULE].type == MODULE_TYPE_GHOST;
|
||||
}
|
||||
#else
|
||||
inline bool isModuleGhost(uint8_t idx)
|
||||
{
|
||||
return false;
|
||||
}
|
||||
#endif
|
||||
|
||||
#if defined(PCBSKY9X)
|
||||
inline bool isExtraModule(uint8_t idx)
|
||||
{
|
||||
@@ -178,7 +191,7 @@ inline bool isModulePPM(uint8_t moduleIdx)
|
||||
|
||||
inline bool isModuleTypeR9MNonAccess(uint8_t type)
|
||||
{
|
||||
return type == MODULE_TYPE_R9M_PXX1 || type == MODULE_TYPE_R9M_LITE_PXX1 || type == MODULE_TYPE_R9M_LITE_PRO_PXX1;
|
||||
return type == MODULE_TYPE_R9M_PXX1 || type == MODULE_TYPE_R9M_LITE_PXX1;
|
||||
}
|
||||
|
||||
inline bool isModuleR9MNonAccess(uint8_t idx)
|
||||
@@ -218,7 +231,7 @@ inline bool isModuleR9MLiteNonPro(uint8_t idx)
|
||||
|
||||
inline bool isModuleTypeR9MLitePro(uint8_t type)
|
||||
{
|
||||
return type == MODULE_TYPE_R9M_LITE_PRO_PXX1 || type == MODULE_TYPE_R9M_LITE_PRO_PXX2;
|
||||
return type == MODULE_TYPE_R9M_LITE_PRO_PXX2;
|
||||
}
|
||||
|
||||
inline bool isModuleTypeR9MLite(uint8_t type)
|
||||
@@ -384,6 +397,8 @@ inline int8_t sentModuleChannels(uint8_t idx)
|
||||
{
|
||||
if (isModuleCrossfire(idx))
|
||||
return CROSSFIRE_CHANNELS_COUNT;
|
||||
else if (isModuleGhost(idx))
|
||||
return GHOST_CHANNELS_COUNT;
|
||||
else if (isModuleMultimodule(idx) && !isModuleMultimoduleDSM2(idx))
|
||||
return 16;
|
||||
else if (isModuleSBUS(idx))
|
||||
@@ -528,7 +543,7 @@ inline bool isTelemAllowedOnBind(uint8_t moduleIndex)
|
||||
return true;
|
||||
}
|
||||
|
||||
if (g_model.moduleData[EXTERNAL_MODULE].type == MODULE_TYPE_R9M_PXX1 || g_model.moduleData[EXTERNAL_MODULE].type == MODULE_TYPE_R9M_LITE_PRO_PXX1) {
|
||||
if (g_model.moduleData[EXTERNAL_MODULE].type == MODULE_TYPE_R9M_PXX1) {
|
||||
if (isModuleR9M_LBT(EXTERNAL_MODULE))
|
||||
return g_model.moduleData[EXTERNAL_MODULE].pxx.power < R9M_LBT_POWER_200_16CH_NOTELEM;
|
||||
else
|
||||
|
||||
@@ -133,7 +133,6 @@ uint8_t getRequiredProtocol(uint8_t module)
|
||||
|
||||
#if defined(HARDWARE_EXTERNAL_MODULE_SIZE_SML)
|
||||
case MODULE_TYPE_R9M_LITE_PXX1:
|
||||
case MODULE_TYPE_R9M_LITE_PRO_PXX1:
|
||||
protocol = PROTOCOL_CHANNELS_PXX1_SERIAL;
|
||||
break;
|
||||
|
||||
@@ -193,6 +192,12 @@ uint8_t getRequiredProtocol(uint8_t module)
|
||||
break;
|
||||
#endif
|
||||
|
||||
#if defined(GHOST)
|
||||
case MODULE_TYPE_GHOST:
|
||||
protocol = PROTOCOL_CHANNELS_GHOST;
|
||||
break;
|
||||
#endif
|
||||
|
||||
default:
|
||||
protocol = PROTOCOL_CHANNELS_NONE;
|
||||
break;
|
||||
@@ -243,6 +248,12 @@ void enablePulsesExternalModule(uint8_t protocol)
|
||||
break;
|
||||
#endif
|
||||
|
||||
#if defined(GHOST)
|
||||
case PROTOCOL_CHANNELS_GHOST:
|
||||
EXTERNAL_MODULE_ON();
|
||||
break;
|
||||
#endif
|
||||
|
||||
#if defined(PXX2) && defined(EXTMODULE_USART)
|
||||
case PROTOCOL_CHANNELS_PXX2_HIGHSPEED:
|
||||
extmoduleInvertedSerialStart(PXX2_HIGHSPEED_BAUDRATE);
|
||||
@@ -332,6 +343,13 @@ bool setupPulsesExternalModule(uint8_t protocol)
|
||||
return true;
|
||||
#endif
|
||||
|
||||
#if defined(GHOST)
|
||||
case PROTOCOL_CHANNELS_GHOST:
|
||||
setupPulsesGhost();
|
||||
scheduleNextMixerCalculation(EXTERNAL_MODULE, GHOST_PERIOD);
|
||||
return true;
|
||||
#endif
|
||||
|
||||
#if defined(MULTIMODULE)
|
||||
case PROTOCOL_CHANNELS_MULTIMODULE:
|
||||
setupPulsesMultiExternalModule();
|
||||
|
||||
@@ -237,6 +237,12 @@ PACK(struct CrossfirePulsesData {
|
||||
uint8_t length;
|
||||
});
|
||||
|
||||
#define GHOST_FRAME_MAXLEN 16
|
||||
PACK(struct GhostPulsesData {
|
||||
uint8_t pulses[GHOST_FRAME_MAXLEN];
|
||||
uint8_t length;
|
||||
});
|
||||
|
||||
union InternalModulePulsesData {
|
||||
#if defined(PXX1)
|
||||
#if defined(INTMODULE_USART)
|
||||
@@ -286,6 +292,8 @@ union ExternalModulePulsesData {
|
||||
PpmPulsesData<pulse_duration_t> ppm;
|
||||
|
||||
CrossfirePulsesData crossfire;
|
||||
|
||||
GhostPulsesData ghost;
|
||||
} __ALIGNED(4);
|
||||
|
||||
/* The __ALIGNED keyword is required to align the struct inside the modulePulsesData below,
|
||||
@@ -310,6 +318,7 @@ bool setupPulsesInternalModule();
|
||||
bool setupPulsesExternalModule();
|
||||
void setupPulsesDSM2();
|
||||
void setupPulsesCrossfire();
|
||||
void setupPulsesGhost();
|
||||
void setupPulsesMultiExternalModule();
|
||||
void setupPulsesMultiInternalModule();
|
||||
void setupPulsesSbus();
|
||||
@@ -364,7 +373,8 @@ enum ChannelsProtocols {
|
||||
PROTOCOL_CHANNELS_SBUS,
|
||||
PROTOCOL_CHANNELS_PXX2_LOWSPEED,
|
||||
PROTOCOL_CHANNELS_PXX2_HIGHSPEED,
|
||||
PROTOCOL_CHANNELS_AFHDS3
|
||||
PROTOCOL_CHANNELS_AFHDS3,
|
||||
PROTOCOL_CHANNELS_GHOST
|
||||
};
|
||||
|
||||
inline void stopPulses()
|
||||
|
||||
Reference in New Issue
Block a user