Group Assignment 1

#if 1
//motor
void zmain(void)
{
    motor_start();                  // enable motor controller
    motor_forward(0,0);             // set speed to zero to stop motors

    while(SW1_Read()){
        vTaskDelay(100);
    }

    motor_forward(100,3300);
    motor_turn(200,50,350);         // First 90* turn

    motor_forward(100,2400);
    motor_turn(200,50,350);         // Second 90* turn
    motor_forward(100,2590);

    motor_turn(200,15,350);         // Slope turn
    motor_turn(200,180,900);
    motor_turn(200,35,130);
    motor_forward(100,1550);

    motor_forward(0,0);             // stop motors
    motor_stop();                   // disable motor controller

    while(true)
    {
        vTaskDelay(100);
    }
}
#endif