Day 4- Add Sensor, Servo

// Example NewPing library sketch

#include <NewPing.h>

#define TRIGGER_PIN  12  // Arduino pin tied to trigger pin on the ultrasonic sensor.

#define ECHO_PIN     11  // 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.

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); // NewPing setup of pins and maximum distance.

void setup() {

 Serial.begin(115200); // Open serial monitor at 115200 baud to see ping results.

}

void loop() {

 delay(50);                     // Wait 50ms between pings (about 20 pings/sec). 29ms should be the shortest delay between pings.

 Serial.print("Ping: ");

 Serial.print(sonar.ping_cm()); // Send ping, get distance in cm and print result (0 = outside set distance range)

 Serial.println("cm");

}

const int analogPin = A0;   // pin that the sensor is attached to

const int ledPin = 13;      // pin that the LED is attached to

const int threshold = 400;  // an arbitrary threshold level that's in the range of the analog input

void setup() {

 // initialize the LED pin as an output:

 pinMode(ledPin, OUTPUT);

 // initialize serial communications:

 Serial.begin(9600);

}

void loop() {

 // read the value of the potentiometer:

 int analogValue = analogRead(analogPin);

 // if the analog value is high enough, turn on the LED:

 if (analogValue > threshold) {

   digitalWrite(ledPin, HIGH);

 } else {

   digitalWrite(ledPin, LOW);

 }

 // print the analog value:

 Serial.println(analogValue);

 delay(1);  // delay in between reads for stability

}

//Arduino Nano Car Code

// --- Pin Definitions ---

// Motor A pins (e.g., Left Motor)

const int motorA1 = 5;

const int motorA2 = 6;

// Motor B pins (e.g., Right Motor)

const int motorB1 = 9;

const int motorB2 = 10;

------------------------------------------------------------------------

#include <NewPing.h>

#define TRIGGER_PIN  12  // Arduino pin tied to trigger pin 

#define ECHO_PIN     11  // Arduino pin tied to echo pin 

#define MAX_DISTANCE 200 // Maximum distance we want to ping for 

NewPing sonar(TRIGGER_PIN, ECHO_PIN, MAX_DISTANCE); // NewPing setup of pins 

void setup() {

 Serial.begin(115200); // Open serial monitor at 115200 baud

 pinMode(motorA1, OUTPUT);

 pinMode(motorA2, OUTPUT);

 pinMode(motorB1, OUTPUT);

 pinMode(motorB2, OUTPUT);

}

void loop() {

 Serial.print("Ping: ");

 Serial.print(sonar.ping_cm()); // Send ping, get distance in cm 

 Serial.println("cm");

 moveForward();

 if (sonar.ping_cm()< 10)

// backup and turn

  {

 moveBackward();

 delay(500);

 turnLeft();

 delay(500);

  }

}

// --- Define Movement Functions ---

void moveForward() {

 // Both motors spin forward

 digitalWrite(motorA1, HIGH);

 digitalWrite(motorA2, LOW);

 digitalWrite(motorB1, HIGH);

 digitalWrite(motorB2, LOW);

}

void moveBackward() {

 // Both motors spin backward

 digitalWrite(motorA1, LOW);

 digitalWrite(motorA2, HIGH);

 digitalWrite(motorB1, LOW);

 digitalWrite(motorB2, HIGH);

}

void turnLeft() {

 // Motor A spins backward, Motor B spins forward (Tank turn)

 digitalWrite(motorA1, LOW);

 digitalWrite(motorA2, HIGH);

 digitalWrite(motorB1, HIGH);

 digitalWrite(motorB2, LOW);

}

void turnRight() {

 // Motor A spins forward, Motor B spins backward (Tank turn)

 digitalWrite(motorA1, HIGH);

 digitalWrite(motorA2, LOW);

 digitalWrite(motorB1, LOW);

 digitalWrite(motorB2, HIGH);

}

void stopCar() {

 // Setting all inputs LOW puts the DRV8833 into coast/stop mode

 digitalWrite(motorA1, LOW);

 digitalWrite(motorA2, LOW);

 digitalWrite(motorB1, LOW);

 digitalWrite(motorB2, LOW);

}

#include <Servo.h>

Servo myservo;  // create Servo object to control a servo

int potpin = A0;  // analog pin used to connect the potentiometer

int val;    // variable to read the value from the analog pin

void setup() {

 myservo.attach(9);  // attaches the servo on pin 9 to the Servo object

}

void loop() {

 val = analogRead(potpin);            // reads the value of the potentiometer (value between 0 and 1023)

 val = map(val, 0, 1023, 0, 180);     // scale it for use with the servo (value between 0 and 180)

 myservo.write(val);                  // sets the servo position according to the scaled value

 delay(15);                           // waits for the servo to get there

}