loracomm.c

/* ===================================================================== *
 *                             LORA HANDLING                             *
 * ===================================================================== */
 
#include "loracomm.h"
 
extern EventGroupHandle_t xMsgReadyGroup;
extern MessageBufferHandle_t xLoRaTxBuff;
extern EventGroupHandle_t xSystemStatusGroup;

void vLoRaTransmit(void *argument) {
  const TickType_t blockTime = portMAX_DELAY;
  uint8_t rxData[LORA_MSG_LENGTH];
 
  LoRa *lora = DeviceHandle_getHandle("LoRa").device;
 
  for (;;) {
    // Wait for SX1272 to be ready for transmission
    EventBits_t uxBits = xEventGroupWaitBits(xMsgReadyGroup, GROUP_MESSAGE_READY_LORA, pdFALSE, pdFALSE, blockTime);
    if ((uxBits & GROUP_MESSAGE_READY_LORA)) {
      // Wait to receive message in buffer
      size_t xReceivedBytes = xMessageBufferReceive(
          xLoRaTxBuff,
          (void *)rxData,
          sizeof(rxData),
          blockTime
      );
      // Transmit if message is available
      if (xReceivedBytes) {
        lora->transmit(lora, rxData);
        xEventGroupClearBits(xMsgReadyGroup, GROUP_MESSAGE_READY_LORA);
      }
    }
  }
}

void vLoRaSample(void *argument) {
  const TickType_t xFrequency = pdMS_TO_TICKS(250);
  const TickType_t blockTime  = pdMS_TO_TICKS(125);
 
  A3G4250D *gyro              = DeviceHandle_getHandle("Gyro").device;
  KX134_1211 *lAccel          = DeviceHandle_getHandle("LAccel").device;
  KX134_1211 *hAccel          = DeviceHandle_getHandle("HAccel").device;
 
  enum State *flightState     = StateHandle_getHandle("FlightState").state;
  float *altitude             = StateHandle_getHandle("Altitude").state;
  float *velocity             = StateHandle_getHandle("Velocity").state;
 
  for (;;) {
    // Block until 250ms interval
    TickType_t xLastWakeTime = xTaskGetTickCount();
    vTaskDelayUntil(&xLastWakeTime, xFrequency);
 
    uint8_t systemStatus = xEventGroupGetBits(xSystemStatusGroup);
 
    // Create AVData packet with current data
    LoRa_Packet avData = LoRa_AVData(
        LORA_HEADER_AV_DATA,
        *flightState | systemStatus,
        lAccel->rawAccelData,
        hAccel->rawAccelData,
        KX134_1211_DATA_TOTAL,
        gyro->rawGyroData,
        A3G4250D_DATA_TOTAL,
        *altitude,
        *velocity
    );
 
    // Add packet to queue
    xMessageBufferSend(xLoRaTxBuff, &avData, LORA_MSG_LENGTH, blockTime);
  }
}

void EXTI1_IRQHandler(void) {
  EXTI->PR |= (0x02);
  BaseType_t xHigherPriorityTaskWoken = pdFALSE, xResult;
 
  //
  xResult = xEventGroupSetBitsFromISR(
      xMsgReadyGroup,
      GROUP_MESSAGE_READY_LORA,
      &xHigherPriorityTaskWoken
  );
 
  if (xResult != pdFAIL)
    portYIELD_FROM_ISR(xHigherPriorityTaskWoken);
}