/*
 * Licensed under the GNU General Public License version 2 with exceptions. See
 * LICENSE file in the project root for full license information
 */

#include <kern.h>
#include <bsp.h>

#include "utypes.h"
#include "esc.h"
#include "bootstrap.h"

extern uint32_t local_boot_state;

#define GPIO_LED_RED 1 /* Dummy GPIO number, suppose to be real GPIO pin for LED */

enum led_flash
{ OFF, ON, FLICKER, BLINK, SINGLE_FLASH, DOUBLE_FLASH, INVERTED_DOUBLE_FLASH,
      TRIPLE_FLASH };

void led_handler(uint32_t led_state, uint32_t led_number)
{
   switch (led_state)
   {
      case OFF:
      {
         gpio_set (led_number, 1);
         task_delay (tick_from_ms (1000));
         break;
      }
      case ON:
      {
         gpio_set (led_number, 0);
         task_delay (tick_from_ms (1000));
         break;
      }
      case FLICKER:
      {
         gpio_set (led_number, 0);
         task_delay (tick_from_ms (50));
         gpio_set (led_number, 1);
         task_delay (tick_from_ms (50));
         break;
      }
      case BLINK:
      {
         gpio_set (led_number, 0);
         task_delay (tick_from_ms (200));
         gpio_set (led_number, 1);
         task_delay (tick_from_ms (200));
         break;
      }
      case SINGLE_FLASH:
      {
         gpio_set (led_number, 0);
         task_delay (tick_from_ms (200));
         gpio_set (led_number, 1);
         task_delay (tick_from_ms (1000));
         break;
      }
      case DOUBLE_FLASH:
      {
         gpio_set (led_number, 0);
         task_delay (tick_from_ms (200));
         gpio_set (led_number, 1);
         task_delay (tick_from_ms (200));
         gpio_set (led_number, 0);
         task_delay (tick_from_ms (200));
         gpio_set (led_number, 1);
         task_delay (tick_from_ms (1000));
         break;
      }
      case INVERTED_DOUBLE_FLASH:
      case TRIPLE_FLASH:
      default:
      {
         task_delay (tick_from_ms (1000));
         break;
      }
   }
}
void led_run (void *arg)
{

   uint16_t al_status;
   enum led_flash led_state = OFF;

   for (;;)
   {
      /* Led states according to ETG1300 IndicatorLabelingSpecification
       * RUN led task only used if not ESC pin is connected.
       */
      al_status = ESCvar.ALstatus & 0x1f;
      if (al_status & ESCop)
      {
         led_state = ON;
      }
      else if (al_status & ESCinit)
      {
         led_state = OFF;
      }
      else if (al_status & ESCpreop)
      {
         led_state = BLINK;
      }
      else if (al_status & ESCsafeop)
      {
         led_state = SINGLE_FLASH;
      }
      else if (al_status & ESCboot)
      {
         led_state = FLICKER;
      }
      else
      {
         led_state = OFF;
      }

      led_handler (led_state, GPIO_LED_RED);
   }
}

void led_error (void *arg)
{

   uint16_t al_status,al_status_code;
   enum led_flash led_state = OFF;

   for (;;)
   {
      /* Led states according to ETG1300 IndicatorLabelingSpecification */
      al_status = ESCvar.ALstatus & 0x001f;
      al_status_code = ESCvar.ALerror;

      /* Note: Flicker is defined blow aswell
       * Capture APPLICATION errors that happend during boot
       */
      if ((al_status & ESCboot) && (local_boot_state == BOOT_FAILED))
      {
         led_state = FLICKER;
      }
      /* The AL status code == No error or NO AL status Error Indication
       * of not entered the requested starte
       */
      else if (al_status_code == 0x00 || !(al_status & 0x10))
      {
         led_state = OFF;
      }
      /* 0x002D No Sync Error
       * 0x0032 PLL error
       */
      else if (al_status_code == 0x2D || al_status_code == 0x32 )
      {
         led_state = SINGLE_FLASH;
      }
      /* 0x001B SyncManager watchdog */
      else if (al_status_code == 0x1B )
      {
         led_state = DOUBLE_FLASH;
      }
      /* Booting error, Init state reached but Error Indicator bit is set
       * to 1 in Al Status
       * Application BOOT information, fail or not
       */
      else if (al_status & (ESCinit | ESCerror))
      {
         led_state = FLICKER;
      }
      /* Invalid Configuration, General configuration change
       * We'll end here at last if we got errors in ALstatus
       */
      else
      {
         led_state = BLINK;
      }
      led_handler (led_state,GPIO_LED_RED);
   }
}