#include <stdio.h>
#include <stdint.h>
#include "ar.h"
#include "script.h"
#include "fsm.h"
#include "random.h"

extern enum ar_track_dir_e   state_trackdir[];
extern enum if_turnout_dir_e state_turnout[];
extern void monitor_dump(void);

void pr_t(void)
{
  static int t = 0;
  monitor_dump();
  printf("%d (LINE %d) ", ++t, script_st.lineno);
}

void ar_motor_off(void)
{
  pr_t();
  printf("MOTOR OFF\n"); 
}

void ar_motor_on(void)
{
  pr_t();
  printf("MOTOR ON\n"); 
}

void ar_track1_dir_set(enum ar_track_dir_e tdir)
{
  pr_t();
  if (tdir == AR_TRACK_DIR_NORMAL) {
    state_trackdir[0] = AR_TRACK_DIR_NORMAL; 
    printf("TRACK #1 DIR=NORMAL\n"); 
  } else {
    state_trackdir[0] = AR_TRACK_DIR_REVERSE; 
    printf("TRACK #1 DIR=REVERSE\n"); 
  }
}

void ar_track2_dir_set(enum ar_track_dir_e tdir)
{
  pr_t();
  if (tdir == AR_TRACK_DIR_NORMAL) {
    state_trackdir[1] = AR_TRACK_DIR_NORMAL; 
    printf("TRACK #2 DIR=NORMAL\n"); 
  } else {
    state_trackdir[1] = AR_TRACK_DIR_REVERSE; 
    printf("TRACK #2 DIR=REVERSE\n"); 
  }
}

void ar_motor_run_until(ar_speedstep_t spdstep_target,
                        ar_decp_id decpi,
                        if_sn_id sn_brake,
                        if_sn_id sn_stop)
{
  pr_t();
  printf("RUN-UNTIL SPEEDSTEP=%d DECPI=%d SNBRK=%d SNSTOP=%d\n",
         spdstep_target, decpi, sn_brake, sn_stop); 
}

void ar_motor_run_to(ar_speedstep_t spdstep_target,
                     if_sn_id sn_pass)
{
  pr_t();
  printf("RUN-TO SPEEDSTEP=%d SNPASS=%d\n",
         spdstep_target, sn_pass); 
}

int8_t ar_motor_next(void)
{
  return 0;
}

void ar_stay_start(ar_staytime_t st)
{
  pr_t();
  printf("STAY T=%d\n", st);
}

void ar_stay_abs_start(uint8_t t)
{
  pr_t();
  printf("STAY-ABS T=%d(=%.1f [SEC])\n", t, 0.1*t);
}

int8_t ar_stay_next(void)
{
  return 0;
}

void if_turnout_init(void)
{
  ;
}

int8_t if_turnout_action(if_to_id p,
                         enum if_turnout_dir_e d)
{
  pr_t();
  if (d == TURNOUT_DIR_NORMAL) {
    printf("TURNOUT #%d NORMAL\n", p); 
    state_turnout[p] = TURNOUT_DIR_NORMAL;
  } else {
    printf("TURNOUT #%d REVERSE\n", p); 
    state_turnout[p] = TURNOUT_DIR_REVERSE;
  }
}

int8_t if_sensor_get(if_sn_id sn)
{
  uint16_t r = random_get16();
  return (r & 0x01) == 0;
}

int8_t if_accessary_off(if_ac_id ac)
{
  pr_t();
  printf("ACCESSARY-OFF AC=%d\n", ac);
  return 1;
}

int8_t if_accessary_on(if_ac_id ac)
{
  pr_t();
  printf("ACCESSARY-ON AC=%d\n", ac);
  return 1;
}
