Dependents: servo_01 nhk_2018_undercarry_test08 nhk_2018_undercarry_test09 nhk_2018_undercarry_test10
XQ_servo.cpp@0:6f76e98e01ad, 2018-03-18 (annotated)
- Committer:
- kenken0721
- Date:
- Sun Mar 18 06:41:56 2018 +0000
- Revision:
- 0:6f76e98e01ad
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
kenken0721 | 0:6f76e98e01ad | 1 | #include "mbed.h" |
kenken0721 | 0:6f76e98e01ad | 2 | #include "XQ_servo.h" |
kenken0721 | 0:6f76e98e01ad | 3 | |
kenken0721 | 0:6f76e98e01ad | 4 | |
kenken0721 | 0:6f76e98e01ad | 5 | double XQ_servo::map(double x, double in_min, double in_max, double out_min, double out_max){ |
kenken0721 | 0:6f76e98e01ad | 6 | return (x - in_min) * (out_max - out_min) / (in_max - in_min) + out_min; |
kenken0721 | 0:6f76e98e01ad | 7 | } |
kenken0721 | 0:6f76e98e01ad | 8 | |
kenken0721 | 0:6f76e98e01ad | 9 | XQ_servo::XQ_servo(PinName signal) : pwm(signal){ |
kenken0721 | 0:6f76e98e01ad | 10 | } |
kenken0721 | 0:6f76e98e01ad | 11 | |
kenken0721 | 0:6f76e98e01ad | 12 | void XQ_servo::move(float value){ |
kenken0721 | 0:6f76e98e01ad | 13 | value = (int)map(value, 1.0, 0.0, 700, 2300); |
kenken0721 | 0:6f76e98e01ad | 14 | pwm.pulsewidth_us(value); |
kenken0721 | 0:6f76e98e01ad | 15 | } |
kenken0721 | 0:6f76e98e01ad | 16 |