#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "io.h"
#include "pp.h"
#include "fatal.h"

/*-------------------------------------------------------
 * エラー表示
 *   短時間点灯をエラーコード値の回数行い, 長時間消灯を行う 
 *-------------------------------------------------------*/
void fatal(uint8_t err)
{
  uint8_t i = 0;
  for (;;) { /* 繰返し */
    /* エラーコード値の回数だけ短時間点灯 */
    for (i = err; i != 0; i--) { 
      LED_RUN_ON();
      LED_IDLE_ON();
      LED_SENS_ON();
      pp_delay_ms(100);
      LED_RUN_OFF();
      LED_IDLE_OFF();
      LED_SENS_OFF();
      pp_delay_ms(300);
    }
    /* 消灯 (2秒) */
    pp_delay_ms(2000);
  }
}

void fatal_s(uint8_t err, uint16_t lineno,
             const char *s)
{
  fatal(err);
}

void fatal_sc(uint8_t err, uint16_t lineno,
              const char *s, char ch)
{
  fatal(err);
}

void fatal_si(uint8_t err, uint16_t lineno,
              const char *s, uint16_t i)
{
  fatal(err);
}
