/*
 * スケール/センサ距離設定 
 */
#include <xc.h>
#include <stdint.h>
#include "mcr.h"
#include "io.h"
#include "led7seg.h"
#include "config.h"
#include "defs.h"

/* 設定 */
void config_set(void)
{
  uint8_t t;
  /* 設定モード開始の表示 */
  led7seg_display_const("CNF");
  delay_ms(5000);
  for (;;) {
    CLRWDT();
    if (!SW_CONF_PUSHED()) {
      delay_ms(500);
      break;
    }
  }
  /* センサ間距離の設定 */
  for (t = 0; t < 15; t++) {
    CLRWDT();
    led7seg_display_const("   ");
    delay_ms(100);
    led7seg_display_const("SEN");
    delay_ms(400);
  }
  for (;;) {
    CLRWDT();
    read_sensor_distance();
    led7seg_display(sensor_dist_cm_str); 
    if (SW_CONF_PUSHED()) {
      delay_ms(500);
      config_sw_rel_wait();
      break;
    }
  }
  /* スケールの設定 */
  for (t = 0; t < 15; t++) {
    CLRWDT();
    led7seg_display_const("   ");
    delay_ms(100);
    led7seg_display_const("SCA");
    delay_ms(400);
  }
  for (;;) {
    CLRWDT();
    read_scale();
    led7seg_display_const(model_scale_str);
    if (SW_CONF_PUSHED()) {
      delay_ms(500);
      config_sw_rel_wait();
      break;
    }
  }
  /* 設定終了の表示 */
  for (t = 0; t < 10; t++) {
    CLRWDT();
    led7seg_display_const("   ");
    delay_ms(200);
    led7seg_display_const("...");
    delay_ms(200);
  }
}

/* 表示 */
void config_display(void) 
{
  /* センサ間距離の表示 */
  led7seg_display_const("SEN");
  delay_ms(1500);
  led7seg_display(sensor_dist_cm_str); 
  delay_ms(3000);
  /* スケールの表示 */
  led7seg_display_const("SCA");
  delay_ms(1500);
  led7seg_display_const(model_scale_str);
  delay_ms(3000);
}

/* 設定SWの解放を待機 */
void config_sw_rel_wait(void)
{
  uint8_t i = 0;
  while (i != 50) {
    CLRWDT();
    delay_ms(1);
    if (!SW_CONF_PUSHED()) {
      i++;
    } else {
      i = 0;
    }
  }
}
