#include "stdio.h"
#include "stdlib.h"

int main() {
  printf("AutoPlow starting...\n\n");

  printf("Attempting to set proper device configuration on ARD1\n");
  system("stty -F /dev/ttyACM0 9600 raw -clocal -echo");

  printf("Attempting to begin serial data read on ARD1 (Motor Controller) at /dev/ttyACM0\n");
  FILE * ttyACM0;
  ttyACM0 = fopen("/dev/ttyACM0", "w+");
  if (ttyACM0) {
    printf("Successfully opened serial stream\n\n");
    printf("Attempting device reset\n");
    fputs("Restart;", ttyACM0);
    printf("Dumping contents:\n");
    char buffer[4096];
    fputs("Brakes 0;", ttyACM0);
    while (fgets(buffer, sizeof(buffer), ttyACM0) != NULL) {
      printf("Input: ");
      printf(buffer);
    }
    printf("Closing file stream\n");
    fclose(ttyACM0);
  } else {
    printf("Unsuccessful in opening serial stream. Make sure the Arduino is plugged in to the RPI.\n");
    return 1;
  }
  return 0;
}