Fabian Meissner / PM2_Libary

Libary for PM2.

Dependencies:   RangeFinder FastPWM

Servo.cpp

Committer:
mrford1616
Date:
2021-04-24
Revision:
9:97b59d914fd8
Parent:
4:9c003c402033

File content as of revision 9:97b59d914fd8:

#include "Servo.h"

Servo::Servo(PinName Pin) : ServoPin(Pin) {}

void Servo::SetPosition(int Pos)
{
    Position = Pos;
}

void Servo::StartPulse()
{
    ServoPin = 1;
    PulseStop.attach_us(callback(this, &Servo::EndPulse), Position);
}

void Servo::EndPulse()
{
    ServoPin = 0;
}

void Servo::Enable(int StartPos, int Period)
{
    Position = StartPos;
    Pulse.attach_us(callback(this, &Servo::StartPulse), Period);
}

void Servo::Disable()
{
    Pulse.detach();
}