Arduino -тэй хүн дагасан роботыг хэрхэн яаж хийх вэ: 3 алхам

2024 Зохиолч: John Day | [email protected]. Хамгийн сүүлд өөрчлөгдсөн: 2024-01-30 11:01

Хүн роботыг дагаж, хүнийг дагадаг

Алхам 1: Багаж хэрэгслийг авах

Дараахь хэрэгслүүдийг аваарай: Хэт авианы мэдрэгч SensorArduino uno 4 дугуйтай моторServo Батерей ба батерейны хайрцаг

Алхам 2: Холболт

Тоног төхөөрөмж бүрийг мотор драйвертай холбож, мотор драйверийг arduino руу холбоно уу.

Алхам 3: Код

#оруулах#оруулах#оруулах#ЗӨВ А2 тодорхойлох#Зүүн ХАГААРАА тодорхойлох A3#TRIGGER_PIN A1 тодорхойлох#ECHO_PIN A0 тодорхойлох#MAX_DISTANCE 100NewPing sonar (TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); AF_DCMotor Motor1 (1, MOTOR12_Motor); AF_DCMotor Motor3 (3, MOTOR34_1KHZ); AF_DCMotor Motor4 (4, MOTOR34_1KHZ); Servo myservo; int pos = 0; void setup () {// нэг удаа ажиллуулахын тулд тохиргооны кодоо энд оруулна уу: Serial.begin (9600); myservo.attach (10); {for (pos = 90; pos <= 180; pos += 1) {myservo.write (pos); саатал (15);} for (pos = 180; pos> = 0; pos- = 1) {myservo.write (pos); саатал (15);} for (pos = 0; pos <= 90; pos += 1) {myservo.write (pos); delay (15);}} pinMode (RIGHT, INPUT); pinMode (LEFT, INPUT);} void loop () {// давтан ажиллуулахын тулд үндсэн кодоо энд оруулна уу: delay (50); гарын үсэггүй int зай = sonar.ping_cm (); Serial.print ("зай"); Serial.println (зай); int Right_Value = digitalRead (ЗӨВ); int Left_Value = digitalRead (LEFT); Serial.print ("ЗӨВ"); Serial.println (Right_Value); Serial.print ("LEFT"); Serial.println (Left_Value); if ((Right_Value == 1) && (зай> = 10 && зай <= 30) && (Left_Value == 1))) {Motor1.setSpeed (120); Мотор 1. ажиллуулах (урагш); Motor2.setSpeed (120); Motor2.run (FORWARD); Motor3.setSpeed (120); Мотор 3. гүйх (урагш); Motor4.setSpeed (120); Motor4.run (FORWARD);} if if ((Right_Value == 0) && (Left_Value == 1)) {Motor1.setSpeed (200); Мотор 1. ажиллуулах (урагш); Motor2.setSpeed (200); Motor2.run (FORWARD); Motor3.setSpeed (100); Motor3.run (BACKWARD); Motor4.setSpeed (100); Motor4.run (BACKWARD);} if if ((Right_Value == 1) && (Left_Value == 0)) {Motor1.setSpeed (100); Мотор 1. ажиллуулах (Буцах); Motor2.setSpeed (100); Motor2.run (BACKWARD); Motor3.setSpeed (200); Мотор 3. гүйх (урагш); Motor4.setSpeed (200); Motor4.run (FORWARD);} if 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 (зай> 1 && зай <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); }}