XL-MaxSonar MB1260 高度計のテストプログラムです。
Dependencies: mbed
main.cpp@0:ee1032401c3e, 2016-11-30 (annotated)
- Committer:
- tsumagari
- Date:
- Wed Nov 30 11:43:17 2016 +0000
- Revision:
- 0:ee1032401c3e
- Child:
- 1:29f4aa7418eb
XL-MaxSonar MB1260 ???????????????
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 | 0:ee1032401c3e | 22 | pc.printf("CalculatedDist: %f\n\r",sonerDistTime/58.0); |
tsumagari | 0:ee1032401c3e | 23 | wait(0.5); |
tsumagari | 0:ee1032401c3e | 24 | } |
tsumagari | 0:ee1032401c3e | 25 | } |