/***********************************************
 * 蝋燭風
 ************************************************/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "adc.h"
#include "io.h"
#include "incr-lin.h"
#include "random.h"

/*
 * 間欠カオス法による1/fゆらぎを用いて蝋燭の揺らぎを模倣
 */

/* 有限状態機械 */
enum fsm_state_e {
  STATE_Q0 = 0, /* 消灯 */
  STATE_Q1,     /* 点灯 */
};

#define CANDLE_ENV_SPEED_DX    50
#define CANDLE_ENV_SPEED_DY   512

static void     candle_init(void);
static uint16_t candle_next(uint16_t stability);
static void     intermittent_chaos_init(void);
static uint16_t intermittent_chaos_get(void);

void Light(void)
{
  /* 状態 */
  enum fsm_state_e fsm_state = STATE_Q0;
  /* 現在輝度 */
  uint16_t intensity_current = 0;
  /* 蝋燭の輝度 */
  candle_init();
  /* 主ループ */
  for (;;) {
    __delay_ms(20);
    CLRWDT();
    /* On/Offスイッチを読む */
    int8_t sw_on = SW_ON();
    /* パラメータボリュームを読む (10ビット: 0..1023) */
    adc_val_t adc_val_param = ADC_Read(ADC_CH_PARAM);
    /* 蝋燭炎安定パラメータ (0..255) */
    uint16_t stability = adc_val_param >> 2; 
    /* 輝度包絡線 */
    uint16_t intensity_enverope = 0; 
    /* 現在輝度 */
    intensity_current = candle_next(stability) >> 6;
    /* 有限状態機械 */
    switch (fsm_state) {
    case STATE_Q0: /* 消灯状態 */
      /* 消灯 */
      intensity_enverope = 0;
      /* 状態遷移 */
      if (sw_on) {
        fsm_state = STATE_Q1;
        /* 輝度包絡線 */
        incr_lin_init(0);
      }
      break;
    case STATE_Q1: /* 点灯状態 */
      /* 状態遷移 */
      if (!sw_on) {
        fsm_state = STATE_Q0;
      }
      /* 輝度包絡線計算: すこしづつ明るく */
      intensity_enverope 
        = incr_lin_next(CANDLE_ENV_SPEED_DX, CANDLE_ENV_SPEED_DY,
                        INTENSITY_MAX); 
      break;
    }
    /* 輝度出力 */
    if (intensity_current > intensity_enverope) {
      /* 輝度を包絡線で制限する */
      intensity_current = intensity_enverope;
    }
    LED_INTENSITY(intensity_current);
  }
}

static uint16_t candle_stability_t = 0;

static void candle_init(void)
{
  intermittent_chaos_init();
  candle_stability_t = 0;
}

static uint16_t candle_next(uint16_t stability)
{
  uint16_t v = 0;  /* 固定小数点数(Q0.16形式) */
  if (candle_stability_t > 0) {
    /* 現在の状態にとどまる */
    candle_stability_t--;
    /* 僅かにランダム性を入れる */
    v = 0xE000 ^ (random_get16() >> 3);  
  } else {
    /* 次の状態に移る */
    v = intermittent_chaos_get();
    if (v >= 0xF000) {
      candle_stability_t = stability;
    }
  }
  return v;
}

/* 間欠カオス - カオス状態はQ0.16形式の固定小数点数で表現 */

static uint16_t  intermittent_chaos_x = 0;

static void intermittent_chaos_init(void)
{
  intermittent_chaos_x = 0;
}

static uint16_t intermittent_chaos_get(void)
{
  uint32_t x = (uint32_t)intermittent_chaos_x;
  uint16_t v = 0;
  if (x < 0x8000) {
    x = x + ((x * x) >> (16 - 1));
  } else {
    x = x - ((0x00010000 - x) * (0x00010000 - x) >> (16 - 1));
  }
  v = (uint16_t) x & 0xFFFF;
  v = v ^ (random_get16() >> 4);  /* ランダム性を入れる */
  intermittent_chaos_x = v;
  return intermittent_chaos_x;
}
