#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);
while(1==1)
{
if(buttons.MiddlePressed())
{
dcmotorL.SetPower(127);
dcmotorR.SetPower(-127);
Sleep(5.0);
dcmotorL.SetPower(25);
Sleep(2.0);
dcmotorL.SetPower(-127);
Sleep(5.0);
dcmotorL.SetPower(0);
dcmotorR.SetPower(0);
}
}
}