LineFollowNXCLegoRobot

/*Robert's labb 27/8/2013*/

#define THRESHOLD 45
#define VOL 3

task light()
{
    SetSensorLight(IN_3);
    OnFwd(OUT_AB, 40);
    while (true)
    {
        if (Sensor(IN_3) > THRESHOLD)
        {
            OnRev(OUT_B, 15);
            OnFwd(OUT_A, 15);
            Wait(100);
            until(Sensor(IN_3) < THRESHOLD); {
                OnFwd(OUT_AB, 40);
            }
        }
    }
}
task armsensor() {
    SetSensorTouch(IN_1); SetSensorTouch(IN_4); while (true)
        
    {
        if (SENSOR_1 == 1 || SENSOR_4 == 1) {
            Off(OUT_AB);
            TextOut(10,LCD_LINE1,"Calle -- Erik", true); Wait(1000);
            PlayToneEx(262,400,VOL,FALSE);  Wait(500);
            PlayToneEx(294,400,VOL,FALSE);  Wait(500);
            PlayToneEx(330,400,VOL,FALSE);  Wait(500);
            PlayToneEx(294,400,VOL,FALSE);  Wait(500);
            PlayToneEx(262,1600,VOL,FALSE); Wait(1000);
            ClearScreen();
        }
    }
}
task main() {
    Precedes(light, armsensor);
    SetSensorTouch(IN_1); SetSensorTouch(IN_4);
}