Lightweight FlyBed1, structure based on KK-Board Firmware First this one should work, then I can get more complex FlyBed1 working :)
Servo_PWM/Servo_PWM.cpp
- Committer:
- maetugr
- Date:
- 2013-06-24
- Revision:
- 2:c2ebab7c189f
- Parent:
- 0:d51bf879e9df
File content as of revision 2:c2ebab7c189f:
#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); }