2/5/14 – Code (Version 1.0)

#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);
dcmotorR.SetPower(0);
dcmotorL.SetPower(0);
}
}

}

Leave a Reply

Your email address will not be published. Required fields are marked *