Lab 2

lab2
nick niemann
keith szelagowski
kevin laster

//beeper
void main()
{
    printf("Beeper Program 14\n");
    tone(500.0, 3);
    sleep(1.0);
    tone(100.0, 3);
    sleep(1.0);
    tone(1000.0, 2);
   
}

//motor
void main() {
    printf("Team 14 \nMotor Program");
   
   
    motor(0,50);
    motor(3,50);
    sleep(3.0);
   
    beep();
    bk(0);
    bk(3);
   
    motor(0,-50);
    motor(3,-50);
    sleep(2.0);
   
    beep();
    off(0);
    sleep(2.0);
   
    fd(0);
    fd(3);
    motor(0,100);
    motor(3,100);
    sleep(3.0);
    beep();
    off(0);
    off(3);
}


//sensor
void main() {
    while(1)
      {
        while (digital(11))//left
          {
            motor(3, 50);
            motor(0, -50);
            if(!digital(11))
              {
                printf("left..n");
                off(0);
                off(3);
                break;
            }
        }
       
        while (digital(9))//right
          {
            motor(0, 50);
            motor(3, -50);
            if(!digital(9))
              {
                printf("right..n");
                off(0);
                off(3);
                break;   
            }
        }
    }
}


//obstacle avoidance
void main() {
    printf("obstacle\n");
    while(!start_button());
    while(!stop_button())
      {
        fd(0);
        fd(3);
        if (digital(11))//left
          {
              bk(0);
              bk(3);
              sleep(0.5);
              motor(0, 50);
              motor(3, -50);
              sleep(0.5);
          }
       
        if (digital(9))//right
          {
              bk(0);
              bk(3);
              sleep(0.5);
              motor(3, 50);
              motor(0, -50);
              sleep(0.5);
        }
    }
    off(0);
    off(3);
}