Advertisement
justhrun

Servo_PCB_Shaker.ino

Jul 10th, 2015
287
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
C++ 1.00 KB | None | 0 0
  1. /*
  2. buat ngegoyang2 PCB dalam larutan FeCl3 / FerriChlorida
  3. biar gak pegel pake tangan
  4. */
  5. #include <SimpleSoftwareServo.h>
  6.  
  7. SimpleSoftwareServo servo1;
  8.  
  9. const byte servo1_pin = 1;
  10. byte pos;
  11. const byte trim_pin = 3;
  12. int trim_val = 0;
  13. byte xspeed;
  14. const byte xmin = 50;
  15. const byte xmax = 150;
  16.  
  17. void setup() {
  18.     servo1.attach(servo1_pin);
  19.     SimpleSoftwareServo::refresh();
  20.     delay(500);
  21.     servo1.write(xmin);
  22.     delay(500);
  23.     SimpleSoftwareServo::refresh();
  24.     delay(250);
  25. }
  26.  
  27. void loop() {
  28.     trim_val = analogRead(trim_pin); delay(20);
  29.     xspeed = map(trim_val,0,1023,3,13); delay(20);
  30.     for(pos = xmin; pos < xmax; pos += xspeed) {
  31.         servo1.write(pos);
  32.         SimpleSoftwareServo::refresh(); // delays ~20ms
  33.     }
  34.     servo1.write(xmax);
  35.     SimpleSoftwareServo::refresh();
  36.     delay(500);
  37.     for(pos = xmax; pos>xmin; pos -= xspeed) {                                
  38.         servo1.write(pos);
  39.         SimpleSoftwareServo::refresh(); // delays ~20ms
  40.     }
  41.     servo1.write(xmin);
  42.     SimpleSoftwareServo::refresh();
  43.     delay(500);
  44. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement