Matthias Grob / Mbed 2 deprecated FlyBed1

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.

Dependencies:   mbed MODI2C

Servo_PWM/Servo_PWM.cpp@40:2ca410923691, 2014-02-14 (annotated)

Committer:
maetugr
Date:
Fri Feb 14 14:17:32 2014 +0000
Revision:
40:2ca410923691
Parent:
29:8b7362a2ee14 
now with MPU6050 before taking it too FlyBed2

Who changed what in which revision?

UserRevisionLine numberNew contents of line
maetugr 15:753c5d6a63b3 1 #include "Servo_PWM.h"
maetugr 15:753c5d6a63b3 2 #include "mbed.h"
maetugr 15:753c5d6a63b3 3
maetugr 29:8b7362a2ee14 4 Servo_PWM::Servo_PWM(PinName Pin, int frequency) : ServoPin(Pin) {
maetugr 29:8b7362a2ee14 5 SetFrequency(frequency);
maetugr 15:753c5d6a63b3 6 ServoPin = 0;
maetugr 21:c2a2e7cbabdd 7 initialize();
maetugr 15:753c5d6a63b3 8 }
maetugr 15:753c5d6a63b3 9
maetugr 29:8b7362a2ee14 10 void Servo_PWM::SetFrequency(int frequency) {
maetugr 29:8b7362a2ee14 11 ServoPin.period(1.0/frequency);
maetugr 29:8b7362a2ee14 12 }
maetugr 29:8b7362a2ee14 13
maetugr 15:753c5d6a63b3 14 void Servo_PWM::initialize() {
maetugr 15:753c5d6a63b3 15 // initialize ESC
maetugr 21:c2a2e7cbabdd 16 SetPosition(0); // zero throttle
maetugr 15:753c5d6a63b3 17 }
maetugr 15:753c5d6a63b3 18
maetugr 15:753c5d6a63b3 19 void Servo_PWM::SetPosition(int position) {
maetugr 22:d301b455a1ad 20 ServoPin.pulsewidth_us(position+1000);
maetugr 15:753c5d6a63b3 21 }
maetugr 15:753c5d6a63b3 22
maetugr 15:753c5d6a63b3 23 void Servo_PWM::operator=(int position) {
maetugr 15:753c5d6a63b3 24 SetPosition(position);
maetugr 15:753c5d6a63b3 25 }