Dependents: serial_connected_mcu_nucleo serial_connected_mcu_nucleo
servo.cpp@0:54b8292756b8, 2016-02-26 (annotated)
- Committer:
- inst
- Date:
- Fri Feb 26 16:09:01 2016 +0000
- Revision:
- 0:54b8292756b8
- Child:
- 1:ffc003a37375
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
inst | 0:54b8292756b8 | 1 | #include "servo.hpp" |
inst | 0:54b8292756b8 | 2 | #include "mbed.h" |
inst | 0:54b8292756b8 | 3 | |
inst | 0:54b8292756b8 | 4 | namespace mbed_stl { |
inst | 0:54b8292756b8 | 5 | |
inst | 0:54b8292756b8 | 6 | const float servo::min_position_sec_ = 0.9f * 0.001f; |
inst | 0:54b8292756b8 | 7 | const float servo::max_position_sec_ = 2.1f * 0.001f; |
inst | 0:54b8292756b8 | 8 | |
inst | 0:54b8292756b8 | 9 | servo::servo(PinName pin) : pwm_(pin) { |
inst | 0:54b8292756b8 | 10 | pwm_.period(20.0f * 0.001f); |
inst | 0:54b8292756b8 | 11 | } |
inst | 0:54b8292756b8 | 12 | |
inst | 0:54b8292756b8 | 13 | void servo::set_position(float pos) { |
inst | 0:54b8292756b8 | 14 | pwm.pulsewidth((1.0f - pos) * min_position_sec + pos * max_position_sec); |
inst | 0:54b8292756b8 | 15 | } |
inst | 0:54b8292756b8 | 16 | |
inst | 0:54b8292756b8 | 17 | } /* namespace mbed_stl */ |