רובוט פשוט למתחילים

/ *
 * קוד שנכתב על ידי ניקודם ברטנק
 * ביקור:
 *
 * ג מאת ניקודם ברטניק
 * אם יש לך שאלה תוכל לכתוב כאן:
 * /

 
// מהירות המנועים בין 0 ו- 255, אם תרצו תוכלו לשנות את זה
int pwm_speed = 255;
// טריג של חיישן קולי
int trig = 12;
// הד של חיישן קולי
הד int = 13;

הגדרת ביטול () {

  // סיכות לבקר מנוע
pinMode (11, פלט);
pinMode (10, פלט);
pinMode (9, OUTPUT);
pinMode (6, פלט);
pinMode (5, פלט);
pinMode (3, פלט);
// הגדר טריג כפלט והד ככניסה לחיישן קולי
pinMode (trig, OUTPUT);
pinMode (הד, INPUT);

}

לולאת חלל () {

digitalWrite (trig, LOW);
עיכוב מיקרו-שניות (2);
digitalWrite (trig, HIGH);
עיכוב מיקרו-שניות (5);
digitalWrite (trig, LOW);

משך זמן = דופק (הד, גבוה);
מרחק int = משך / 29/2;

אם (מרחק> 10) {
   // התקדם קדימה ב -100 מילישניות
   קדימה (100);
} אחרת אם (מרחק <10) {
  // אחורה ב 1000 מ '= שניה אחת
  אחורה (1000);
  // נשאר על ידי 1000ms = שניה אחת
   שמאל (1000);
}
}

// פונקציה לנהיגה ישר
בטל קדימה (עיכוב בזמן) {
  digitalWrite (11, HIGH);
  digitalWrite (10, נמוך);
  
  digitalWrite (9, HIGH);
  digitalWrite (6, נמוך);

  analogWrite (5, pwm_speed);
  analogWrite (3, pwm_speed);
  עיכוב (עיכוב_זמן);
}

// פונקציה להיפוך
בטל לאחור (זמן השהיה_ int) {
  digitalWrite (11, נמוך);
  digitalWrite (10, HIGH);
  
  digitalWrite (9, נמוך);
  digitalWrite (6, HIGH);

  analogWrite (5, pwm_speed);
  analogWrite (3, pwm_speed);
  עיכוב (עיכוב_זמן);
}

// פונקציה לפנייה שמאלה
בטל שמאל (זמן השהיה_ int) {
  digitalWrite (11, HIGH);
  digitalWrite (10, נמוך);
  
  digitalWrite (9, נמוך);
  digitalWrite (6, נמוך);

  analogWrite (5, pwm_speed);
  analogWrite (3, 0);
  עיכוב (עיכוב_זמן);
}

// פונקציה לפנייה ימינה
ביטול זכות (עיכוב בזמן int) {
  digitalWrite (11, נמוך);
  digitalWrite (10, נמוך);
  
  digitalWrite (9, HIGH);
  digitalWrite (6, נמוך);

  analogWrite (5, 0);
  analogWrite (3, pwm_speed);
  עיכוב (עיכוב_זמן);
}

// פונקציה לעצירת מנועים
עצור מנועים_הפסקה (זמן השהיה_ int) {
  
  digitalWrite (11, נמוך);
  digitalWrite (10, נמוך);
  
  digitalWrite (9, נמוך);
  digitalWrite (6, נמוך);

  analogWrite (5, 0);
  analogWrite (3, 0);
  עיכוב (עיכוב_זמן);
}