Advertisement
Guest User

Praksa_Dummy_Board

a guest
Jun 21st, 2018
72
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C 1.62 KB | None | 0 0
  1. #define trigPin 11
  2. #define echoPin 12
  3.  
  4. #define greenLED  9   // PWM PIN 9
  5. #define redLED    6   // PWM PIN 6
  6. #define yellowLED 3   // PWM PIN 3
  7.  
  8. #define potentiometer 5
  9. #define pneumatic 2
  10.  
  11.  
  12. int v1 = 1;
  13. int v1_speed = 1;
  14. float v2 = 1;
  15. float v2_speed = 0.2;
  16.  
  17. boolean pneumaticState = true;
  18. long    pneumaticDelay = 0; //keep track of the last time the pneumatic has been activated
  19.  
  20.  
  21. long    senseDelay = 0;
  22.  
  23. void setup() {
  24.   Serial.begin(115200);
  25.   pinMode(pneumatic, OUTPUT);
  26.   pinMode(trigPin, OUTPUT);
  27.   pinMode(echoPin, INPUT);
  28.   // nothing happens in setup
  29. }
  30.  
  31. void loop() {
  32.   //GREEN PWM////////////////////
  33.   analogWrite(greenLED, v1);
  34.   if (v1 <= 0 || v1 >= 255)
  35.     v1_speed = -v1_speed;
  36.   v1 += v1_speed;
  37.  
  38.   //RED PWM////////////////////
  39.   analogWrite(redLED, v2);
  40.   if (v2 <= 0 || v2 >= 255)
  41.     v2_speed = -v2_speed;
  42.   v2 += v2_speed;
  43.  
  44.   /*
  45.   if (millis() > senseDelay) {
  46.     senseDistance()logWrite(yellowLED, senseDistance());
  47.     senseDelay = millis() + 500;
  48.   }
  49.   */
  50.  
  51.   analogWrite(yellowLED, analogRead(potentiometer) / 4);
  52.  
  53.   if(millis() > pneumaticDelay) {
  54.    pneumaticState = !pneumaticState;
  55.    digitalWrite(pneumatic, pneumaticState);
  56.    pneumaticDelay = millis() + 2500;
  57.   }
  58.  
  59.  
  60.   delay(5);
  61. }
  62.  
  63. int senseDistance() {
  64.   long duration, distance;
  65.   digitalWrite(trigPin, LOW);
  66.   delayMicroseconds(20);
  67.   digitalWrite(trigPin, HIGH);
  68.   delayMicroseconds(20);
  69.   digitalWrite(trigPin, LOW);
  70.   delayMicroseconds(20);
  71.   duration = pulseIn(echoPin, HIGH);
  72.   distance = (duration / 2) / 29.1;
  73.   Serial.print("Distance: ");
  74.   Serial.println(distance);
  75.   return distance;
  76. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement