void setup () {
for(int i=8;i<14;i++)
{pinMode (i, OUTPUT);}
}
void left_speed ( int speed ) {
// TODO : Implement your code here
if( speed > 0)
{
digitalWrite (8,HIGH);
digitalWrite (11,LOW);
analogWrite (9 , speed) ;
}
else
{
speed = 0 - speed ;
digitalWrite (8 , LOW ) ;
digitalWrite (11 , HIGH ) ;
analogWrite (9 , speed) ;
}
}
void right_speed ( int speed ) {
// TODO : Implement your code here
if( speed > 0)
{
digitalWrite (13,HIGH);
digitalWrite (12,LOW);
analogWrite (10 , speed) ;
}
else
{
speed = 0 - speed ;
digitalWrite (13 , LOW ) ;
digitalWrite (12 , HIGH ) ;
analogWrite (10 , speed) ;
}
}
void forward (int speed ) {
// TODO
right_speed(speed);
left_speed(speed);
}
void backward (int speed ) {
// TODO
if(speed>0){speed=-speed;}
right_speed(speed);
left_speed(speed);
}
void turnleft (int speed ) {
// TODO
right_speed(speed);
left_speed(0);
}
void turnright (int speed ) {
// TODO
right_speed(0);
left_speed(speed);
}
void loop ()
{
forward(100);
delay(2000);
backward(100);
delay(2000);
turnleft(100);
delay(2000);
turnright(100);
delay(2000);
}