Fabrizzio and Casey Arduino Car

1inary file (no preview

1#define trigPin 12
2#define echoPin 13
3
4int n; 
5int duration,  distance;
6
7int lightPin = 0;  //define a pin for Photo resistor
8int threshold  = 250;
9
10String readString;
11
12#include <Servo.h> 
13Servo myservo1;  //  create servo object to control servo 
14Servo myservo2;
15
16void setup() {
17  Serial.begin(9600);
18  myservo1.attach(8); // assigns the servo to a pin
19  myservo2.attach(9);
20  pinMode(trigPin, OUTPUT);
21  pinMode(echoPin, INPUT);
22  pinMode(3, OUTPUT);
23    Serial.begin(9600);  //Begin serial communcation
24    pinMode(11, OUTPUT);
25   
26}
27
28void loop() {
29  digitalWrite(trigPin,  HIGH);
30  _delay_ms(500);
31  digitalWrite(trigPin, LOW);
32  duration = pulseIn(echoPin,  HIGH);
33  distance = (duration/2) / 29.1;
34        
35  if (distance < 40)  { // this is the distance which the rover has to stop
36   digitalWrite(3,HIGH);
37    myservo1.write(n); // controls the direction of the motors
38    myservo2.write(180-n);
39   delay(1000);  // how long the wheels spin
40   myservo1.write(n);
41   myservo2.write(90-n);
42   delay(500);
43}
44  else { // what the rover will do if it doen't sense anything
45   digitalWrite(3,LOW );
46    myservo1.write(180-n);
47    myservo2.write(n);
48
49     if(analogRead(lightPin) > threshold ){    
50        digitalWrite(11, HIGH);
51        Serial.println("high");
52            digitalWrite(11, HIGH); 
53delay(500);                   
54digitalWrite(11, LOW);    
55delay(50);                    
56}
57         
58    else{
59        digitalWrite(11, LOW);
60        Serial.println("low");  
61    }
62
63    delay(100);
64    ;
65}
66}  

1inary file (no preview