Cara Membuat Robot Pengikut Manusia Dengan Arduino: 3 Langkah

2025 Pengarang: John Day | [email protected]. Terakhir diubah: 2025-01-23 14:49

Manusia mengikuti robot merasakan dan mengikuti manusia

Langkah 1: Dapatkan Alat

Dapatkan alat-alat seperti: Ultrasonic sensorSensorArduino uno 4 gear motor with wheelServo Battery dan battery case Driver motor Kabel jumper Chassis

Langkah 2: Menghubungkan

Hubungkan setiap peralatan ke driver motor. Hubungkan driver motor ke arduino.

Langkah 3: Kode

#sertakan#sertakan#sertakan#tentukan KANAN A2#tentukan KIRI A3#tentukan TRIGGER_PIN A1#tentukan ECHO_PIN A0#tentukan MAX_DISTANCE 100Sonar Ping Baru(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);Motor_1Motor12_DCK(1,Motor_1Motor12_DCK),MOtor DCMotor(DCK);AF_DCMotor Motor3(3, MOTOR34_1KHZ);AF_DCMotor Motor4(4, MOTOR34_1KHZ);Servo myservo;int pos =0;void setup() { // letakkan kode pengaturan Anda di sini, untuk dijalankan sekali: Serial.begin(9600);myservo.attach(10);{untuk(pos = 90; pos <= 180; pos += 1){ myservo.write(pos); delay(15);} for(pos = 180; pos >= 0; pos-= 1) { myservo.write(pos); delay(15);}untuk(pos = 0; pos<=90; pos += 1) { myservo.write(pos); delay(15);}}pinMode(RIGHT, INPUT);pinMode(LEFT, INPUT);}void loop() { // letakkan kode utama Anda di sini, untuk dijalankan berulang kali: 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) && (jarak>=10 && jarak<=30)&&(Nilai_Kiri==1)){ Motor1.setSpeed(120); Motor1.run (MAJU); Motor2.setSpeed(120); Motor2.run (MAJU); Motor3.setSpeed(120); Motor3.run (MAJU); Motor4.setSpeed(120); Motor4.run(FORWARD);}else if((Right_Value==0) && (Left_Value==1)) { Motor1.setSpeed(200); Motor1.run (MAJU); Motor2.setSpeed(200); Motor2.run (MAJU); Motor3.setSpeed(100); Motor3.run(Mundur); Motor4.setSpeed(100); Motor4.run(BACKWARD);}else if((Right_Value==1)&&(Left_Value==0)) { Motor1.setSpeed(100); Motor1.run (Mundur); Motor2.setSpeed(100); Motor2.run (Mundur); Motor3.setSpeed(200); Motor3.run (MAJU); Motor4.setSpeed(200); Motor4.run(FORWARD);}else if((Right_Value==1)&&(Left_Value==1)) { Motor1.setSpeed(0); Motor1.run(LEPAS); Motor2.setSpeed(0); Motor2.run(LEPAS); Motor3.setSpeed(0); Motor3.run(LEPAS); Motor4.setSpeed(0); Motor4.run(RELEASE);}else if(jarak > 1 && jarak < 10) { Motor1.setSpeed(0); Motor1.run(LEPAS); Motor2.setSpeed(0); Motor2.run(LEPAS); Motor3.setSpeed(0); Motor3.run(LEPAS); Motor4.setSpeed(0); Motor4.run(LEPAS); } }