SHOW:
|
|
- or go back to the newest paste.
| 1 | #include <NewPing.h> | |
| 2 | #include <Servo.h> | |
| 3 | /* **************************************************************** */ | |
| 4 | ||
| 5 | Servo myservo; | |
| 6 | NewPing metr(trig_pin, echo_pin, max_distance); | |
| 7 | ||
| 8 | /* **************************************************************** */ | |
| 9 | ||
| 10 | int posit = 0; | |
| 11 | - | float distance; |
| 11 | + | |
| 12 | int trig_pin = 50; | |
| 13 | int max_distance = 300; | |
| 14 | float distance; // float může být zaměněn za int, protože knihovna umí pouze celá čísla | |
| 15 | ||
| 16 | /* **************************************************************** */ | |
| 17 | ||
| 18 | void setup() | |
| 19 | {
| |
| 20 | Serial.begin(9600); | |
| 21 | myservo.attach(30); | |
| 22 | pinMode(echo_pin, INPUT); | |
| 23 | pinMode(trig_pin, OUTPUT); | |
| 24 | } | |
| 25 | ||
| 26 | /* **************************************************************** */ | |
| 27 | ||
| 28 | void loop() | |
| 29 | {
| |
| 30 | for(posit = 0; posit <= 180; posit += 1) {
| |
| 31 | myservo.write(posit); | |
| 32 | meter(); | |
| 33 | delay(25); | |
| 34 | } | |
| 35 | ||
| 36 | for(posit = 180; posit >= 0; posit -= 1) {
| |
| 37 | myservo.write(posit); | |
| 38 | meter(); | |
| 39 | delay(25); | |
| 40 | } | |
| 41 | } | |
| 42 | ||
| 43 | /* **************************************************************** */ | |
| 44 | ||
| 45 | void meter(){
| |
| 46 | distance = metr.ping_cm(); // uloží do proměnné vzdálenost výsledek ping_cm (co měří vzdálenost) | |
| 47 | Serial.println(distance); | |
| 48 | delay(20); | |
| 49 | } |
