After hitting the first button to start the emergency stop and following programs, it wont start. The program appears to completely stop. I am not sure what the problem is. FYI this is a line following robot.
#pragma config(Sensor, in1, lineFollowerR, sensorLineFollower)
#pragma config(Sensor, in2, lineFollowerL, sensorLineFollower)
#pragma config(Sensor, dgtl1, ultrasonic, sensorSONAR_cm)
#pragma config(Sensor, dgtl3, button, sensorTouch)
#pragma config(Sensor, dgtl4, emerge, sensorTouch)
#pragma config(Motor, port2, rightMotor, tmotorVex393_MC29, openLoop)
#pragma config(Motor, port3, leftMotor, tmotorVex393_MC29, openLoop)
#pragma config(Motor, port5, clencher, tmotorVex393_MC29, openLoop)
#pragma config(Motor, port6, arm, tmotorVex393_MC29, openLoop)
//!!Code automatically generated by ‘ROBOTC’ configuration wizard !!//
task emergency()
{
while(1==1)
{
if(SensorValue(emerge) == 1)
{
stopAllTasks();
}
wait1Msec(10);
}
}
task following()
{
while(1==1)
{
startMotor(leftMotor, 30);
startMotor(rightMotor, -30);
if(SensorValue(lineFollowerR)<1000)
{
startMotor(leftMotor, 40);
wait(.5);
}
if(SensorValue(lineFollowerL)<1000)
{
startMotor(rightMotor, -40);
wait(.5);
}
if(SensorValue(ultrasonic) < 20 && SensorValue(ultrasonic) > 1)
{
stopMotor(leftMotor);
stopMotor(rightMotor);
waitUntil(SensorValue(ultrasonic) > 20);
}
wait1Msec(10);
}
}
task main()
{
untilBump(button);
startTask(following);
startTask(emergency);
}