+
+
 //this is the main code for task 6 MSRD project
 //created on 4th Oct.
 //Created by Yuhan Long

//all right reserved 
#include <TimerOne.h>
#include <stdlib.h>
#include "Task6Drivers.h"

//int BUTTON=;
//int SLOT=;



char time200 = 0;
//public char time4 = 0;

char CharReceived = 0;
int ValReceived=0;



void setup(){  
 //for setup code of pins and interrupts.
 Timer1.initialize(5000);//set the timer interrupt at 5ms
 Timer1.attachInterrupt(timerInterrupt);
 Serial.begin(115200);
 drivers.init();
 //pinMode(BUTTON, INPUT);
 //pinMode(SLOT, INPUT);

 //set other output 
}

void timerInterrupt(){
  //read switch at a granulartiy of 0.02s
  //take serial communication every 0.1s
