src/lib/StubbornReceiver/stubborn_receiver.cpp

   1 #include <cstdint>
   2 #include "stubborn_receiver.h"
   3
   4 StubbornReceiver::StubbornReceiver(uint8_t maxPackageIndex)
   5 {
   6     this->maxPackageIndex = maxPackageIndex;
   7     this->ResetState();
   8 }
   9
  10 void StubbornReceiver::ResetState()
  11 {
  12     data = 0;
  13     bytesPerCall = 1;
  14     currentOffset = 0;
  15     currentPackage = 0;
  16     length = 0;
  17     telemetryConfirm = false;
  18 }
  19
  20 bool StubbornReceiver::GetCurrentConfirm()
  21 {
  22     return telemetryConfirm;
  23 }
  24
  25 void StubbornReceiver::SetDataToReceive(uint8_t maxLength, uint8_t* dataToReceive, uint8_t bytesPerCall)
  26 {
  27     length = maxLength;
  28     data = dataToReceive;
  29     currentPackage = 1;
  30     currentOffset = 0;
  31     finishedData = false;
  32     this->bytesPerCall = bytesPerCall;
  33 }
  34
  35 void StubbornReceiver::ReceiveData(uint8_t packageIndex, volatile uint8_t* receiveData)
  36 {
  37     if  (packageIndex == 0 && currentPackage > 1)
  38     {
  39         finishedData = true;
  40         telemetryConfirm = !telemetryConfirm;
  41         return;
  42     }
  43
  44     if (packageIndex == maxPackageIndex)
  45     {
  46         telemetryConfirm = !telemetryConfirm;
  47         currentPackage = 1;
  48         currentOffset = 0;
  49         finishedData = false;
  50         return;
  51     }
  52
  53     if (finishedData)
  54     {
  55         return;
  56     }
  57
  58     if (packageIndex == currentPackage)
  59     {
  60         for (uint8_t i = 0; i < bytesPerCall; i++)
  61         {
  62             data[currentOffset++] = *(receiveData + i);
  63         }
  64
  65         currentPackage++;
  66         telemetryConfirm = !telemetryConfirm;
  67         return;
  68     }
  69
  70     return;
  71 }
  72
  73 bool StubbornReceiver::HasFinishedData()
  74 {
  75     return finishedData;
  76 }
  77
  78 void StubbornReceiver::Unlock()
  79 {
  80     if (finishedData)
  81     {
  82         currentPackage = 1;
  83         currentOffset = 0;
  84         finishedData = false;
  85     }
  86 }