#include <FEHLCD.h>
#include <FEHIO.h>
#include <FEHUtility.h>
#include <FEHMotor.h>
int main(void)
{
FEHMotor dcmotorL(FEHMotor::Motor0);
FEHMotor dcmotorR(FEHMotor::Motor1);
ButtonBoard buttons(FEHIO::Bank3);
AnalogInputPin CdS(FEHIO::P0_0);
while(1==1)
{
if(buttons.MiddlePressed())
{
while(1==1)
{
if(CdS.Value()<0.290)
{
dcmotorL.SetPercent(50);
dcmotorR.SetPercent(50);
Sleep(1.0);
dcmotorL.SetPercent(0);
dcmotorR.SetPercent(100);
Sleep(2.5);
dcmotorL.SetPercent(50);
Sleep(0.5);
dcmotorL.SetPercent(0);
Sleep(2.5);
dcmotorL.SetPercent(50);
Sleep(1.5);
dcmotorL.SetPercent(-50);
dcmotorR.SetPercent(-50);
Sleep(0.5);
dcmotorL.SetPercent(50);
dcmotorR.SetPercent(50);
Sleep(1.0);
dcmotorL.SetPercent(-50);
dcmotorR.SetPercent(-50);
Sleep(0.5);
dcmotorL.SetPercent(50);
dcmotorR.SetPercent(50);
Sleep(1.0);
dcmotorL.SetPercent(0);
dcmotorR.SetPercent(0);
}
}
}
}
}