Robot WOnt Move!

[adruinouno111]

The robot wont move!

Code: [Select]


#include <NewPing.h>
#include <AFMotor.h>
#include <Servo.h>

// Define Sonar Sensor Pins.

#define TRIGGER_PIN  22  // Arduino pin tied to trigger pin on the ultrasonic sensor.
#define ECHO_PIN     24  // Arduino pin tied to echo pin on the ultrasonic sensor.
#define MAX_DISTANCE 200 // Maximum distance we want to ping for (in centimeters). Maximum sensor distance is rated at 400-500cm.

Servo eyes;
int pingnorm;
int pingleft;
int pingright;
int pingcenter;

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE);

// Adafruit Motor Setup (Declares Motors)
AF_DCMotor motor1(1);
AF_DCMotor motor2(2);
AF_DCMotor motor3(3);
AF_DCMotor motor4(4);

// Define Data Points

int motorspeed = 235; // MAX SPEED IS 255
int safedist = 5; // In Inches


void setup(){
  // Adafruit Motor Setup Code
  motor1.setSpeed(motorspeed);
  motor2.setSpeed(motorspeed);
  motor3.setSpeed(motorspeed);
  motor4.setSpeed(motorspeed);
  motor1.run(RELEASE);
  motor2.run(RELEASE);
  motor3.run(RELEASE);
  motor4.run(RELEASE); 

  // Servo For Ultrasonic Sensor

  eyes.attach(9);

  // Serial Communication

  Serial.begin(9600);
  // Boot Up Code
  Serial.print("Sonar Bot Booting Up");
  delay(1);
  Serial.print(".");
  delay(500);
  Serial.print(".");
  delay(500);
  Serial.print(".");
  delay(500);
  Serial.print("\nBoot Up Successful!");

}


void loop(){

  // Check In Center
  eyes.write(20);
  Serial.print("Robot Scanning Center");
  delay(100);
  Serial.print("\n.");
  delay(100);
  Serial.print("\n.");
  delay(100);
  pingnorm = sonar.ping_in();
  Serial.print("\n.");
  delay(100);

  if (pingnorm > safedist){
    Serial.print("No Object Detected\n");
    motor1.run(FORWARD);
    motor2.run(FORWARD);
    motor3.run(FORWARD);
    motor4.run(FORWARD);
  }
  else{
    motor1.run(RELEASE);
    motor2.run(RELEASE);
    motor3.run(RELEASE);
    motor4.run(RELEASE);
    Serial.print("Object Detected!\n");
    Serial.print("Scanning\n");
    // Scan Left
    eyes.write(0);
    pingright = sonar.ping_in();
    delay(1000);
    // Scan Right
    Serial.print(".");
    eyes.write(40);
    pingleft = sonar.ping_in();
    delay(1000);
    // Scan Center
    Serial.print(".");
    eyes.write(20);
    pingcenter = sonar.ping_in();
    delay(1000);
    Serial.print(".\n");

    // Decide For Best Direction

    if (pingleft > pingright){
      Serial.print("Object Detected On Right\n");
    motor1.run(FORWARD);
    motor4.run(FORWARD);
    }

    else if (pingright > pingleft){
      Serial.print("Object Detected On Left\n");
    motor2.run(FORWARD);
    motor3.run(FORWARD);
    }
  }
}








Thank You!

[holmes4]

So you have some code code you found on the net and ?1?!?

Mark

[patduino]

Hi 111,

So.... What does it do?

[JB_AU]

I'm very sure motors & servos need pins, just like i need a bed to sleep in

[Henry_Best]

I'm very sure motors & servos need pins, just like i need a bed to sleep in

The pins are all predefined in the Adafruit software <AFMotor.h>.

[Henry_Best]

The robot wont move!

Which arduino are you using? Have you checked if it's compatible with the Adafruit Motor Shield? If I remember correctly, that shield isn't fully compatible with the mega.
You'd be better off asking here:http://forums.adafruit.com/.

[PaulS]

PWM (motor speed control), the NewPing library, and the Servo library all need timers. Attaching one servo disables PWM on some pins (9 and 10 on a 328-based Arduino). Using the NewPing library disables PWM on some pins, too (I'm not sure which ones).

Which pins are your motors (via the shield) connected to?

[Henry_Best]

PWM (motor speed control), the NewPing library, and the Servo library all need timers. Attaching one servo disables PWM on some pins (9 and 10 on a 328-based Arduino). Using the NewPing library disables PWM on some pins, too (I'm not sure which ones).

Which pins are your motors (via the shield) connected to?

From the Adafruit Motor Shield FAQ:-

"What pins are not used on the motor shield?
All 6 analog input pins are available. They can also be used as digital pins (pins #14 thru 19)

Digital pin 2, and 13 are not used.

Digital pin 11: DC Motor #1 / Stepper #1 (activation/speed control)
Digital pin 3: DC Motor #2 / Stepper #1 (activation/speed control)
Digital pin 5: DC Motor #3 / Stepper #2 (activation/speed control)
Digital pin 6: DC Motor #4 / Stepper #2 (activation/speed control)
These pins are in use only if the DC/Stepper noted is in use

Digital pin 4, 7, 8 and 12 are used to drive DC motors and Stepper motors via the 74HC595 serial-to-parallel latch
All these pins are in use if any DC motors or steppers are used

Digitals pin 9: Servo #1 control
Digital pin 10: Servo #2 control
These pins are used only if that particular servo is in use."