-#pragma config(StandardModel, “RVW SQUAREBOT”)
//+++++++++++++++++++++++++++++++++++++++++++++| MAIN |+++++++++++++++++++++++++++++++++++++++++++++++
task main()
{
wait1Msec(2500);
motor[rightMotor] = 127; //BOTTOM BL CK IS LEG IN LEG OUT
motor[leftMotor] = 127;
wait1Msec(2010);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(100);
motor[rightMotor] = -127;
motor[leftMotor] = -127;
wait1Msec(2010);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(100);
motor[rightMotor] = 127;
motor[leftMotor] = 127;
wait1Msec(2010);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(500);
motor[rightMotor] = 127; //shake it all about
motor[leftMotor] = -127;
wait1Msec(666);
motor[rightMotor] = -127;
motor[leftMotor] = 127;
wait1Msec(667);
motor[rightMotor] =127;
motor[leftMotor] = -127;
wait1Msec(667);
motor[rightMotor] = 0; //pause btw shake in and turn
motor[leftMotor] = 0;
wait1Msec(2100);
motor[rightMotor] = 127;
motor[leftMotor] = -127;
wait1Msec(2000);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(1000);
motor[rightMotor] = -127; //reset
motor[leftMotor] = -127;
wait1Msec(3000);
motor[rightMotor] = 0; //Break between leg switchdtgvnm ,
motor[leftMotor] = 0;
wait1Msec(2000);
wait1Msec(2500);
motor[rightMotor] = 127; //BOTTOM BL CK IS LEG IN LEG OUT
motor[leftMotor] = 127;
wait1Msec(2010);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(100);
motor[rightMotor] = -127;
motor[leftMotor] = -127;
wait1Msec(2010);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(100);
motor[rightMotor] = 127;
motor[leftMotor] = 127;
wait1Msec(2010);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(500);
motor[rightMotor] = 127; //shake it all about
motor[leftMotor] = -127;
wait1Msec(666);
motor[rightMotor] = -127;
motor[leftMotor] = 127;
wait1Msec(667);
motor[rightMotor] =127;
motor[leftMotor] = -127;
wait1Msec(667);
motor[rightMotor] = 0; //pause btw shake in and turn
motor[leftMotor] = 0;
wait1Msec(2100);
motor[rightMotor] = 127;
motor[leftMotor] = -127;
wait1Msec(2000);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(1000);
motor[rightMotor] = -127; //reset
motor[leftMotor] = -127;
wait1Msec(3000);
motor[rightMotor] = 0; //pause between arm leg
motor[leftMotor] = 0;
wait1Msec(2000);
motor[armMotor] = 50;
wait1Msec(1000);
motor[armMotor] = -50;
wait1Msec(1000);
motor[armMotor] = 50;
wait1Msec(1000);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(500);
motor[rightMotor] = 127; //shake it all about
motor[leftMotor] = -127;
wait1Msec(666);
motor[rightMotor] = -127;
motor[leftMotor] = 127;
wait1Msec(667);
motor[rightMotor] =127;
motor[leftMotor] = -127;
wait1Msec(667);
motor[rightMotor] = 0; //pause btw shake in and turn
motor[leftMotor] = 0;
wait1Msec(2100);
motor[rightMotor] = 127;
motor[leftMotor] = -127;
wait1Msec(2000);
motor[rightMotor] = 0; //pause
motor[leftMotor] = 0;
wait1Msec(1000);
motor[rightMotor] = -127; //reset
motor[leftMotor] = -127;
wait1Msec(3000);
}
//++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++