Advertisement
Guest User

Untitled

a guest
Feb 21st, 2019
74
0
Never
Not a member of Pastebin yet? Sign Up, it unlocks many cool features!
text 0.65 KB | None | 0 0
  1. int y,old_y;
  2. double duration = 0; //パルスが行って帰ってくるまでの時間
  3. double distance = 0; //距離
  4.  
  5. void setup() {
  6. Serial.begin( 9600 ); //デバッグのため
  7. //超音波センサのピン
  8. pinMode(3, INPUT);
  9. pinMode(2, OUTPUT);
  10. }
  11.  
  12. void loop() {
  13. digitalWrite(2, LOW);
  14. delayMicroseconds(2);
  15. digitalWrite(2, HIGH); //超音波出力、START
  16. delayMicroseconds( 10 );
  17. digitalWrite(2, LOW); //超音波出力、STOP
  18. duration = pulseIn(3, HIGH);
  19. if (duration > 0) {
  20. duration = duration/2;
  21. distance = duration*340*100/1000000;
  22. y = 0.9 * old_y + 0.1 * distance;
  23. Serial.println(y);
  24. old_y = y;
  25. }
  26. delay(100);
  27. }
Advertisement
Add Comment
Please, Sign In to add comment
Advertisement