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@28:ba6ca9f4def4, 2012-12-01 (annotated)
- Committer:
- maetugr
- Date:
- Sat Dec 01 07:13:04 2012 +0000
- Revision:
- 28:ba6ca9f4def4
- Parent:
- 22:d301b455a1ad
- Child:
- 29:8b7362a2ee14
bevor eigener PID
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 | 22:d301b455a1ad | 16 | ServoPin.pulsewidth_us(position+1000); |
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 | } |