Advertisement
SonicDH

Robo-Roach Code

May 23rd, 2014
261
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 0.66 KB | None | 0 0
  1. const int motor = 9;
  2. const int sensor = A5;
  3. int sensorVal = 0;
  4. int motorVal = 0;
  5. void setup(){pinMode(motor, OUTPUT);
  6. Serial.begin(9600);}
  7. void loop(){
  8.   sensorVal = analogRead(sensor);
  9.   if (sensorVal >= 1010) //dark, full power
  10.   {
  11.     analogWrite(motor, 255);
  12.   }
  13.   else if (sensorVal <= 970) //light, stop
  14.   {
  15.     analogWrite(motor, 0);
  16.   }
  17.   else //fuzzy zone, move according to sensor readings
  18.   {
  19.     motorVal = map(sensorVal, 970, 1010, 0, 230);
  20.     analogWrite(motor, motorVal);
  21.   }
  22.  
  23.   Serial.print("sensor = " );                      
  24.   Serial.print(sensorVal);      
  25.   Serial.print("\t output = ");      
  26.   Serial.println(motorVal);
  27. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement