Libary for PM2.
Dependencies: RangeFinder FastPWM
Diff: Servo.cpp
- Revision:
- 4:9c003c402033
- Parent:
- 0:86129f1b4a93
--- a/Servo.cpp Thu Apr 01 14:31:43 2021 +0000 +++ b/Servo.cpp Tue Apr 06 11:21:54 2021 +0000 @@ -1,26 +1,30 @@ #include "Servo.h" -#include "mbed.h" + +Servo::Servo(PinName Pin) : ServoPin(Pin) {} - Servo::Servo(PinName Pin) : ServoPin(Pin) {} +void Servo::SetPosition(int Pos) +{ + Position = Pos; +} - void Servo::SetPosition(int Pos) { - Position = Pos; - } +void Servo::StartPulse() +{ + ServoPin = 1; + PulseStop.attach_us(callback(this, &Servo::EndPulse), Position); +} - void Servo::StartPulse() { - ServoPin = 1; - PulseStop.attach_us(callback(this, &Servo::EndPulse), Position); - } - - void Servo::EndPulse() { - ServoPin = 0; - } +void Servo::EndPulse() +{ + ServoPin = 0; +} - void Servo::Enable(int StartPos, int Period) { - Position = StartPos; - Pulse.attach_us(callback(this, &Servo::StartPulse), Period); - } +void Servo::Enable(int StartPos, int Period) +{ + Position = StartPos; + Pulse.attach_us(callback(this, &Servo::StartPulse), Period); +} - void Servo::Disable() { - Pulse.detach(); - } \ No newline at end of file +void Servo::Disable() +{ + Pulse.detach(); +} \ No newline at end of file