#include "adapter_ard.h"

#include <ctime>
#include <time.h>
#include <stdio.h>
#include <math.h>
#include <iostream>

serial_c Serial;

int main(int argc, char** argv){
  setup();
  while(1){
    loop();
    printf("millis %ld\n", millis());
  }
}

long millis(){
  clock_t clk_t;
  clk_t = clock();
  long milli=clk_t * 1000 / CLOCKS_PER_SEC;
  return milli; 
}

int abs(int in){
  return abs(in);
}

void pinMode(int pin, int mode){
  printf("set pin %d in mode %d\n", pin, mode);
  printf("$pm,%d,%d",pin, mode);
}

int analogRead(int pin){
  return 69;
}

void digitalWrite(int pin, int level){
  printf("set pin %d at level %d\n", pin, level);
  printf("$dw,%d,%d", pin, level);
}

void analogWrite(int pin, int dc){
  printf("set pin %d at duty cycle %d\n", pin, dc);
  printf("$aw,%d,%d", pin, dc);
}

void serial_c::begin(int br){
  printf("started serial at %d bps\n", br);
}

void serial_c::print(std::string txt){
  std::cout << "serial : " << txt;
}

void serial_c::println(std::string txt){
  this->print(txt);
  std::cout << std::endl;
}

void serial_c::print(int nb){
  printf("serial : %d", nb);
}

void serial_c::println(int nb){
  this->print(nb);
  printf("\n");
}