Arduino ilə insan izləyən bir robot necə etmək olar: 3 addım

2024 Müəllif: John Day | [email protected]. Son dəyişdirildi: 2024-01-30 07:44

İnsan robotu izləyir və insanı izləyir

Addım 1: Alətləri əldə edin

Alətləri əldə edin: Ultrasonik sensorSensorArduino uno 4 təkərli mühərriklərServo Batareya və batareya qutusu Motor sürücüsü Jumper telləri Şassi

Addım 2: Bağlantı

Hər bir cihazı motor sürücüsünə qoşun. Motor sürücüsünü arduino -ya qoşun.

Addım 3: Kod

#daxil edin#daxil edin#daxil edin#SAĞ A2 müəyyən edin#SOL A3 təyin edin#ECHO_PIN A0 təyin edin#MAX_DISTANCE 100NewPing sonar (TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); AF_DCMotor Motor1 (1, MOTOR12_MOTOR12_1); AF_DCMotor Motor3 (3, MOTOR34_1KHZ); AF_DCMotor Motor4 (4, MOTOR34_1KHZ); Servo myservo; int pos = 0; void setup () {// bir dəfə çalışmaq üçün quraşdırma kodunuzu bura qoyun: Serial.begin (9600); myservo.attach (10); {for (pos = 90; pos <= 180; pos += 1) {myservo.write (pos); gecikmə (15);} üçün (pos = 180; pos> = 0; pos- = 1) {myservo.write (pos); gecikmə (15);} üçün (pos = 0; pos <= 90; pos += 1) {myservo.write (pos); gecikmə (15);}} pinMode (SAĞ, GİRİŞ); pinMode (SOL, GİRİŞ);} void loop () {// təkrar işlətmək üçün əsas kodunuzu bura qoyun: delay (50); işarəsiz int məsafəsi = sonar.ping_cm (); Serial.print ("məsafə"); Serial.println (məsafə); int Sağ_Dəyər = digitalRead (SAĞ); int Sol_Dəyər = rəqəmsal Oxu (SOL); Serial.print ("SAĞ"); Serial.println (Sağ_Dəyər); Serial.print ("SOL"); Serial.println (Sol_Dəyər); əgər ((Sağ_Dəyər == 1) && (məsafə> = 10 və & məsafə <= 30) && (Sol_Dəyər == 1))) {Motor1.setSpeed (120); Motor1.run (İLƏ); Motor2.setSpeed (120); Motor2.run (İLƏ); Motor3.setSpeed (120); Motor3.run (İLƏ); Motor4.setSpeed (120); Motor4.run (İLƏ);} başqa halda ((Sağ_Dəyər == 0) && (Sol_Dəyər == 1)) {Motor1.setSpeed (200); Motor1.run (İLƏ); Motor2.setSpeed (200); Motor2.run (İLƏ); Motor3.setSpeed (100); Motor3.run (arxaya); Motor4.setSpeed (100); Motor4.run (BACKWARD);} başqa halda ((Sağ_Dəyər == 1) && (Sol_Dəyər == 0)) {Motor1.setSpeed (100); Motor1.run (arxaya); Motor2.setSpeed (100); Motor2.run (arxaya); Motor3.setSpeed (200); Motor3.run (İLƏ); Motor4.setSpeed (200); Motor4.run (İLƏ);} başqa halda ((Sağ_Dəyər == 1) && (Sol_Dəyər == 1)) {Motor1.setSpeed (0); Motor1.run (Çıxar); Motor2.setSpeed (0); Motor2.run (Çıxar); Motor3.setSpeed (0); Motor3.run (buraxın); Motor4.setSpeed (0); Motor4.run (Çıxar);} başqa halda (məsafə> 1 && məsafə <10) {Motor1.setSpeed (0); Motor1.run (Çıxar); Motor2.setSpeed (0); Motor2.run (Çıxar); Motor3.setSpeed (0); Motor3.run (buraxın); Motor4.setSpeed (0); Motor4.run (Çıxar); }}