/*
  Copyright (c) 2016-2020 Peter Antypas

  This file is part of the MAIANA™ transponder firmware.

  The firmware is free software: you can redistribute it and/or modify
  it under the terms of the GNU General Public License as published by
  the Free Software Foundation, either version 3 of the License, or
  (at your option) any later version.

  This program is distributed in the hope that it will be useful,
  but WITHOUT ANY WARRANTY; without even the implied warranty of
  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  GNU General Public License for more details.

  You should have received a copy of the GNU General Public License
  along with this program.  If not, see <https://www.gnu.org/licenses/>
*/

#include "stm32l4xx_hal.h"
#include "RadioManager.hpp"
#include "RXPacketProcessor.hpp"
#include "DataTerminal.hpp"
#include "TXScheduler.hpp"
#include "GPS.hpp"
#include "SystickTimer.hpp"
#include "CommandProcessor.hpp"
#include "bsp.hpp"
#include "printf_serial.h"
#include "FreeRTOS.h"
#include "task.h"

void fireTestPacket()
{
  VHFChannel channel = CH_87;
  if ( rand() % 2 == 0 )
    channel = CH_88;

  TXPacket *p = TXPacketPool::instance().newTXPacket(channel);
  if ( !p ) {
      //DBG("Ooops! Out of TX packets :(\r\n");
      return;
  }

  /**
   * Define a dummy packet of 9600 random bits, so it will take 1 second to transmit it.
   * This is long enough for most spectrum analyzers to capture details using "max hold",
   * even at very low resolution bandwidths. Great way to measure power and look for
   * spurious emissions as well as harmonics.
   */
  p->configureForTesting(channel, 9600);

  RadioManager::instance().sendTestPacketNow(p);
}

void determineCauseOfReset()
{
  std::string cause;
  if ( __HAL_RCC_GET_FLAG(RCC_FLAG_IWDGRST) )
    cause += "Watchdog, ";
  if ( __HAL_RCC_GET_FLAG(RCC_FLAG_SFTRST) )
    cause += "Software, ";
  if ( __HAL_RCC_GET_FLAG(RCC_FLAG_BORRST) )
    cause += "Brownout";

  //DBG("Cause of reset: %s\r\n", cause.c_str());
  __HAL_RCC_CLEAR_RESET_FLAGS();
}


void mainTask(void *params)
{
  EventQueue::instance().init();
  //EventPool::instance().init();
  Configuration::instance().init();
  CommandProcessor::instance().init();
  DataTerminal::instance().init();

  RXPacketProcessor packetProcessor;

  SystickTimer::instance();


#if not defined CALIBRATION_MODE && not defined TX_TEST_MODE
  GPS::instance().init();
  GPS::instance().enable();
#endif


#ifdef ENABLE_TX
  TXPacketPool::instance().init();
  TXScheduler::instance().init();
#endif

#if defined CALIBRATION_MODE
  RadioManager::instance().init();
  RadioManager::instance().transmitCW(CH_87);

  HAL_Delay(1000);
  RadioManager::instance().start();
#elif defined TX_TEST_MODE
  TXPacketPool::instance().init();
  RadioManager::instance().init();
  RadioManager::instance().start();

  // Throttle here to avoid continuous transmission in case we enter a reset loop
  HAL_Delay(400);
  fireTestPacket();
#else
  RadioManager::instance().init();
  RadioManager::instance().start();
#endif

  uint32_t counter = 0;

  bsp_start_wdt();

  // We're getting a very high rate of interrupts, so there's no need to dispatch events every time
  while (1)
    {
      __WFI();
      ++counter;
      if ( counter % 20 == 0 )
        {
          counter = 1;
          bsp_refresh_wdt();
          EventQueue::instance().dispatch();
        }
    }
}

int main(void)
{
  bsp_hw_init();

  TaskHandle_t xHandle;
  xTaskCreate(mainTask, "main", 1024u, NULL, 5, &xHandle);
  xPortStartScheduler();

#if 0

  EventQueue::instance().init();
  EventPool::instance().init();
  Configuration::instance().init();
  CommandProcessor::instance().init();
  DataTerminal::instance().init();

  RXPacketProcessor packetProcessor;

  SystickTimer::instance();


#if not defined CALIBRATION_MODE && not defined TX_TEST_MODE
  GPS::instance().init();
  GPS::instance().enable();
#endif


#ifdef ENABLE_TX
  TXPacketPool::instance().init();
  TXScheduler::instance().init();
#endif

#if defined CALIBRATION_MODE
  RadioManager::instance().init();
  RadioManager::instance().transmitCW(CH_87);

  HAL_Delay(1000);
  RadioManager::instance().start();
#elif defined TX_TEST_MODE
  TXPacketPool::instance().init();
  RadioManager::instance().init();
  RadioManager::instance().start();

  // Throttle here to avoid continuous transmission in case we enter a reset loop
  HAL_Delay(400);
  fireTestPacket();
#else
  RadioManager::instance().init();
  RadioManager::instance().start();
#endif

  uint32_t counter = 0;

  bsp_start_wdt();

  // We're getting a very high rate of interrupts, so there's no need to dispatch events every time
  while (1)
    {
      __WFI();
      ++counter;
      if ( counter % 20 == 0 )
        {
          counter = 1;
          bsp_refresh_wdt();
          EventQueue::instance().dispatch();
        }
    }
#endif

}