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.
Servo_PWM/Servo_PWM.cpp@21:c2a2e7cbabdd, 2012-11-17 (annotated)
- Committer:
- maetugr
- Date:
- Sat Nov 17 11:49:21 2012 +0000
- Revision:
- 21:c2a2e7cbabdd
- Parent:
- 15:753c5d6a63b3
- Child:
- 22:d301b455a1ad
Erster Flugtest, noch nicht stabil!
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
maetugr | 15:753c5d6a63b3 | 1 | #include "Servo_PWM.h" |
maetugr | 15:753c5d6a63b3 | 2 | #include "mbed.h" |
maetugr | 15:753c5d6a63b3 | 3 | |
maetugr | 15:753c5d6a63b3 | 4 | Servo_PWM::Servo_PWM(PinName Pin) : ServoPin(Pin) { |
maetugr | 15:753c5d6a63b3 | 5 | ServoPin.period(0.020); |
maetugr | 15:753c5d6a63b3 | 6 | ServoPin = 0; |
maetugr | 21:c2a2e7cbabdd | 7 | initialize(); |
maetugr | 15:753c5d6a63b3 | 8 | } |
maetugr | 15:753c5d6a63b3 | 9 | |
maetugr | 15:753c5d6a63b3 | 10 | void Servo_PWM::initialize() { |
maetugr | 15:753c5d6a63b3 | 11 | // initialize ESC |
maetugr | 21:c2a2e7cbabdd | 12 | SetPosition(0); // zero throttle |
maetugr | 15:753c5d6a63b3 | 13 | } |
maetugr | 15:753c5d6a63b3 | 14 | |
maetugr | 15:753c5d6a63b3 | 15 | void Servo_PWM::SetPosition(int position) { |
maetugr | 21:c2a2e7cbabdd | 16 | ServoPin.pulsewidth((position+1000)/1000000.0); |
maetugr | 15:753c5d6a63b3 | 17 | } |
maetugr | 15:753c5d6a63b3 | 18 | |
maetugr | 15:753c5d6a63b3 | 19 | void Servo_PWM::operator=(int position) { |
maetugr | 15:753c5d6a63b3 | 20 | SetPosition(position); |
maetugr | 15:753c5d6a63b3 | 21 | } |