tarou yamada / servo

Dependents:   serial_connected_mcu_nucleo serial_connected_mcu_nucleo

servo.cpp

Committer:
inst
Date:
2016-02-26
Revision:
1:ffc003a37375
Parent:
0:54b8292756b8
Child:
2:58169cf31b49

File content as of revision 1:ffc003a37375:

#include "servo.hpp"
#include "mbed_stl.hpp"
#include "mbed.h"

namespace mbed_stl {

const float servo::min_position_sec_ = 0.9f * 0.001f;
const float servo::max_position_sec_ = 2.1f * 0.001f;

servo::servo(PinName pin) : pwm_(pin) {
    pwm_.period(20.0f * 0.001f);
}

void servo::set_position(float pos) {
    pwm_.pulsewidth(linear_algebra::lerp(pos, min_position_sec_, max_position_sec_));
}

} /* namespace mbed_stl */