@@ -13,8 +13,9 @@ enum ModuleType {
|
||||
MODULE_TYPE_R9M_LITE_PRO_PXX1,
|
||||
MODULE_TYPE_R9M_LITE_PRO_PXX2,
|
||||
MODULE_TYPE_SBUS,
|
||||
MODULE_TYPE_MAX = MODULE_TYPE_SBUS,
|
||||
MODULE_TYPE_COUNT
|
||||
MODULE_TYPE_XJT_LITE_PXX2,
|
||||
MODULE_TYPE_COUNT,
|
||||
MODULE_TYPE_MAX = MODULE_TYPE_COUNT - 1
|
||||
};
|
||||
|
||||
/* FrSky XJT / ISRM */
|
||||
@@ -30,8 +31,9 @@ enum ModuleSubtypePXX1 {
|
||||
enum ModuleSubtypeISRM_PXX2 {
|
||||
MODULE_SUBTYPE_ISRM_PXX2_ACCESS,
|
||||
MODULE_SUBTYPE_ISRM_PXX2_ACCST_D16,
|
||||
MODULE_SUBTYPE_ISRM_PXX2_ACCST_LR12, // not implemented in the module as of today
|
||||
MODULE_SUBTYPE_ISRM_PXX2_LAST = MODULE_SUBTYPE_ISRM_PXX2_ACCST_D16
|
||||
MODULE_SUBTYPE_ISRM_PXX2_ACCST_LR12,
|
||||
MODULE_SUBTYPE_ISRM_PXX2_ACCST_D8,
|
||||
MODULE_SUBTYPE_ISRM_PXX2_LAST = MODULE_SUBTYPE_ISRM_PXX2_ACCST_D8
|
||||
};
|
||||
|
||||
enum ModuleSubtypeR9M_PXX2 {
|
||||
@@ -50,9 +52,6 @@ enum AntennaTypes {
|
||||
XJT_EXTERNAL_ANTENNA
|
||||
};
|
||||
|
||||
#define HAS_RF_PROTOCOL_FAILSAFE(rf) ((rf) == MODULE_SUBTYPE_PXX1_ACCST_D16)
|
||||
#define HAS_RF_PROTOCOL_MODELINDEX(rf) (((rf) == MODULE_SUBTYPE_PXX1_ACCST_D16) || ((rf) == MODULE_SUBTYPE_PXX1_ACCST_LR12))
|
||||
|
||||
/* FrSky R9M / R9M-Lite & co */
|
||||
|
||||
enum ModuleSubtypeR9M {
|
||||
|
||||
@@ -23,6 +23,9 @@
|
||||
|
||||
#include "bitfield.h"
|
||||
#include "definitions.h"
|
||||
#if defined(MULTIMODULE)
|
||||
#include "telemetry/multi.h"
|
||||
#endif
|
||||
|
||||
#define CROSSFIRE_CHANNELS_COUNT 16
|
||||
|
||||
@@ -50,7 +53,7 @@ inline bool isModuleMultimoduleDSM2(uint8_t)
|
||||
|
||||
inline bool isModuleTypeXJT(uint8_t type)
|
||||
{
|
||||
return type == MODULE_TYPE_XJT_PXX1;
|
||||
return type == MODULE_TYPE_XJT_PXX1 || type == MODULE_TYPE_XJT_LITE_PXX2;
|
||||
}
|
||||
|
||||
inline bool isModuleXJT(uint8_t idx)
|
||||
@@ -58,17 +61,26 @@ inline bool isModuleXJT(uint8_t idx)
|
||||
return isModuleTypeXJT(g_model.moduleData[idx].type);
|
||||
}
|
||||
|
||||
inline bool isModuleXJT2(uint8_t idx)
|
||||
inline bool isModuleXJTD8(uint8_t idx)
|
||||
{
|
||||
return isModuleXJT(idx) && g_model.moduleData[idx].subType == MODULE_SUBTYPE_PXX1_ACCST_D8;
|
||||
}
|
||||
|
||||
inline bool isModuleXJTLR12(uint8_t idx)
|
||||
{
|
||||
return isModuleXJT(idx) && g_model.moduleData[idx].subType == MODULE_SUBTYPE_PXX1_ACCST_LR12;
|
||||
}
|
||||
|
||||
inline bool isModuleXJTD16(uint8_t idx)
|
||||
{
|
||||
return isModuleXJT(idx) && g_model.moduleData[idx].subType == MODULE_SUBTYPE_PXX1_ACCST_D16;
|
||||
}
|
||||
|
||||
inline bool isModuleACCESS(uint8_t idx)
|
||||
{
|
||||
return g_model.moduleData[idx].type == MODULE_TYPE_ISRM_PXX2;
|
||||
}
|
||||
|
||||
inline bool isModuleXJTVariant(uint8_t idx)
|
||||
{
|
||||
return g_model.moduleData[idx].type == MODULE_TYPE_XJT_PXX1 || g_model.moduleData[idx].type == MODULE_TYPE_ISRM_PXX2;
|
||||
}
|
||||
|
||||
|
||||
#if defined(CROSSFIRE)
|
||||
inline bool isModuleCrossfire(uint8_t idx)
|
||||
{
|
||||
@@ -164,27 +176,32 @@ inline bool isModuleR9MLite(uint8_t idx)
|
||||
|
||||
inline bool isModuleR9M_FCC(uint8_t idx)
|
||||
{
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].subType == MODULE_SUBTYPE_R9M_FCC;
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].rfProtocol == MODULE_SUBTYPE_R9M_FCC;
|
||||
}
|
||||
|
||||
inline bool isModuleTypeLite(uint8_t type)
|
||||
{
|
||||
return isModuleTypeR9MLite(type) || type == MODULE_TYPE_XJT_LITE_PXX2;
|
||||
}
|
||||
|
||||
inline bool isModuleR9M_LBT(uint8_t idx)
|
||||
{
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].subType == MODULE_SUBTYPE_R9M_EU;
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].rfProtocol == MODULE_SUBTYPE_R9M_EU;
|
||||
}
|
||||
|
||||
inline bool isModuleR9M_FCC_VARIANT(uint8_t idx)
|
||||
{
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].subType != MODULE_SUBTYPE_R9M_EU;
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].rfProtocol != MODULE_SUBTYPE_R9M_EU;
|
||||
}
|
||||
|
||||
inline bool isModuleR9M_EUPLUS(uint8_t idx)
|
||||
{
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].subType == MODULE_SUBTYPE_R9M_EUPLUS;
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].rfProtocol == MODULE_SUBTYPE_R9M_EUPLUS;
|
||||
}
|
||||
|
||||
inline bool isModuleR9M_AU_PLUS(uint8_t idx)
|
||||
{
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].subType == MODULE_SUBTYPE_R9M_AUPLUS;
|
||||
return isModuleR9MNonAccess(idx) && g_model.moduleData[idx].rfProtocol == MODULE_SUBTYPE_R9M_AUPLUS;
|
||||
}
|
||||
|
||||
inline bool isModuleTypePXX1(uint8_t type)
|
||||
@@ -199,13 +216,13 @@ inline bool isModulePXX1(uint8_t idx)
|
||||
|
||||
inline bool isModulePXX2(uint8_t idx)
|
||||
{
|
||||
return isModuleXJT2(idx) || isModuleR9MAccess(idx);
|
||||
return isModuleACCESS(idx) || isModuleR9MAccess(idx);
|
||||
}
|
||||
|
||||
inline bool isModuleRFAccess(uint8_t idx)
|
||||
{
|
||||
if (isModuleXJT2(idx)) {
|
||||
return g_model.moduleData[idx].subType == MODULE_SUBTYPE_ISRM_PXX2_ACCESS;
|
||||
if (isModuleACCESS(idx)) {
|
||||
return g_model.moduleData[idx].rfProtocol == MODULE_SUBTYPE_ISRM_PXX2_ACCESS;
|
||||
}
|
||||
else if (isModuleR9MAccess(idx)) {
|
||||
return true;
|
||||
@@ -251,7 +268,7 @@ inline int8_t maxModuleChannels_M8(uint8_t idx)
|
||||
if (isExtraModule(idx))
|
||||
return MAX_EXTRA_MODULE_CHANNELS_M8;
|
||||
else if (isModuleXJT(idx))
|
||||
return maxChannelsXJT[1 + g_model.moduleData[idx].rfProtocol];
|
||||
return maxChannelsXJT[1 + g_model.moduleData[idx].subType];
|
||||
else
|
||||
return maxChannelsModules[g_model.moduleData[idx].type];
|
||||
}
|
||||
@@ -264,6 +281,10 @@ inline int8_t defaultModuleChannels_M8(uint8_t idx)
|
||||
return 0; // 8 channels
|
||||
else if (isModuleMultimoduleDSM2(idx))
|
||||
return -1; // 7 channels
|
||||
else if (isModuleXJTD8(idx))
|
||||
return 0; // 8 channels
|
||||
else if (isModuleXJTLR12(idx))
|
||||
return 4; // 12 channels
|
||||
else if (isModulePXX2(idx))
|
||||
return 8; // 16 channels
|
||||
else
|
||||
@@ -363,6 +384,15 @@ static const uint8_t receiverOptions[] = {
|
||||
0b11111111, // R9-MM+OTA
|
||||
};
|
||||
|
||||
enum ModuleCapabilities {
|
||||
MODULE_CAPABILITY_COUNT
|
||||
};
|
||||
|
||||
enum ReceiverCapabilities {
|
||||
RECEIVER_CAPABILITY_FPORT,
|
||||
RECEIVER_CAPABILITY_COUNT
|
||||
};
|
||||
|
||||
inline uint8_t getReceiverOptions(uint8_t modelId)
|
||||
{
|
||||
if (modelId < DIM(receiverOptions))
|
||||
@@ -373,7 +403,7 @@ inline uint8_t getReceiverOptions(uint8_t modelId)
|
||||
|
||||
inline bool isReceiverOptionAvailable(uint8_t modelId, uint8_t option)
|
||||
{
|
||||
return receiverOptions[modelId] & (1 << option);
|
||||
return getReceiverOptions(modelId) & (1 << option);
|
||||
}
|
||||
|
||||
inline bool isDefaultModelRegistrationID()
|
||||
@@ -381,4 +411,63 @@ inline bool isDefaultModelRegistrationID()
|
||||
return memcmp(g_model.modelRegistrationID, g_eeGeneral.ownerRegistrationID, PXX2_LEN_REGISTRATION_ID) == 0;
|
||||
}
|
||||
|
||||
inline bool isModuleModelIndexAvailable(uint8_t idx)
|
||||
{
|
||||
if (isModuleXJT(idx))
|
||||
return g_model.moduleData[idx].subType != MODULE_SUBTYPE_PXX1_ACCST_D8;
|
||||
|
||||
if (isModuleR9M(idx))
|
||||
return true;
|
||||
|
||||
if (isModuleDSM2(idx))
|
||||
return true;
|
||||
|
||||
if (isModuleACCESS(idx))
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
inline bool isModuleFailsafeAvailable(uint8_t idx)
|
||||
{
|
||||
#if defined(PXX2)
|
||||
if (isModuleACCESS(idx))
|
||||
return true;
|
||||
#endif
|
||||
|
||||
if (isModuleXJT(idx))
|
||||
return g_model.moduleData[idx].subType == MODULE_SUBTYPE_PXX1_ACCST_D16;
|
||||
|
||||
#if defined(MULTIMODULE)
|
||||
if (isModuleMultimodule(idx))
|
||||
return multiModuleStatus.isValid() && multiModuleStatus.supportsFailsafe();
|
||||
#endif
|
||||
|
||||
if (isModuleR9M(idx))
|
||||
return true;
|
||||
|
||||
return false;
|
||||
}
|
||||
|
||||
inline uint8_t getMaxRxNum(uint8_t idx)
|
||||
{
|
||||
if (isModuleDSM2(idx))
|
||||
return 20;
|
||||
|
||||
#if defined(MULTIMODULE)
|
||||
if (isModuleMultimodule(idx))
|
||||
return g_model.moduleData[idx].getMultiProtocol(true) == MODULE_SUBTYPE_MULTI_OLRS ? 4 : 15;
|
||||
#endif
|
||||
|
||||
return 63;
|
||||
}
|
||||
|
||||
inline const char * getModuleDelay(uint8_t idx)
|
||||
{
|
||||
if (isModuleXJTD16(idx) || isModuleR9MNonAccess(idx))
|
||||
return sentModuleChannels(idx) > 8 ? "(18ms)" : "(9ms)";
|
||||
|
||||
return nullptr;
|
||||
}
|
||||
|
||||
#endif // _MODULES_H_
|
||||
|
||||
@@ -74,6 +74,7 @@ uint8_t getRequiredProtocol(uint8_t module)
|
||||
|
||||
case MODULE_TYPE_ISRM_PXX2:
|
||||
case MODULE_TYPE_R9M_LITE_PRO_PXX2:
|
||||
case MODULE_TYPE_XJT_LITE_PXX2:
|
||||
protocol = PROTOCOL_CHANNELS_PXX2_HIGHSPEED;
|
||||
break;
|
||||
|
||||
|
||||
@@ -94,6 +94,8 @@ PACK(struct PXX2HardwareInformation {
|
||||
PXX2Version hwVersion;
|
||||
PXX2Version swVersion;
|
||||
uint8_t variant;
|
||||
uint32_t capabilities; // variable length
|
||||
uint8_t capabilityNotSupported;
|
||||
});
|
||||
|
||||
PACK(struct ModuleInformation {
|
||||
@@ -110,9 +112,10 @@ PACK(struct ModuleInformation {
|
||||
class ModuleSettings {
|
||||
public:
|
||||
uint8_t state; // 0x00 = READ 0x40 = WRITE
|
||||
tmr10ms_t retryTime;
|
||||
tmr10ms_t timeout;
|
||||
uint8_t externalAntenna;
|
||||
int8_t txPower;
|
||||
uint8_t dirty;
|
||||
};
|
||||
|
||||
class ReceiverSettings {
|
||||
@@ -167,6 +170,7 @@ PACK(struct ModuleState {
|
||||
union {
|
||||
ModuleInformation * moduleInformation;
|
||||
ModuleSettings * moduleSettings;
|
||||
ReceiverSettings * receiverSettings;
|
||||
BindInformation * bindInformation;
|
||||
OtaUpdateInformation * otaUpdateInformation;
|
||||
};
|
||||
@@ -196,9 +200,22 @@ PACK(struct ModuleState {
|
||||
{
|
||||
moduleSettings = source;
|
||||
moduleSettings->state = PXX2_SETTINGS_WRITE;
|
||||
moduleSettings->retryTime = 0;
|
||||
moduleSettings->timeout = 0;
|
||||
mode = MODULE_MODE_MODULE_SETTINGS;
|
||||
}
|
||||
void readReceiverSettings(ReceiverSettings * destination)
|
||||
{
|
||||
receiverSettings = destination;
|
||||
receiverSettings->state = PXX2_SETTINGS_READ;
|
||||
mode = MODULE_MODE_RECEIVER_SETTINGS;
|
||||
}
|
||||
void writeReceiverSettings(ReceiverSettings * source)
|
||||
{
|
||||
receiverSettings = source;
|
||||
receiverSettings->state = PXX2_SETTINGS_WRITE;
|
||||
receiverSettings->timeout = 0;
|
||||
mode = MODULE_MODE_RECEIVER_SETTINGS;
|
||||
}
|
||||
});
|
||||
|
||||
extern ModuleState moduleState[NUM_MODULES];
|
||||
@@ -393,10 +410,9 @@ inline void SEND_FAILSAFE_1S()
|
||||
void setCustomFailsafe(uint8_t moduleIndex);
|
||||
|
||||
enum R9MLiteLBTPowerValues {
|
||||
R9M_LITE_LBT_POWER_25 = 0,
|
||||
R9M_LITE_LBT_POWER_25_16,
|
||||
R9M_LITE_LBT_POWER_100,
|
||||
R9M_LITE_LBT_POWER_MAX = R9M_LITE_LBT_POWER_100
|
||||
R9M_LITE_LBT_POWER_25_TELEM = 0,
|
||||
R9M_LITE_LBT_POWER_100_NOTELEM,
|
||||
R9M_LITE_LBT_POWER_MAX = R9M_LITE_LBT_POWER_100_NOTELEM
|
||||
};
|
||||
|
||||
enum R9MFCCPowerValues {
|
||||
@@ -416,5 +432,5 @@ enum R9MLBTPowerValues {
|
||||
};
|
||||
|
||||
#define BIND_CH9TO16_ALLOWED(idx) (!isModuleR9M_LBT(idx) || g_model.moduleData[idx].pxx.power != R9M_LBT_POWER_25)
|
||||
#define BIND_TELEM_ALLOWED(idx) (g_model.moduleData[EXTERNAL_MODULE].type == MODULE_TYPE_R9M_PXX1) ? (!(IS_TELEMETRY_INTERNAL_MODULE() && moduleIdx == EXTERNAL_MODULE) && (!isModuleR9M_LBT(idx) || g_model.moduleData[idx].pxx.power < R9M_LBT_POWER_200)) : (!(IS_TELEMETRY_INTERNAL_MODULE() && moduleIdx == EXTERNAL_MODULE) && (!isModuleR9M_LBT(idx) || g_model.moduleData[idx].pxx.power < R9M_LITE_LBT_POWER_100))
|
||||
#define BIND_TELEM_ALLOWED(idx) (g_model.moduleData[EXTERNAL_MODULE].type == MODULE_TYPE_R9M_PXX1) ? (!(IS_TELEMETRY_INTERNAL_MODULE() && moduleIdx == EXTERNAL_MODULE) && (!isModuleR9M_LBT(idx) || g_model.moduleData[idx].pxx.power < R9M_LBT_POWER_200)) : (!(IS_TELEMETRY_INTERNAL_MODULE() && moduleIdx == EXTERNAL_MODULE) && (!isModuleR9M_LBT(idx) || g_model.moduleData[idx].pxx.power < R9M_LITE_LBT_POWER_100_NOTELEM))
|
||||
#endif // _PULSES_H_
|
||||
|
||||
@@ -39,8 +39,15 @@ uint8_t Pxx2Pulses::addFlag0(uint8_t module)
|
||||
|
||||
void Pxx2Pulses::addFlag1(uint8_t module)
|
||||
{
|
||||
uint8_t flag1 = g_model.moduleData[module].subType << 4;
|
||||
Pxx2Transport::addByte(flag1);
|
||||
uint8_t subType;
|
||||
if (isModuleXJT(module)) {
|
||||
static const uint8_t PXX2_XJT_MODULE_SUBTYPES[] = {0x01, 0x03, 0x02};
|
||||
subType = PXX2_XJT_MODULE_SUBTYPES[min<uint8_t>(g_model.moduleData[module].subType, 2)];
|
||||
}
|
||||
else {
|
||||
subType = g_model.moduleData[module].subType;
|
||||
}
|
||||
Pxx2Transport::addByte(subType << 4);
|
||||
}
|
||||
|
||||
void Pxx2Pulses::addPulsesValues(uint16_t low, uint16_t high)
|
||||
@@ -180,7 +187,7 @@ void Pxx2Pulses::setupModuleSettingsFrame(uint8_t module)
|
||||
{
|
||||
ModuleSettings * destination = moduleState[module].moduleSettings;
|
||||
|
||||
if (get_tmr10ms() > destination->retryTime) {
|
||||
if (get_tmr10ms() > destination->timeout) {
|
||||
addFrameType(PXX2_TYPE_C_MODULE, PXX2_TYPE_ID_TX_SETTINGS);
|
||||
uint8_t flag0 = 0;
|
||||
if (destination->state == PXX2_SETTINGS_WRITE)
|
||||
@@ -193,7 +200,7 @@ void Pxx2Pulses::setupModuleSettingsFrame(uint8_t module)
|
||||
Pxx2Transport::addByte(flag1);
|
||||
Pxx2Transport::addByte(destination->txPower);
|
||||
}
|
||||
destination->retryTime = get_tmr10ms() + 200/*next try in 2s*/;
|
||||
destination->timeout = get_tmr10ms() + 200/*next try in 2s*/;
|
||||
}
|
||||
else {
|
||||
setupChannelsFrame(module);
|
||||
|
||||
Reference in New Issue
Block a user