Cách tạo một robot theo sau con người với Arduino: 3 bước

2025 Tác giả: John Day | [email protected]. Sửa đổi lần cuối: 2025-01-23 15:15

Con người theo dõi cảm giác của con người và theo dõi con người

Bước 1: Nhận công cụ

Nhận các công cụ như: Cảm biến siêu âmSensorArduino no 4 động cơ bánh răng với bánh xeServo Pin và hộp đựng pin Trình điều khiển động cơ Dây nhảy khung

Bước 2: Kết nối

Kết nối mọi thiết bị với trình điều khiển động cơ. Kết nối trình điều khiển động cơ với arduino.

Bước 3: Mã

# bao gồm # bao gồm # bao gồm # xác định ĐÚNG A2 # xác định TRÁI A3 # xác định TRIGGER_PIN A1 # xác định ECHO_PIN A0 # xác định MAX_DISTANCE 100NewPing sonar (TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); AF_DCMotor Motor1 (1, MOTOR12_1KHZ); AF_DCMotor Motor2 (2CM); AF_DCMotor Motor3 (3, MOTOR34_1KHZ); AF_DCMotor Motor4 (4, MOTOR34_1KHZ); Servo myservo; int pos = 0; void setup () {// đặt mã thiết lập của bạn tại đây, để chạy một lần: Serial.begin (9600); myservo.attach (10); {for (pos = 90; pos <= 180; pos + = 1) {myservo.write (pos); delay (15);} for (pos = 180; pos> = 0; pos- = 1) {myservo.write (pos); delay (15);} for (pos = 0; pos <= 90; pos + = 1) {myservo.write (pos); delay (15);}} pinMode (RIGHT, INPUT); pinMode (LEFT, INPUT);} void loop () {// đặt mã chính của bạn ở đây, để chạy lặp lại: delay (50); unsigned int distance = sonar.ping_cm (); Serial.print ("distance"); Serial.println (distance); int Right_Value = digitalRead (RIGHT); int Left_Value = digitalRead (LEFT); Serial.print ("RIGHT"); Serial.println (Right_Value); Serial.print ("LEFT"); Serial.println (Left_Value); if ((Right_Value == 1) && (distance> = 10 && distance <= 30) && (Left_Value == 1)) {Motor1.setSpeed (120); Motor1.run (FORWARD); Motor2.setSpeed (120); Motor2.run (FORWARD); Motor3.setSpeed (120); Motor3.run (FORWARD); Motor4.setSpeed (120); Motor4.run (FORWARD);} else if ((Right_Value == 0) && (Left_Value == 1)) {Motor1.setSpeed (200); Motor1.run (FORWARD); Motor2.setSpeed (200); Motor2.run (FORWARD); Motor3.setSpeed (100); Motor3.run (PHẦN THƯỞNG); Motor4.setSpeed (100); Motor4.run (BACKWARD);} else if ((Right_Value == 1) && (Left_Value == 0)) {Motor1.setSpeed (100); Motor1.run (PHẦN THƯỞNG); Motor2.setSpeed (100); Motor2.run (PHẦN THƯỞNG); Motor3.setSpeed (200); Motor3.run (FORWARD); Motor4.setSpeed (200); Motor4.run (FORWARD);} else if ((Right_Value == 1) && (Left_Value == 1)) {Motor1.setSpeed (0); Motor1.run (RELEASE); Motor2.setSpeed (0); Motor2.run (RELEASE); Motor3.setSpeed (0); Motor3.run (RELEASE); Motor4.setSpeed (0); Motor4.run (RELEASE);} else if (distance> 1 && distance <10) {Motor1.setSpeed (0); Motor1.run (RELEASE); Motor2.setSpeed (0); Motor2.run (RELEASE); Motor3.setSpeed (0); Motor3.run (RELEASE); Motor4.setSpeed (0); Motor4.run (RELEASE); }}