![](/media/cache/img/default_profile.jpg.50x50_q85.jpg)
Project for IoT2
Dependencies: BLE_API BMP085 mbed nRF51822
Fork of nRF51822_SimpleControls by
Diff: Servo.cpp
- Revision:
- 0:dfcebc1e442a
- Child:
- 1:f03072e32ed3
diff -r 000000000000 -r dfcebc1e442a Servo.cpp --- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/Servo.cpp Fri Oct 31 09:41:40 2014 +0000 @@ -0,0 +1,23 @@ +#include "Servo.h" + +Servo::Servo(PinName pin) : _servo(pin) +{ + _servo.period_ms(20); +} + +Servo::~Servo(void) +{ + +} + +void Servo::write(unsigned char degree) +{ + convert(degree); + _servo.pulsewidth_us(pulse); +} + +void Servo::convert(unsigned char degree) +{ + // 0~180 degree correspond to 500~2500 + pulse = degree * 11 + 500; +} \ No newline at end of file