Navigasi2.ino

/* Mode Navigasi 2*/
/* Bergerak maju, berbelok dengan berotasi*/
/* Inputs */
#define FS 2
#define BS 3
#define LS 4
#define RS 5
/* Outputs */
#define RM 6
#define LM 7
int robotDirection=0;
/* Robot Direction
 *  East  0
 *  North 1
 *  West  2
 *  South 3
*/
void setup() {
  pinMode(FS,INPUT);
  pinMode(BS,INPUT);
  pinMode(LS,INPUT);
  pinMode(RS,INPUT);
  pinMode(RM,OUTPUT);
  pinMode(LM,OUTPUT);
}

void loop() {
  

}
boolean isRightOpen(){
  
}
boolean isLeftOpen(){

}
boolean isFrontOpen(){

}

void moveForward(){
  
}
void turnRight(){

}
void turnLeft(){
   
}
void turnAround(){
  
}