Human Following Robot – Easy to Make (Step by Step in Hindi)
Human Following Robot – Easy to Make (Step by Step in Hindi)
Step 1: Components Collect Karo
Sabse pehle ye parts arrange karo:
-
Arduino Uno
-
Ultrasonic Sensor (HC-SR04)
-
IR Sensors
-
Motor Driver (L293D / L298N)
-
DC Motors(Gear) + Wheels
-
Robot Chassis
-
Battery & Connecting Wires
🔹 Step 2: Chassis Aur Motors Fit Karo
Chassis par DC motors fix karo
Wheels lagao
🔹 Step 3: Sensor Connection
Ultrasonic sensor ko robot ke front me lagao
Sensor ke pins Arduino se connect karo
(VCC, GND, Trigger, Echo)
(VCC, GND, Trigger, Echo)
Step 4: Motor Driver Connect Karo
-
Motor driver ko Arduino se connect karo (jesa ka diya gya hai digram me)
-
Motors ko motor driver ke output pins me lagao (jesa ka diya gya hai digram me)
🔹 Step 5: Arduino Programming
-
Arduino IDE open karo
-
Human following logic ka code upload karo
IS CODE KO COPY PASTE KR LO
#include <NewPing.h>
#define ULTRASONIC_SENSOR_TRIG 11
#define ULTRASONIC_SENSOR_ECHO 12
#define MAX_FORWARD_MOTOR_SPEED 75
#define MAX_MOTOR_TURN_SPEED_ADJUSTMENT 50
#define MIN_DISTANCE 10
#define MAX_DISTANCE 30
#define IR_SENSOR_RIGHT 2
#define IR_SENSOR_LEFT 3
//Right motor
int enableRightMotor=5;
int rightMotorPin1=7;
int rightMotorPin2=8;
//Left motor
int enableLeftMotor=6;
int leftMotorPin1=9;
int leftMotorPin2=10;
NewPing mySensor(ULTRASONIC_SENSOR_TRIG, ULTRASONIC_SENSOR_ECHO, 400);
void setup()
{
// put your setup code here, to run once:
pinMode(enableRightMotor, OUTPUT);
pinMode(rightMotorPin1, OUTPUT);
pinMode(rightMotorPin2, OUTPUT);
pinMode(enableLeftMotor, OUTPUT);
pinMode(leftMotorPin1, OUTPUT);
pinMode(leftMotorPin2, OUTPUT);
pinMode(IR_SENSOR_RIGHT, INPUT);
pinMode(IR_SENSOR_LEFT, INPUT);
rotateMotor(0,0);
}
void loop()
{
int distance = mySensor.ping_cm();
int rightIRSensorValue = digitalRead(IR_SENSOR_RIGHT);
int leftIRSensorValue = digitalRead(IR_SENSOR_LEFT);
//NOTE: If IR sensor detects the hand then its value will be LOW else the value will be HIGH
//If right sensor detects hand, then turn right. We increase left motor speed and decrease the right motor speed to turn towards right
if (rightIRSensorValue == LOW && leftIRSensorValue == HIGH )
{
rotateMotor(MAX_FORWARD_MOTOR_SPEED - MAX_MOTOR_TURN_SPEED_ADJUSTMENT, MAX_FORWARD_MOTOR_SPEED + MAX_MOTOR_TURN_SPEED_ADJUSTMENT );
}
//If left sensor detects hand, then turn left. We increase right motor speed and decrease the left motor speed to turn towards left
else if (rightIRSensorValue == HIGH && leftIRSensorValue == LOW )
{
rotateMotor(MAX_FORWARD_MOTOR_SPEED + MAX_MOTOR_TURN_SPEED_ADJUSTMENT, MAX_FORWARD_MOTOR_SPEED - MAX_MOTOR_TURN_SPEED_ADJUSTMENT);
}
//If distance is between min and max then go straight
else if (distance >= MIN_DISTANCE && distance <= MAX_DISTANCE)
{
rotateMotor(MAX_FORWARD_MOTOR_SPEED, MAX_FORWARD_MOTOR_SPEED);
}
//stop the motors
else
{
rotateMotor(0, 0);
}
}
void rotateMotor(int rightMotorSpeed, int leftMotorSpeed)
{
if (rightMotorSpeed < 0)
{
digitalWrite(rightMotorPin1,LOW);
digitalWrite(rightMotorPin2,HIGH);
}
else if (rightMotorSpeed > 0)
{
digitalWrite(rightMotorPin1,HIGH);
digitalWrite(rightMotorPin2,LOW);
}
else
{
digitalWrite(rightMotorPin1,LOW);
digitalWrite(rightMotorPin2,LOW);
}
if (leftMotorSpeed < 0)
{
digitalWrite(leftMotorPin1,LOW);
digitalWrite(leftMotorPin2,HIGH);
}
else if (leftMotorSpeed > 0)
{
digitalWrite(leftMotorPin1,HIGH);
digitalWrite(leftMotorPin2,LOW);
}
else
{
digitalWrite(leftMotorPin1,LOW);
digitalWrite(leftMotorPin2,LOW);
}
analogWrite(enableRightMotor, abs(rightMotorSpeed));
analogWrite(enableLeftMotor, abs(leftMotorSpeed));
}
🔹 Step 6: Power Supply Do
-
Battery connect karo
-
Check karo sab connections tight hain ya nahi
🔹 Step 7: Testing
-
Insaan robot ke aage chalo
-
Robot automatically follow karega
-
Distance kam ho to rukega, zyada ho to move karega
🔹 Step 8: Final Adjustment
-
Sensor angle adjust karo
-
Speed control set karo
-
Proper following distance fix karo
Comments
Post a Comment