NOT FINISHED YET!!! My first try to get a self built fully working Quadrocopter based on an mbed, a self built frame and some other more or less cheap parts.
RC/RC_Channel.cpp@12:67a06c9b69d5, 2012-10-20 (annotated)
- Committer:
- maetugr
- Date:
- Sat Oct 20 17:28:28 2012 +0000
- Revision:
- 12:67a06c9b69d5
- Parent:
- 10:953afcbcebfc
- Child:
- 15:753c5d6a63b3
mit unterbrochenem RC signal, kompass fertig mit speicherung!
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
maetugr | 7:9d4313510646 | 1 | #include "RC_Channel.h" |
maetugr | 7:9d4313510646 | 2 | #include "mbed.h" |
maetugr | 7:9d4313510646 | 3 | |
maetugr | 7:9d4313510646 | 4 | RC_Channel::RC_Channel(PinName mypin) : myinterrupt(mypin) |
maetugr | 7:9d4313510646 | 5 | { |
maetugr | 10:953afcbcebfc | 6 | time = -1; // start value to see if there was any value yet |
maetugr | 7:9d4313510646 | 7 | myinterrupt.rise(this, &RC_Channel::rise); |
maetugr | 7:9d4313510646 | 8 | myinterrupt.fall(this, &RC_Channel::fall); |
maetugr | 12:67a06c9b69d5 | 9 | //timeoutchecker.attach(this, &RC_Channel::timeoutcheck, 1); |
maetugr | 12:67a06c9b69d5 | 10 | |
maetugr | 7:9d4313510646 | 11 | } |
maetugr | 7:9d4313510646 | 12 | |
maetugr | 7:9d4313510646 | 13 | int RC_Channel::read() |
maetugr | 7:9d4313510646 | 14 | { |
maetugr | 7:9d4313510646 | 15 | return time; |
maetugr | 7:9d4313510646 | 16 | } |
maetugr | 7:9d4313510646 | 17 | |
maetugr | 7:9d4313510646 | 18 | void RC_Channel::rise() |
maetugr | 7:9d4313510646 | 19 | { |
maetugr | 7:9d4313510646 | 20 | timer.start(); |
maetugr | 12:67a06c9b69d5 | 21 | LEDs.set(2); |
maetugr | 7:9d4313510646 | 22 | } |
maetugr | 7:9d4313510646 | 23 | |
maetugr | 7:9d4313510646 | 24 | void RC_Channel::fall() |
maetugr | 7:9d4313510646 | 25 | { |
maetugr | 7:9d4313510646 | 26 | timer.stop(); |
maetugr | 12:67a06c9b69d5 | 27 | LEDs.reset(2); |
maetugr | 12:67a06c9b69d5 | 28 | int tester = timer.read_us(); |
maetugr | 12:67a06c9b69d5 | 29 | if(tester >= 1000 && tester <=2000) |
maetugr | 12:67a06c9b69d5 | 30 | time = tester; |
maetugr | 7:9d4313510646 | 31 | timer.reset(); |
maetugr | 10:953afcbcebfc | 32 | timer.start(); |
maetugr | 10:953afcbcebfc | 33 | } |
maetugr | 10:953afcbcebfc | 34 | |
maetugr | 10:953afcbcebfc | 35 | void RC_Channel::timeoutcheck() |
maetugr | 10:953afcbcebfc | 36 | { |
maetugr | 10:953afcbcebfc | 37 | if (timer.read() > 0.3) |
maetugr | 10:953afcbcebfc | 38 | time = 0; |
maetugr | 7:9d4313510646 | 39 | } |