Here is the whole code. As of right now when I compile it I don't get any errors, so all I have to do is wire everything up and test it. Thank you again for all your help.
#include <Servo.h> // includes the servo libs
Servo LeftServo1; // name the servo
Servo RightServo2; // name the servo
int ultraSoundSignal = 7; // Ultrasound signal pin
int val = 0;
int val2 = 0;
int ultrasoundValue = 0;
int timecount = 0; // Echo counter
int ledPin = 13; // LED connected to digital pin 13
int lightSense = 2;
int headLight = 8;
void setup(){
pinMode(6,OUTPUT);
pinMode(5,OUTPUT);
LeftServo1.attach(6); // Attaches the Left Servo to PWM pin 6 on the Arduino
RightServo2.attach(5); // Attaches the Right Servo to PWM pin 5 on the Arduino
pinMode(headLight, OUTPUT);
pinMode(lightSense, INPUT);
Serial.begin(9600); // Sets the baud rate to 9600
pinMode(ledPin, OUTPUT); // Sets the digital pin as output
}
void moveServoLeftTo(int angle, int duration){
// command the servo to move to the given angle for the given number of milliseconds
LeftServo1.write(120);
for (; 120 > 0; 120 - 20){ // loop for the given number of milliseconds by subtracting 20ms each iteration
LeftServo1;// LeftServo1.refresh(); When you said remove refresh did you mean the whole thing or just .refresh() // call the service routine to move the servo
delay(20); // wait 20 milliseconds between each refresh
}
}
void moveServoRightTo(int angle, int duration){
// command the servo to move to the given angle for the given number of milliseconds
RightServo2.write(angle);
for( ; 110 > 0; 110 - 20){ // loop for the given number of milliseconds by subtracting 20ms each iteration
RightServo2; // call the service routine to move the servo
delay(20); // wait 20 milliseconds between each refresh
}
}
void loop() {
// Ping))) functions: Doing more than I need it to, I think, but code
timecount = 0;
val = 0;
pinMode(ultraSoundSignal, OUTPUT); // Switch signalpin to output
digitalWrite(ultraSoundSignal, LOW); // Send low pulse
delayMicroseconds(2); // Wait for 2 microseconds
digitalWrite(ultraSoundSignal, HIGH); // Send high pulse
delayMicroseconds(5); // Wait for 5 microseconds
digitalWrite(ultraSoundSignal, LOW); // Holdoff
pinMode(ultraSoundSignal, INPUT); // Switch signalpin to input
val = digitalRead(ultraSoundSignal); // Append signal value to val
while(val == LOW) { // Loop until pin reads a high value
val = digitalRead(ultraSoundSignal);
}
while(val == HIGH) { // Loop until pin reads a high value
val = digitalRead(ultraSoundSignal);
timecount = timecount +1; // Count echo pulse time
}
ultrasoundValue = timecount; // Append echo pulse time to ultrasoundValue
if(timecount > 0){
digitalWrite(ledPin, HIGH);
}
//delay(1);
// Servo functions: The basics
if(ultrasoundValue > 500){
moveServoLeftTo(45,50); // move the left servo to 45 degrees for 500 milliseconds
moveServoRightTo(180,50); // moveRightTo function is left as an excercise ;)
}
if(ultrasoundValue < 500){
moveServoLeftTo(180,40);
moveServoRightTo(180,40);
}
if(ultrasoundValue < 100){
moveServoLeftTo(180,100);
moveServoRightTo(45,100);
//moveServoLeftTo(45,50);
//moveServoRightTo(180,50);
}
// Headlight - Turns on when photoresistor is triggered
// Doesn't seem to work on the same circuit... not sure why yet.
/* val2 = digitalRead(lightSense); // read input value
if (val == HIGH) { // check if the input is HIGH
digitalWrite(headLight, LOW); // turn LED OFF
} else {
digitalWrite(headLight, HIGH); // turn LED ON
*/
}