// Tarkista mitkä ovat pinnien numerot sinun tapauksessai!!!
int motor_oikea_nopeuspin = 5;
int motor_oikea_pin1 = 6;
int motor_oikea_pin2 = 7;

int motor_vasen_pin1 = 8;
int motor_vasen_pin2 = 9;
int motor_vasen_nopeuspin = 10;

void setup() {
  pinMode(motor_oikea_pin1, OUTPUT);
  pinMode(motor_oikea_pin2, OUTPUT);
  pinMode(motor_vasen_pin1, OUTPUT);
  pinMode(motor_vasen_pin2, OUTPUT);
  pinMode(motor_vasen_nopeuspin, OUTPUT);
  pinMode(motor_oikea_nopeuspin, OUTPUT);
}

void loop() {
 // testaa täällä alla olevia moottorinohjausfunktioita

 seis();            // pysähdy
 eteen(200);        // aja eteenpäion nopeudella 160...   
 delay(500);        // ...puolen sekunnin ajan (500 ms)
 seis();            // pysähdy
 oikealle(255);     // käänny oikealle täydellä nopeudella...
 delay(600);        // ...600 ms ajan
 seis();            // pysähdy
 vasemmalle(255);   // nyt käännytään vasemmalle...
 delay(600);        //...600 ms ajan  
 seis();
 taakse(150);        //peruutetaan       
 delay(1000);        //sekunnin ajan
 seis();             // pysäyhdy


  while(1);
 
}


void seis() {
  digitalWrite(motor_oikea_pin1, LOW);
  digitalWrite(motor_oikea_pin2, LOW); 
  digitalWrite(motor_vasen_pin1, LOW);
  digitalWrite(motor_vasen_pin2, LOW); 
}

void eteen(int nopeus) {
  digitalWrite(motor_oikea_pin1,HIGH);
  digitalWrite(motor_oikea_pin2, LOW);
  digitalWrite(motor_vasen_pin1, HIGH);
  digitalWrite(motor_vasen_pin2, LOW);
  analogWrite(motor_oikea_nopeuspin, nopeus);
  analogWrite(motor_vasen_nopeuspin, nopeus);
}

void taakse(int nopeus) {
  digitalWrite(motor_oikea_pin1,LOW);
  digitalWrite(motor_oikea_pin2, HIGH);
  digitalWrite(motor_vasen_pin1, LOW);
  digitalWrite(motor_vasen_pin2, HIGH);
  analogWrite(motor_oikea_nopeuspin, nopeus);
  analogWrite(motor_vasen_nopeuspin, nopeus);
}

void oikealle(int nopeus) {
  analogWrite(motor_vasen_nopeuspin, nopeus); 
  digitalWrite(motor_oikea_nopeuspin, LOW); 
  digitalWrite(motor_vasen_pin1, HIGH);
  digitalWrite(motor_vasen_pin2, LOW);
}

void vasemmalle(int nopeus) {
  digitalWrite(motor_vasen_nopeuspin, LOW); 
  analogWrite(motor_oikea_nopeuspin, nopeus); 
  digitalWrite(motor_oikea_pin1, HIGH);
  digitalWrite(motor_oikea_pin2, LOW);
}