flashwrite.c

/***********************************************************************************
 * @file        flashWrite.c                                                       *
 * @author      Matt Ricci                                                         *
 * @addtogroup  RTOS                                                                     *
 *                                                                                 *
 * @{                                                                              *
 ***********************************************************************************/
 
#include "FreeRTOS.h"
#include "event_groups.h"
#include "stdbool.h"
 
#include "groups.h"
 
#include "devicelist.h"
#include "flash.h"
#include "membuff.h"
 
#include "state.h"
#include "stm32f439xx.h"
#include "flashwrite.h"
 
extern EventGroupHandle_t xTaskEnableGroup;
 
/* =============================================================================== */
void vApplicationIdleHook() {
 
  State *state = State_getState();
 
  // Write if a page is available in the buffer
  if (state->flightState >= LAUNCH && state->mem.pageReady)
    xEventGroupSetBits(xTaskEnableGroup, GROUP_TASK_ENABLE_FLASH);
}
 
/* =============================================================================== */
void vFlashBuffer(void *argument) {
  const TickType_t timeout = portMAX_DELAY;
  uint32_t pageAddr        = 0;
 
  State *state             = State_getState();
 
  Flash_t *flash           = DeviceList_getDeviceHandle(DEVICE_FLASH).device;
  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) {
      taskENTER_CRITICAL();
      // Flush data to output buffer
      bool success = state->mem.readPage(&state->mem, outBuff);
      if (success) {
        // 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();
    }
  }
}