code.c

/*
 * mBot code for Group 3a2
 *
 * Members:
 * Sungmin
 * Kishor
 * Svetha
 * Alvin
 */
#include "MeMCore.h"

//define the required variables here
int motorspeed = 100;
MeDCMotor motor_right(M1);

MeDCMotor motor_left(M2);

//move forward
void forward()
{
 motor_right.run(+motorSpeed); 
 motor_left.run(-motorSpeed);  
}

//turn right
void right_turn()
{
 motor_right.run(+motorSpeed); 
 motor_left.run(+motorSpeed);
}

//turn left
void left_turn()
{
motor_right.run(-motorSpeed); 
motor_left.run(-motorSpeed);  
}

//detect black strip
bool black_strip()
{
  //stop
  //play tune
  //stop arduino from moving
}

//ultrasound(distance in front)
float dist_front() {
  float dist = ;
  return dist;
}

//colour challenge
void colour_challenge(){
  //detect color 
  if (colour //parameters here) {
      red_task();
      }
      else if (//parameters){
        green_task();
        }
        else if (//parameters) {
          yellow_task();
          }
          else if(//parameters) {
            
}
//red (left turn)
void red_task(){
  left_turn();
}

//green (right turn)
void green_task(){
  right_turn()
}

//yellow (U-turn within same grid)
void yellow_task(){
  right_turn();
  right_turn();
}

//purple (2x left in 2 grid)
void purple_task(){
  left_turn();
  while(dist_front() > 4) {
    //go straight
  }    
  //stop
  left_turn();
  }
}

//light blue (2x right in 2 grid)
void lightblue_task(){
  right_turn();
  while(dist_front() > 4) {
    //go straight
  }    
  //stop
 right_turn();
  }
}

//black (make noise)
void black_task(){
  
}

void setup(){
  
}

void loop() {
  forward();
  if(black_strip()){
    color_challenge();
  }
}