#include <NewPing.h> //Including New Ping Library To Use Ultrasonic Sensor
#include <Servo.h> // Including Servo Library To Use Servo
int echo = 26; // Ultrasonic Sensor Echo Pin
int trigger = 28; // Ultrasonic Sensor Trigger Pin
int motorA = 12; //Motor A Direction Control
int motorB = 13; // Motor B Direction Control
int motorAS = 3; //PWM Speed Control
int motorBS = 11; //PWM Speed Control
int motorAB = 9; //PWM Speed Control
int motorBB = 8;
int speed = 200; // Defines Normal Speed
int screenpin1 = 32; // Use With Serial Screen
int screenpin2 = 34; // Use With Serial Screen
void setup() {
Serial.println("Booting Up");
delay(10);
pinMode(echo, OUTPUT);
pinMode(trigger, OUTPUT);
pinMode(motorA, OUTPUT);
pinMode(motorB, OUTPUT);
pinMode(motorAS, OUTPUT);
pinMode(motorBS, OUTPUT);
pinMode(motorAB, OUTPUT);
pinMode(motorBB, OUTPUT);
}
void loop() {
Serial.println("Welcome To My Robot");
backwards();
delay(5000);
forward();
}
/*
Chasis Direction Controls
_________________________
*/
void forward() {
Serial.println("Forward");
// Moves Chasis Forward , NO OBJECT DETECTED
digitalWrite(motorA, LOW);
digitalWrite(motorB, LOW);
digitalWrite(motorA, HIGH);
digitalWrite(motorB, HIGH);
digitalWrite(motorAS, HIGH);
digitalWrite(motorBS, HIGH);
delay(50);
}
void backwards() {
Serial.println("Back");
// Moves Chasis Forward , NO OBJECT DETECTED
digitalWrite(motorA, LOW);
digitalWrite(motorB, LOW);
digitalWrite(motorAS, HIGH);
digitalWrite(motorBS, HIGH);
delay(50);
}
void right() {
Serial.println("No Object Detected");
// Moves Chasis Forward , NO OBJECT DETECTED
digitalWrite(motorA, HIGH);
digitalWrite(motorB, HIGH);
digitalWrite(motorAS, speed);
digitalWrite(motorBS, speed);
}
void left() {
Serial.println("No Object Detected");
// Moves Chasis Forward , NO OBJECT DETECTED
digitalWrite(motorA, LOW);
digitalWrite(motorB, HIGH);
digitalWrite(motorAS, speed);
digitalWrite(motorBS, speed);
}
/*
Servo Controls
_______________
*/
void servo_left(){
}
void servo_center(){
}
void servo_right(){
}
/*
Ultrasonic Sensor Controls
__________________________
*/
void check(){
}
void look() {
}
void object_notdetected() {
}
void object_detected() {
}
I Need it to go forwards and backwards... Thank You In Advance