Matthias Grob / Mbed 2 deprecated FlyBedLight

Lightweight FlyBed1, structure based on KK-Board Firmware First this one should work, then I can get more complex FlyBed1 working :)

Dependencies:   mbed MODI2C

Servo_PWM/Servo_PWM.cpp

Committer:
maetugr
Date:
2015-11-19
Revision:
3:9cde4e9740fc
Parent:
0:d51bf879e9df

File content as of revision 3:9cde4e9740fc:

#include "Servo_PWM.h"
#include "mbed.h"

Servo_PWM::Servo_PWM(PinName Pin, int frequency) : ServoPin(Pin) {
    SetFrequency(frequency);
    ServoPin = 0;
    initialize();
}

void Servo_PWM::SetFrequency(int frequency) {
    ServoPin.period(1.0/frequency);
}

void Servo_PWM::initialize() {
    // initialize ESC
    SetPosition(0);  // zero throttle
}

void Servo_PWM::SetPosition(int position) {
    ServoPin.pulsewidth_us(position+1000);
}

void Servo_PWM::operator=(int position) {
    SetPosition(position);
}