Stensat StenBOT Rover Kit, Manual

Page: 139 / 180

139 139
Testing the Motors
●
To operate the motors, A1 or A2 need to be
set high or low.
●
Operation is simple if A1 and A2 are set off,
the motors do not operate.
●
If A1 is set high and A2 is low, the motors will
turn one direction.
●
If A1 is low and A2 is high, the motors will turn
in the opposite direction.
●
The same applies for B1 and B2.
●
Enter the program on the right to turn the
motors on.
●
See which way the wheels are turning and
swap the motor pins if needed to make the
wheels spin forward.
●
These pin settings will be used for forward
motion.
void setup()
{
pinMode(6,OUTPUT);
pinMode(9,OUTPUT);
pinMode(10,OUTPUT);
pinMode(11,OUTPUT);
}
void loop()
{
digitalWrite(6,HIGH);
digitalWrite(9,LOW);
digitalWrite(10,HIGH);
digitalWrite(11,LOW);
delay(5000);
digitalWrite(6,LOW);
digitalWrite(10,LOW);
delay(2000);
}