Si të bëni një robot që ndjek njerëzit me Arduino: 3 hapa

Njeriu që ndjek robotin ndjen dhe ndjek njeriun

Hapi 1: Merrni mjetet

Merrni mjetet si: Sensor tejzanor Sensor Arduino uno 4 motorë me rrota me rrota Servo Bateri dhe kuti baterie Shoferi i motorit Jumper telat Shasia

Hapi 2: Lidhja

Lidhni çdo pajisje me drejtuesin e motorit. Lidhni shoferin e motorit me arduino.

Hapi 3: Kodi

#përfshijnë#përfshijnë#përfshijnë#përcaktojnë DREJTA A2#përcaktojnë LEFT A3#përcaktojnë TRIGGER_PIN A1#përcaktojnë ECHO_PIN A0#përcaktojnë MAX_DISTANCE 100Sonar i riPing (TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); AF_DCMotor Motor1 = 1, MOTOR_MOTOR_1; AF_DCMotor Motor3 (3, MOTOR34_1KHZ); AF_DCMotor Motor4 (4, MOTOR34_1KHZ); Servo myservo; int pos = 0; void setup () {// vendosni kodin tuaj të konfigurimit këtu, për të ekzekutuar një herë: Serial.begin (9600); myservo. bashkëngjit (10); {për (pos = 90; pos <= 180; pos += 1) {myservo.shkruaj (pos); vonesë (15);} për (pos = 180; pos> = 0; pos- = 1) {myservo.shkruaj (pos); vonesë (15);} për (pos = 0; pos <= 90; pos += 1) {myservo.shkruaj (pos); vonesë (15);}} pinMode (E DREJTA, HYRJE); pinMode (LEFT, INPUT);} loop void () {// vendos kodin tuaj kryesor këtu, për të ekzekutuar në mënyrë të përsëritur: vonesë (50); int distancë e panënshkruar = sonar.ping_cm (); Serial.print ("distanca"); Serial.println (distanca); int Right_Value = digitalRead (Djathtas); int Left_Value = digitalRead (LEFT); Serial.print ("Djathtas"); Serial.println (Right_Value); Serial.print ("LEFT"); Serial.println (Left_Vale))) {Motor1.setSpeed (120); Motor1.run (PARA); Motor2.setSpeed (120); Motor2.run (PARA); Motor3.setSpeed (120); Motor3.run (PARA); Motor4.setSpeed (120); Motor4.run (PARA);} tjetër nëse ((Vlera e djathtë == 0) && (Vlera e majtë == 1)) {Motor1.setSpeed (200); Motor1.run (PARA); Motor2.setSpeed (200); Motor2.run (PARA); Motor3.setSpeed (100); Motor3.run (BACKWARD); Motor4.setSpeed (100); Motor4.run (BACKWARD);} tjetër nëse ((Right_Value == 1) && (Left_Value == 0)) {Motor1.setSpeed (100); Motor1.run (BACKWARD); Motor2.setSpeed (100); Motor2.run (BACKWARD); Motor3.setSpeed (200); Motor3.run (PARA); Motor4.setSpeed (200); Motor4.run (PARA);} tjetër nëse ((Vlera e djathtë == 1) && (Vlera e majtë == 1)) {Motor1.setSpeed (0); Motor1.run (LIRIM); Motor2.setSpeed (0); Motor2.run (LIRIM); Motor3.setSpeed (0); Motor3.run (LIRIM); Motor4.setSpeed (0); Motor4.run (LIRIM);} tjetër nëse (distanca> 1 && distanca <10) {Motor1.setSpeed (0); Motor1.run (LIRIM); Motor2.setSpeed (0); Motor2.run (LIRIM); Motor3.setSpeed (0); Motor3.run (LIRIM); Motor4.setSpeed (0); Motor4.run (LIRIM); }}