# Making arduino human followinf robot, code error?

**URL:** <https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059>\
**Category:** General Guidance\
**Created:** [April 13, 2021, 8:37pm UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059 "2021-04-13T20:37:10Z")\
**Posts on this page:** 8\
**Page:** 1

<div class="post-metadata">

**Author:** ![elonex](https://avatars.discourse-cdn.com/v4/letter/e/91b2a8/32.png) [@elonex](https://forum.arduino.cc/u/elonex)\
**Post date:** [April 13, 2021, 8:37pm UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059/1 "2021-04-13T20:37:11Z")

</div>

Hello, I am a newbie here, my first robot design. I have made a robot( **Arduino Uno R3 ATmega328P** + **motor shield L293D** +2 IR sensors+ 4 DC 3-6V Motors+ultrasonic sensor+9v Battery+ servomotor **SG90** ) Schematics: [Imgur: The magic of the Internet](https://imgur.com/Ilv3cBb) instead of that power supply I got an _Duracell Basic, 9V, Alkaline_ .  
The problem I have is that the motors of the robot won't spin all 4 in forward direction. They will spin 2 by 2(when I touch left or right side of the robot). Is it a Code error? Thanks!  
Code:  
moderator edit : added code tags

```
#include<NewPing.h>
#include<Servo.h>
#include<AFMotor.h>
#define RIGHT A2
#define LEFT A3
#define TRIGGER_PIN A1
#define ECHO_PIN A0
#define MAX_DISTANCE 100
  

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);

AF_DCMotor Motor1(1,MOTOR12_1KHZ);
AF_DCMotor Motor2(2,MOTOR12_1KHZ);
AF_DCMotor Motor3(3,MOTOR34_1KHZ);
AF_DCMotor Motor4(4,MOTOR34_1KHZ);

Servo myservo;
 
int pos =0;

void setup() {
  // put your setup code here, to run once:
  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() {
  // put your main code here, to run repeatedly:

  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(BACKWARD);
  Motor4.setSpeed(100);
  Motor4.run(BACKWARD);
}else if((Right_Value==1)&&(Left_Value==0)) {
  Motor1.setSpeed(100);
  Motor1.run(BACKWARD);
  Motor2.setSpeed(100);
  Motor2.run(BACKWARD);
  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);
  }
 }

```

---

<div class="post-metadata">

**Author:** ![TomGeorge](https://dub1.discourse-cdn.com/arduino/user_avatar/forum.arduino.cc/tomgeorge/32/215261_2.png) [@TomGeorge](https://forum.arduino.cc/u/TomGeorge)\
**Post date:** [April 14, 2021, 7:11am UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059/2 "2021-04-14T07:11:48Z")

</div>

Hi,  
Welcome to the forum.  
If your battery is one of the smokedetector type, then it will not have the capacity to do what you want.

Tom.... 😀 👍 ☕ 🇦🇺

 ![676](https://europe1.discourse-cdn.com/arduino/original/4X/5/d/6/5d6330abf801ed7290248ec029a94ef180a2d2a0.jpeg)

---

<div class="post-metadata">

**Author:** ![elonex](https://avatars.discourse-cdn.com/v4/letter/e/91b2a8/32.png) [@elonex](https://forum.arduino.cc/u/elonex)\
**Post date:** [April 14, 2021, 11:26am UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059/3 "2021-04-14T11:26:17Z")

</div>

Thanks a lot Tom! What if I connect 2 batteries like those in the image in parallel? Should this make enough power? Or should I change the power source?

---

<div class="post-metadata">

**Author:** ![TomGeorge](https://dub1.discourse-cdn.com/arduino/user_avatar/forum.arduino.cc/tomgeorge/32/215261_2.png) [@TomGeorge](https://forum.arduino.cc/u/TomGeorge)\
**Post date:** [April 14, 2021, 11:28am UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059/4 "2021-04-14T11:28:34Z")

</div>

Hi,  
Change power source.  
What are your motor and servo specifications?

Tom... 😀 👍 ☕ 🇦🇺

---

<div class="post-metadata">

**Author:** ![elonex](https://avatars.discourse-cdn.com/v4/letter/e/91b2a8/32.png) [@elonex](https://forum.arduino.cc/u/elonex)\
**Post date:** [April 14, 2021, 11:34am UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059/5 "2021-04-14T11:34:45Z")

</div>

SERVO MOTOR:  
Weight: 9 g

• Dimension: 22.2 x 11.8 x 31 mm approx.

• Stall torque: 1.8 kgf·cm

• Operating speed: 0.1 s/60 degree

• Operating voltage: 4.8 V (~5V)

• Dead band width: 10 μs

• Temperature range: 0 ºC – 55 º  
4 DC MOTORS:  
Voltage:3-6V  
Torque 0.8kg\*cm

- RPM: 3V:125rpm, 5V:200rpm, 6V:230rpm;
- Curent: 3V:60mA, 5V:100mA, 6V:120mA.

---

<div class="post-metadata">

**Author:** ![TomGeorge](https://dub1.discourse-cdn.com/arduino/user_avatar/forum.arduino.cc/tomgeorge/32/215261_2.png) [@TomGeorge](https://forum.arduino.cc/u/TomGeorge)\
**Post date:** [April 14, 2021, 11:42am UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059/6 "2021-04-14T11:42:19Z")

</div>

Hi,  
Try 9V worth of AA 1.5V batteries in series.  
That is 6 batteries in series.

Tom.... 😀 👍 ☕ 🇦🇺

---

<div class="post-metadata">

**Author:** ![elonex](https://avatars.discourse-cdn.com/v4/letter/e/91b2a8/32.png) [@elonex](https://forum.arduino.cc/u/elonex)\
**Post date:** [April 14, 2021, 11:43am UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059/7 "2021-04-14T11:43:05Z")

</div>

Thanks a lot for your help Tom! Have a good day!

---

<div class="post-metadata">

**Author:** ![system](https://dub1.discourse-cdn.com/arduino/user_avatar/forum.arduino.cc/system/32/1140315_2.png) [@system](https://forum.arduino.cc/u/system)\
**Post date:** [August 12, 2021, 11:43am UTC](https://forum.arduino.cc/t/making-arduino-human-followinf-robot-code-error/848059/8 "2021-08-12T11:43:32Z")

</div>

Closed on August 12, 2021, 11:43am UTC

This topic was automatically closed 120 days after the last reply. New replies are no longer allowed.
