flashwrite.c

/***********************************************************************************
 * @file        flashWrite.c                                                       *
 * @author      Matt Ricci                                                         *
 * @addtogroup  RTOS                                                                     *
 *                                                                                 *
 * @{                                                                              *
 ***********************************************************************************/
 
#include "flashwrite.h"
 
extern EventGroupHandle_t xTaskEnableGroup;
 
/* =============================================================================== */
void vIdle(void *argument) {
 
  enum State *flightState = StateHandle_getHandle("FlightState").state;
  MemBuff *mem            = (MemBuff *)argument;
 
  for (;;) {
    // Write if a page is available in the buffer
    if (*flightState >= LAUNCH && mem->pageReady)
      xEventGroupSetBits(xTaskEnableGroup, GROUP_TASK_ENABLE_FLASH);
  }
}
 
/* =============================================================================== */
void vFlashBuffer(void *argument) {
  const TickType_t timeout = portMAX_DELAY;
  uint32_t pageAddr        = 0;
 
  W25Q128_t *flash         = DeviceList_getDeviceHandle(DEVICE_FLASH).device;
  MemBuff *mem             = (MemBuff *)argument;
  uint8_t outBuff[flash->pageSize];
 
  for (;;) {
    // Wait for write flag to be ready, clear flag on exit
    EventBits_t uxBits = xEventGroupWaitBits(xTaskEnableGroup, GROUP_TASK_ENABLE_FLASH, pdTRUE, pdFALSE, timeout);
    if (uxBits & GROUP_TASK_ENABLE_FLASH) {
      // Flush data to output buffer
      bool success = mem->readPage(mem, outBuff);
      if (success) {
        taskENTER_CRITICAL();
        // Write data to flash memory if within bounds
        if (pageAddr / flash->pageSize < flash->pageCount - 1)
          flash->writePage(flash, pageAddr, outBuff);
 
        // Increment page address
        pageAddr += 0x100;
        taskEXIT_CRITICAL();
      }
    }
  }
}