Mitch Carlson / ESC

Simplified pwm pinout to ESC control library for the KL25Z

esc.cpp

Committer:
MitchJCarlson
Date:
2013-06-09
Revision:
1:4c02fede684b
Parent:
0:ec466ef657a2

File content as of revision 1:4c02fede684b:

#include "mbed.h"
#include "esc.h"

ESC::ESC(PwmOut pwmPinOut, int period)
    : esc(pwmPinOut), period(period), throttle(1000) {
        esc.period_ms(period);
        esc.pulsewidth_us(throttle);
    }

bool ESC::setThrottle(int t) {
    if (t >= 0 && t <= 100) {       // qualify range, 0-100
        throttle = t*10 + 1000;     // map to range, 1-2 ms (1000-2000us)
        esc.pulsewidth_us(throttle);
        return true;
    }
    return false;
}

void ESC::pulse(void) {
    esc.pulsewidth_us(throttle);
}