Dependents: serial_connected_mcu_nucleo serial_connected_mcu_nucleo
servo.cpp
- Committer:
- inst
- Date:
- 2016-06-25
- Revision:
- 4:31ed2ce96ca3
- Parent:
- 3:6cadf3326257
- Child:
- 5:a4d580b86638
File content as of revision 4:31ed2ce96ca3:
#include "servo.hpp" #include "mbed.h" const float servo::_min_position_sec = 0.85f * 0.001f; const float servo::_max_position_sec = 2.15f * 0.001f; servo::servo(PinName pin) : _pwm(pin) { _pwm.period(20.0f * 0.001f); } void servo::set_position(float pos) { if (pos >= 1.0f) { pos = 1.0f; } else if (pos <= -1.0f) { pos = -1.0f; } pos += 1.0f; pos *= 0.5f; _pwm.pulsewidth((1.0f - pos) * _min_position_sec + pos * _max_position_sec); }