/*-------------------------------------------------------
 * パワーパック関係  諸関数
 *-------------------------------------------------------*/
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "mcr-motor.h"
#include "adc.h"
#include "io.h"
#include "pp.h"
#include "pp-const.h"

/* パラメータ値 */
volatile uint16_t  p_speed  = 0;
volatile uint16_t  p_sbfreq = 0;
volatile uint16_t  p_sbpwdt = 0;
volatile uint16_t  p_accel  = 0;
volatile uint16_t  p_decel  = 0;
volatile uint16_t  p_vmax   = 0;
volatile uint16_t  p_light  = 0;

/*-------------------------------------------------------
 * ADC 読み取り 
 *-------------------------------------------------------*/
uint16_t pp_adc_read(adc_ch_t ch)
{
  /* ADC値が十分小さければ値0とみなす
   * (可変抵抗器が厳密に0オームにならない場合への対応) */
  adc_val_t v = ADC_Read(ch);
  if (v < ADC_MARGIN) {
    v = 0;
  } else {
    v = v - ADC_MARGIN;
  }
  return (uint16_t)v;
}

/*------------------------------------------------------- 
 * 各種パラメータ読み込み
 *-------------------------------------------------------*/
void pp_param_read(void)
{
  /* 設定値(生)の読み込み */
  uint16_t vr_speed  = pp_adc_read(ADC_CH_SPEED);
  uint16_t vr_sbfreq = pp_adc_read(ADC_CH_SBFREQ);
  uint16_t vr_sbpwdt = pp_adc_read(ADC_CH_SBPWDT);
  uint16_t vr_accel  = pp_adc_read(ADC_CH_ACCEL);
  uint16_t vr_decel  = pp_adc_read(ADC_CH_DECEL);
  uint16_t vr_vmax   = pp_adc_read(ADC_CH_VMAX);
  uint16_t vr_light  = pp_adc_read(ADC_CH_LIGHT);
  /* 割り込み禁止 */ 
  int8_t ogie  = GIE;
  int8_t opeie = PEIE;
  GIE  = 0;
  PEIE = 0;
  /* パラメータ値の決定 */
  p_speed  = vr_speed;          /* 0 .. 1023 */
  p_sbfreq = vr_sbfreq;         /* 0 .. 1023 */
  p_sbpwdt = vr_sbpwdt;         /* 0 .. 1023 */
  p_accel  = vr_accel << 1;     /* 0 .. 2047 */
  p_decel  = vr_decel << 1;     /* 0 .. 2047 */
  p_vmax   = vr_vmax;           /* 0 .. 1023 */
  p_light  = vr_light >> 2;     /* 0 ..  128 */
  /* 割り込み禁止/許可状態を復元 */ 
  GIE  = ogie;
  PEIE = opeie;
}

/*------------------------------------------------------- 
 * 走行方向SW読込
 *-------------------------------------------------------*/
enum dir_e pp_dir_read(void)
{
  enum dir_e  dir = DIR_NONE;
  if (SW_DIR1F()) {
    dir = DIR_FWD;
  } else if (SW_DIR1R()) {
    dir = DIR_REV;
  }
  return dir;
}

/*-------------------------------------------------------
 * モーター回転方向出力
 *-------------------------------------------------------*/
void pp_motor_dir_set(enum dir_e dir)
{
  switch (dir) {
  case DIR_FWD: 
    MOTOR_DIR_FWD();
    break;
  case DIR_REV:
    MOTOR_DIR_REV();
    break;
  case DIR_NONE:
    MOTOR_DIR_NONE();
    break;
  }
}

/*-------------------------------------------------------
 * 指定ミリ秒の経過を待機
 *-------------------------------------------------------*/
void pp_delay_ms(uint16_t t_msec)
{
  while (t_msec != 0) {
    CLRWDT();
    __delay_ms(1);
    t_msec--;
  }
}
