Ինչպես դարձնել մարդուն հետևող ռոբոտ Arduino- ով. 3 քայլ

2024 Հեղինակ: John Day | [email protected]. Վերջին փոփոխված: 2024-01-30 09:46

Մարդը, ով հետևում է ռոբոտին, զգում և հետևում է մարդուն

Քայլ 1: Ձեռք բերեք գործիքները

Ձեռք բերեք այնպիսի գործիքներ, ինչպիսիք են.

Քայլ 2: Միացում

Միացրեք յուրաքանչյուր սարքավորում շարժիչի վարորդին: Միացրեք շարժիչի վարորդը arduino- ին:

Քայլ 3: Կոդ

#ներառել#ներառել#ներառել#սահմանել ԱIGHԱԿ A2#սահմանել ՁԱՅՆ A3#սահմանել TRIGGER_PIN A1#սահմանել ECHO_PIN A0#սահմանել MAX_DISTANCE 100NewPing սոնար (TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); AF_DCMotor Motor1); AF_DCMotor Motor3 (3, MOTOR34_1KHZ); AF_DCMotor Motor4 (4, MOTOR34_1KHZ); Servo myservo; int pos = 0; void setup () {// տեղադրել ձեր տեղադրման կոդը այստեղ ՝ մեկ անգամ գործարկելու համար. Serial.begin (9600); myservo. կցել (10); {համար (pos = 90; pos <= 180; pos += 1) {myservo.write (pos); ուշացում (15);} համար (pos = 180; pos> = 0; pos- = 1) {myservo.write (pos); ուշացում (15);} համար (pos = 0; pos <= 90; pos += 1) {myservo.write (pos); ուշացում (15);}} pinMode (IGHիշտ, Մուտք); pinMode (ԱՌԱ, ՄՏԱՈ;Մ);} void loop () {// տեղադրեք ձեր հիմնական ծածկագիրը այստեղ ՝ բազմիցս գործարկելու համար. հետաձգում (50); անստորագիր 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 (ԱՌԱARD); Motor2.setSpeed (120); Motor2.run (ԱՌԱARD); Motor3.setSpeed (120); Motor3.run (ԱՌԱARD); Motor4.setSpeed (120); Motor4.run (ԱՌԱ);} այլ դեպքում ((Right_Value == 0) && (Left_Value == 1)) {Motor1.setSpeed (200); Motor1.run (ԱՌԱARD); Motor2.setSpeed (200); Motor2.run (ԱՌԱARD); Motor3.setSpeed (100); Motor3.run (հետընթաց); Motor4.setSpeed (100); Motor4.run (BACKWARD);} այլ դեպքում ((Right_Value == 1) && (Left_Value == 0)) {Motor1.setSpeed (100); Motor1.run (BACKWARD); Motor2.setSpeed (100); Motor2.run (հետընթաց); Motor3.setSpeed (200); Motor3.run (ԱՌԱARD); Motor4.setSpeed (200); Motor4.run (ԱՌԱ);} այլ դեպքում ((Right_Value == 1) && (Left_Value == 1)) {Motor1.setSpeed (0); Motor1.run (ԹՈLEԱՐԿՈՄ); Motor2.setSpeed (0); Motor2.run (ԹՈLEԱՐԿՈՄ); Motor3.setSpeed (0); Motor3.run (ԹՈLEԱՐԿՈՄ); Motor4.setSpeed (0); Motor4.run (ԹՈLEԱՐԿՈՄ);} այլ դեպքում (հեռավորությունը> 1 && հեռավորությունը <10) {Motor1.setSpeed (0); Motor1.run (ԹՈLEԱՐԿՈՄ); Motor2.setSpeed (0); Motor2.run (ԹՈLEԱՐԿՈՄ); Motor3.setSpeed (0); Motor3.run (ԹՈLEԱՐԿՈՄ); Motor4.setSpeed (0); Motor4.run (ԹՈLEԱՐԿՈՄ); }}