forked from ExpressLRS/ExpressLRS
-
Notifications
You must be signed in to change notification settings - Fork 0
Expand file tree
/
Copy pathcommon.cpp
More file actions
159 lines (136 loc) · 6 KB
/
common.cpp
File metadata and controls
159 lines (136 loc) · 6 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
#include "common.h"
// TODO: Validate values for RFmodeCycleAddtionalTime and RFmodeCycleInterval for rates lower than 50HZ
#if defined(Regulatory_Domain_AU_915) || defined(Regulatory_Domain_EU_868) || defined(Regulatory_Domain_FCC_915) || defined(Regulatory_Domain_AU_433) || defined(Regulatory_Domain_EU_433)
#include "SX127xDriver.h"
extern SX127xDriver Radio;
expresslrs_mod_settings_s ExpressLRS_AirRateConfig[RATE_MAX] = {
{0, RATE_200HZ, SX127x_BW_500_00_KHZ, SX127x_SF_6, SX127x_CR_4_7, 5000, TLM_RATIO_1_64, 2, 8},
{1, RATE_100HZ, SX127x_BW_500_00_KHZ, SX127x_SF_7, SX127x_CR_4_7, 10000, TLM_RATIO_1_64, 2, 8},
{2, RATE_50HZ, SX127x_BW_500_00_KHZ, SX127x_SF_8, SX127x_CR_4_7, 20000, TLM_RATIO_NO_TLM, 2, 10},
{3, RATE_25HZ, SX127x_BW_500_00_KHZ, SX127x_SF_9, SX127x_CR_4_7, 40000, TLM_RATIO_NO_TLM, 2, 10}};
//{4, RATE_4HZ, SX127x_BW_500_00_KHZ, SX127x_SF_12, SX127x_CR_4_7, 250000, TLM_RATIO_1_4, 2, 10}}; // for model recovery
expresslrs_rf_pref_params_s ExpressLRS_AirRateRFperf[RATE_MAX] = {
{0, RATE_200HZ, -112, 4380, 3500, 2500, 2000, 5000}, // ~ 3 sync packets
{1, RATE_100HZ, -117, 8770, 3500, 2500, 2000, 5000},
{2, RATE_50HZ, -120, 17540, 3500, 2500, 2000, 5000},
{3, RATE_25HZ, -123, 17540, 3500, 4000, 2000, 5000}};
//{4, RATE_4HZ, -131, 239620, 30000, 60000, 0, 250}}; // this means always send sync on ch[0] as soon as we can
#endif
#if defined(Regulatory_Domain_ISM_2400)
#include "SX1280Driver.h"
extern SX1280Driver Radio;
#ifdef USE_500HZ
expresslrs_mod_settings_s ExpressLRS_AirRateConfig[RATE_MAX] = {
{0, RATE_500HZ, SX1280_LORA_BW_0800, SX1280_LORA_SF5, SX1280_LORA_CR_4_5, 2000, TLM_RATIO_1_128, 2, 12}, // needs more work/debugging and it's not even supported in OTX yet
{1, RATE_250HZ, SX1280_LORA_BW_0800, SX1280_LORA_SF6, SX1280_LORA_CR_LI_4_7, 4000, TLM_RATIO_1_64, 2, 14},
{2, RATE_150HZ, SX1280_LORA_BW_0800, SX1280_LORA_SF7, SX1280_LORA_CR_LI_4_7, 6666, TLM_RATIO_1_32, 2, 12},
{3, RATE_50HZ, SX1280_LORA_BW_0800, SX1280_LORA_SF9, SX1280_LORA_CR_4_5, 20000, TLM_RATIO_NO_TLM, 2, 12}};
expresslrs_rf_pref_params_s ExpressLRS_AirRateRFperf[RATE_MAX] = {
{0, RATE_500HZ, -105, 4380, 3500, 1000, 2000, 5000}, // ~ 3 sync packets
{1, RATE_250HZ, -108, 4380, 3500, 2500, 2000, 5000}, // ~ 3 sync packets
{2, RATE_150HZ, -112, 8770, 3500, 2500, 2000, 5000},
{3, RATE_50HZ, -117, 17540, 3500, 2500, 2000, 5000}}; // this means always send sync on ch[0] as soon as we can
#else
expresslrs_mod_settings_s ExpressLRS_AirRateConfig[RATE_MAX] = {
{0, RATE_250HZ, SX1280_LORA_BW_0800, SX1280_LORA_SF6, SX1280_LORA_CR_LI_4_7, 4000, TLM_RATIO_1_64, 2, 14},
{1, RATE_150HZ, SX1280_LORA_BW_0800, SX1280_LORA_SF7, SX1280_LORA_CR_LI_4_7, 6666, TLM_RATIO_1_32, 2, 12},
{2, RATE_50HZ, SX1280_LORA_BW_0800, SX1280_LORA_SF9, SX1280_LORA_CR_4_5, 20000, TLM_RATIO_NO_TLM, 2, 12},
{3, RATE_25HZ, SX1280_LORA_BW_0800, SX1280_LORA_SF10, SX1280_LORA_CR_4_5, 40000, TLM_RATIO_NO_TLM, 2, 12}};
expresslrs_rf_pref_params_s ExpressLRS_AirRateRFperf[RATE_MAX] = {
{0, RATE_250HZ, -108, 4380, 3500, 2500, 2000, 5000}, // ~ 3 sync packets
{1, RATE_150HZ, -112, 8770, 3500, 2500, 2000, 5000},
{2, RATE_50HZ, -117, 17540, 3500, 2500, 2000, 5000}, // this means always send sync on ch[0] as soon as we can
{3, RATE_25HZ, -120, 36886, 3500, 4000, 2000, 5000}};
#endif
#endif
expresslrs_mod_settings_s *get_elrs_airRateConfig(int8_t index);
//const expresslrs_mod_settings_s * ExpressLRS_nextAirRate;
expresslrs_mod_settings_s *ExpressLRS_currAirRate;
expresslrs_mod_settings_s *ExpressLRS_prevAirRate;
ICACHE_RAM_ATTR expresslrs_mod_settings_s *get_elrs_airRateConfig(int8_t index)
{
// Protect against out of bounds rate
if (index < 0)
{
// Set to first entry in the array
return &ExpressLRS_AirRateConfig[0];
}
else if (index > (RATE_MAX - 1))
{
// Set to last usable entry in the array
return &ExpressLRS_AirRateConfig[RATE_MAX - 1];
}
return &ExpressLRS_AirRateConfig[index];
}
ICACHE_RAM_ATTR expresslrs_rf_pref_params_s *get_elrs_RFperfParams(int8_t index)
{
// Protect against out of bounds rate
if (index < 0)
{
// Set to first entry in the array
return &ExpressLRS_AirRateRFperf[0];
}
else if (index > (RATE_MAX - 1))
{
// Set to last usable entry in the array
return &ExpressLRS_AirRateRFperf[RATE_MAX - 1];
}
return &ExpressLRS_AirRateRFperf[index];
}
ICACHE_RAM_ATTR uint8_t enumRatetoIndex(expresslrs_RFrates_e rate)
{ // convert enum_rate to index
int i;
for (i = 0; i < RATE_MAX; i++)
{
expresslrs_mod_settings_s *const ModParams = get_elrs_airRateConfig(i);
if (ModParams->enum_rate == rate)
{
return i;
}
}
return i;
}
expresslrs_mod_settings_s *ExpressLRS_currAirRate_Modparams;
expresslrs_rf_pref_params_s *ExpressLRS_currAirRate_RFperfParams;
uint8_t ExpressLRS_nextAirRateIndex = 0;
//expresslrs_mod_settings_s *ExpressLRS_nextAirRate;
//expresslrs_mod_settings_s *ExpressLRS_prevAirRate;
connectionState_e connectionState = disconnected;
connectionState_e connectionStatePrev = disconnected;
uint8_t UID[6] = {MY_UID};
uint8_t CRCCaesarCipher = UID[4];
uint8_t DeviceAddr = UID[5] & 0b111111; // temporarily based on mac until listen before assigning method merged
#define RSSI_FLOOR_NUM_READS 5 // number of times to sweep the noise foor to get avg. RSSI reading
#define MEDIAN_SIZE 20
uint8_t ICACHE_RAM_ATTR TLMratioEnumToValue(expresslrs_tlm_ratio_e enumval)
{
switch (enumval)
{
case TLM_RATIO_NO_TLM:
return 0;
break;
case TLM_RATIO_1_2:
return 2;
break;
case TLM_RATIO_1_4:
return 4;
break;
case TLM_RATIO_1_8:
return 8;
break;
case TLM_RATIO_1_16:
return 16;
break;
case TLM_RATIO_1_32:
return 32;
break;
case TLM_RATIO_1_64:
return 64;
break;
case TLM_RATIO_1_128:
return 128;
break;
default:
return 0;
}
}