Driver for the SX1280 RF Transceiver
Dependents: SX1280PingPong RangignMaster RangingSlave MSNV2-Terminal_V1-6 ... more
Diff: RangingCorrection.cpp
- Revision:
- 12:c4f110f3fe3e
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/RangingCorrection.cpp Thu Nov 08 10:08:44 2018 +0000 @@ -0,0 +1,121 @@ +#include "RangingCorrection.h" + +#include "rangingCorrection/rangingCorrectionSF5BW0400.h" +#include "rangingCorrection/rangingCorrectionSF6BW0400.h" +#include "rangingCorrection/rangingCorrectionSF7BW0400.h" +#include "rangingCorrection/rangingCorrectionSF8BW0400.h" +#include "rangingCorrection/rangingCorrectionSF9BW0400.h" +#include "rangingCorrection/rangingCorrectionSF10BW0400.h" +#include "rangingCorrection/rangingCorrectionSF5BW0800.h" +#include "rangingCorrection/rangingCorrectionSF6BW0800.h" +#include "rangingCorrection/rangingCorrectionSF7BW0800.h" +#include "rangingCorrection/rangingCorrectionSF8BW0800.h" +#include "rangingCorrection/rangingCorrectionSF9BW0800.h" +#include "rangingCorrection/rangingCorrectionSF10BW0800.h" +#include "rangingCorrection/rangingCorrectionSF5BW1600.h" +#include "rangingCorrection/rangingCorrectionSF6BW1600.h" +#include "rangingCorrection/rangingCorrectionSF7BW1600.h" +#include "rangingCorrection/rangingCorrectionSF8BW1600.h" +#include "rangingCorrection/rangingCorrectionSF9BW1600.h" +#include "rangingCorrection/rangingCorrectionSF10BW1600.h" + +const double* RangingCorrectionPerSfBwGain[6][3] = { + { &RangingCorrectionSF5BW0400[0], &RangingCorrectionSF5BW0800[0], &RangingCorrectionSF5BW1600[0] }, + { &RangingCorrectionSF6BW0400[0], &RangingCorrectionSF6BW0800[0], &RangingCorrectionSF6BW1600[0] }, + { &RangingCorrectionSF7BW0400[0], &RangingCorrectionSF7BW0800[0], &RangingCorrectionSF7BW1600[0] }, + { &RangingCorrectionSF8BW0400[0], &RangingCorrectionSF8BW0800[0], &RangingCorrectionSF8BW1600[0] }, + { &RangingCorrectionSF9BW0400[0], &RangingCorrectionSF9BW0800[0], &RangingCorrectionSF9BW1600[0] }, + { &RangingCorrectionSF10BW0400[0], &RangingCorrectionSF10BW0800[0], &RangingCorrectionSF10BW1600[0] }, +}; + +const RangingCorrectionPolynomes_t* RangingCorrectionPolynomesPerSfBw[6][3] = { + { &correctionRangingPolynomeSF5BW0400, &correctionRangingPolynomeSF5BW0800, &correctionRangingPolynomeSF5BW1600 }, + { &correctionRangingPolynomeSF6BW0400, &correctionRangingPolynomeSF6BW0800, &correctionRangingPolynomeSF6BW1600 }, + { &correctionRangingPolynomeSF7BW0400, &correctionRangingPolynomeSF7BW0800, &correctionRangingPolynomeSF7BW1600 }, + { &correctionRangingPolynomeSF8BW0400, &correctionRangingPolynomeSF8BW0800, &correctionRangingPolynomeSF8BW1600 }, + { &correctionRangingPolynomeSF9BW0400, &correctionRangingPolynomeSF9BW0800, &correctionRangingPolynomeSF9BW1600 }, + { &correctionRangingPolynomeSF10BW0400, &correctionRangingPolynomeSF10BW0800, &correctionRangingPolynomeSF10BW1600 }, +}; + +double Sx1280RangingCorrection::GetRangingCorrectionPerSfBwGain( const RadioLoRaSpreadingFactors_t sf, const RadioLoRaBandwidths_t bw, const int8_t gain){ + uint8_t sf_index, bw_index; + + switch(sf){ + case LORA_SF5: + sf_index = 0; + break; + case LORA_SF6: + sf_index = 1; + break; + case LORA_SF7: + sf_index = 2; + break; + case LORA_SF8: + sf_index = 3; + break; + case LORA_SF9: + sf_index = 4; + break; + case LORA_SF10: + sf_index = 5; + break; + } + switch(bw){ + case LORA_BW_0400: + bw_index = 0; + break; + case LORA_BW_0800: + bw_index = 1; + break; + case LORA_BW_1600: + bw_index = 2; + break; + } + + double correction = RangingCorrectionPerSfBwGain[sf_index][bw_index][gain]; + return correction; +} + +double Sx1280RangingCorrection::ComputeRangingCorrectionPolynome(const RadioLoRaSpreadingFactors_t sf, const RadioLoRaBandwidths_t bw, const double median){ + uint8_t sf_index, bw_index; + + switch(sf){ + case LORA_SF5: + sf_index = 0; + break; + case LORA_SF6: + sf_index = 1; + break; + case LORA_SF7: + sf_index = 2; + break; + case LORA_SF8: + sf_index = 3; + break; + case LORA_SF9: + sf_index = 4; + break; + case LORA_SF10: + sf_index = 5; + break; + } + switch(bw){ + case LORA_BW_0400: + bw_index = 0; + break; + case LORA_BW_0800: + bw_index = 1; + break; + case LORA_BW_1600: + bw_index = 2; + break; + } + const RangingCorrectionPolynomes_t *polynome = RangingCorrectionPolynomesPerSfBw[sf_index][bw_index]; + double correctedValue = 0.0; + double correctionCoeff = 0; + for(uint8_t order = 0; order < polynome->order; order++){ + correctionCoeff = polynome->coefficients[order] * pow(median, polynome->order - order - 1); + correctedValue += correctionCoeff; + } + return correctedValue; +}