kings / Mbed 2 deprecated MainMix_20170517

Totale Testversion

Dependencies:   mbed

Fork of DrehungMitStopp by kings

Servo.cpp

Committer:
freunjor
Date:
2017-05-21
Revision:
5:24350e6fc9d7
Parent:
3:cfb0b6bcf568

File content as of revision 5:24350e6fc9d7:

#include "Servo.h"
#include "mbed.h"

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

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

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

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

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

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