Thursday, March 4, 2010

Motor Control Program

void forward ()
{
motor_ra = 0;
motor_rb = 1;
motor_la = 0;
motor_lb = 1;
}

void backward ()
{
motor_ra = 1;
motor_rb = 0;
motor_la = 1;
motor_lb = 0;
}

void left()
{
motor_la = 1;
motor_lb = 0;
motor_ra = 0;
motor_rb = 1;
}
void right()
{
motor_la = 0;
motor_lb = 1;
motor_ra = 1;
motor_rb = 0;
}

void stop()
{
motor_la = 1;
motor_lb = 1;
motor_ra = 1;
motor_rb = 1;
}

No comments:

Post a Comment