tarou yamada / servo

Dependents:   serial_connected_mcu_nucleo serial_connected_mcu_nucleo

servo.cpp

Committer:
inst
Date:
2016-02-26
Revision:
0:54b8292756b8
Child:
1:ffc003a37375

File content as of revision 0:54b8292756b8:

#include "servo.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((1.0f - pos) * min_position_sec + pos * max_position_sec);
}

} /* namespace mbed_stl */