Isang simpleng robot para sa mga nagsisimula

/ *
 * Code wrtitten ni Nikodem Bartnk
 * pagbisita:
 *
 * C ni Nikodem Bartnik
 * Kung mayroon kang tanong maaari kang sumulat dito:
 * /

 
// bilis ng mga motor na betwen 0 at 255, kung gusto mo maaari mo itong baguhin
int pwm_speed = 255;
// trig ng ultrasonic sensor
int trig = 12;
// echo ng ultrasonic sensor
int echo = 13;

walang pag-setup () {

  // pin para sa controller ng motor
pinMode (11, OUTPUT);
pinMode (10, OUTPUT);
pinMode (9, OUTPUT);
pinMode (6, OUTPUT);
pinMode (5, OUTPUT);
pinMode (3, OUTPUT);
// set set bilang output at echo bilang input para sa ultrasonic sensor
pinMode (trig, OUTPUT);
pinMode (echo, INPUT);

}

walang bisa na loop () {

digitalWrite (trig, LOW);
pagkaantalaMicroseconds (2);
digitalWrite (trig, HIGH);
pagkaantalaMicroseconds (5);
digitalWrite (trig, LOW);

tagal ng int = pulseIn (echo, HIGH);
int distansya = tagal / 29/2;

kung (distansya> 10) {
   // pasulong ng 100 ms
   pasulong (100);
} kung hindi man (distansya <10) {
  // paatras ng 1000ms = 1 segundo
  paatras (1000);
  // iniwan ng 1000ms = 1 segundo
   kaliwa (1000);
}
}

// function para sa pagmamaneho nang diretso
walang pasulong (int delay_time) {
  digitalWrite (11, Hataas);
  digitalWrite (10, LOW);
  
  digitalWrite (9, Hataas);
  digitalWrite (6, LOW);

  analogWrite (5, pwm_speed);
  analogWrite (3, pwm_speed);
  pagkaantala (pagkaantala_time);
}

// function para sa pagbabaligtad
walang bisa paurong (int delay_time) {
  digitalWrite (11, LOW);
  digitalWrite (10, Hataas);
  
  digitalWrite (9, LOW);
  digitalWrite (6, Hataas);

  analogWrite (5, pwm_speed);
  analogWrite (3, pwm_speed);
  pagkaantala (pagkaantala_time);
}

// function para sa pag-kaliwa
walang bisa sa kaliwa (int delay_time) {
  digitalWrite (11, Hataas);
  digitalWrite (10, LOW);
  
  digitalWrite (9, LOW);
  digitalWrite (6, LOW);

  analogWrite (5, pwm_speed);
  analogWrite (3, 0);
  pagkaantala (pagkaantala_time);
}

// function para sa pag-kanan
walang bisa (int delay_time) {
  digitalWrite (11, LOW);
  digitalWrite (10, LOW);
  
  digitalWrite (9, Hataas);
  digitalWrite (6, LOW);

  analogWrite (5, 0);
  analogWrite (3, pwm_speed);
  pagkaantala (pagkaantala_time);
}

// function para sa paghinto ng motor
walang bisa motor_stop (int delay_time) {
  
  digitalWrite (11, LOW);
  digitalWrite (10, LOW);
  
  digitalWrite (9, LOW);
  digitalWrite (6, LOW);

  analogWrite (5, 0);
  analogWrite (3, 0);
  pagkaantala (pagkaantala_time);
}