XL-MaxSonar MB1260 高度計のテストプログラムです。
Dependencies: mbed
main.cpp@1:29f4aa7418eb, 2016-12-02 (annotated)
- Committer:
- tsumagari
- Date:
- Fri Dec 02 09:56:09 2016 +0000
- Revision:
- 1:29f4aa7418eb
- Parent:
- 0:ee1032401c3e
???????;
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
tsumagari | 0:ee1032401c3e | 1 | #include "mbed.h" |
tsumagari | 0:ee1032401c3e | 2 | |
tsumagari | 0:ee1032401c3e | 3 | Serial pc(USBTX,USBRX); |
tsumagari | 0:ee1032401c3e | 4 | Timer sonerTimer; |
tsumagari | 0:ee1032401c3e | 5 | InterruptIn sonerPin(p22); |
tsumagari | 0:ee1032401c3e | 6 | double sonerDistTime=0; |
tsumagari | 0:ee1032401c3e | 7 | |
tsumagari | 0:ee1032401c3e | 8 | void sonerInterruptStart(){ |
tsumagari | 0:ee1032401c3e | 9 | sonerTimer.start(); |
tsumagari | 0:ee1032401c3e | 10 | } |
tsumagari | 0:ee1032401c3e | 11 | void sonerInterruptStop(){ |
tsumagari | 0:ee1032401c3e | 12 | sonerTimer.stop(); |
tsumagari | 0:ee1032401c3e | 13 | sonerDistTime = sonerTimer.read_us(); |
tsumagari | 0:ee1032401c3e | 14 | sonerTimer.reset(); |
tsumagari | 0:ee1032401c3e | 15 | } |
tsumagari | 0:ee1032401c3e | 16 | |
tsumagari | 0:ee1032401c3e | 17 | int main() { |
tsumagari | 0:ee1032401c3e | 18 | sonerPin.rise(&sonerInterruptStart); |
tsumagari | 0:ee1032401c3e | 19 | sonerPin.fall(&sonerInterruptStop); |
tsumagari | 0:ee1032401c3e | 20 | while(1) { |
tsumagari | 0:ee1032401c3e | 21 | pc.printf("DistTime: %f\n\r",sonerDistTime); |
tsumagari | 1:29f4aa7418eb | 22 | pc.printf("CalculatedDist: %f\n\r",sonerDistTime*0.017262 + 2.1727); |
tsumagari | 0:ee1032401c3e | 23 | wait(0.5); |
tsumagari | 0:ee1032401c3e | 24 | } |
tsumagari | 0:ee1032401c3e | 25 | } |