Egy egyszerű robot kezdőknek

/ *
 * A kódot Nikodem Bartnk írta
 * látogatás:
 *
 * C, Nikodem Bartnik
 * Ha kérdése van, írhat ide:
 * /

 
// A motorok 0 és 255 közötti sebessége, ha úgy tetszik, megváltoztathatja
int pwm_speed = 255;
// ultrahangos érzékelő triggerje
int trig = 12;
// az ultrahangos érzékelő visszhangja
int visszhang = 13;

érvénytelen beállítás () {

  // a motorvezérlő csapjai
pinMode (11, OUTPUT);
pinMode (10, OUTPUT);
pinMode (9, OUTPUT);
pinMode (6, OUTPUT);
pinMode (5, OUTPUT);
pinMode (3, OUTPUT);
// állítsa be a trig értéket kimenetként és visszhangot bemenetként az ultrahangos érzékelőhöz
pinMode (trig, OUTPUT);
pinMode (visszhang, INPUT);

}

void loop () {

digitalWrite (trig, LOW);
késleltetésMikrosekundumok (2);
digitalWrite (trig, HIGH);
késleltetésMikrosekundumok (5);
digitalWrite (trig, LOW);

int idő = pulseIn (visszhang, HIGH);
int távolság = időtartam / 29/2;

if (távolság> 10) {
   // lépés előre 100 ms-val
   előre (100);
} máshol, ha (távolság <10) {
  // hátra 1000 ms-rel = 1 másodperc
  hátra (1000);
  // balra 1000 ms = 1 másodperc
   balra (1000);
}
}

// egyenes vezetés funkciója
érvénytelen előre (int késés_idő) {
  digitalWrite (11, HIGH);
  digitalWrite (10, LOW);
  
  digitalWrite (9, HIGH);
  digitalWrite (6, LOW);

  analoWrite (5, pwm_speed);
  analoWrite (3, pwm_speed);
  késés (késleltetési idő);
}

// fordított funkció
érvénytelen visszafelé (int késés_idő) {
  digitalWrite (11, LOW);
  digitalWrite (10, HIGH);
  
  digitalWrite (9, LOW);
  digitalWrite (6, HIGH);

  analoWrite (5, pwm_speed);
  analoWrite (3, pwm_speed);
  késés (késleltetési idő);
}

// balra fordulás funkció
érvénytelen marad (int késés_idő) {
  digitalWrite (11, HIGH);
  digitalWrite (10, LOW);
  
  digitalWrite (9, LOW);
  digitalWrite (6, LOW);

  analoWrite (5, pwm_speed);
  analogWrite (3, 0);
  késés (késleltetési idő);
}

// jobbra fordulás funkció
semmi jobb (int késés_idő) {
  digitalWrite (11, LOW);
  digitalWrite (10, LOW);
  
  digitalWrite (9, HIGH);
  digitalWrite (6, LOW);

  analogWrite (5, 0);
  analoWrite (3, pwm_speed);
  késés (késleltetési idő);
}

// funkció a motorok leállításához
void motors_stop (int késleltetési idő) {
  
  digitalWrite (11, LOW);
  digitalWrite (10, LOW);
  
  digitalWrite (9, LOW);
  digitalWrite (6, LOW);

  analogWrite (5, 0);
  analogWrite (3, 0);
  késés (késleltetési idő);
}