Chen Huan
/
Final_DongGanPingTai
Tsinghua Icenter ChenHuan
servo/Servo.h@0:9b8df4f9b792, 2017-03-16 (annotated)
- Committer:
- heroistired
- Date:
- Thu Mar 16 13:07:14 2017 +0000
- Revision:
- 0:9b8df4f9b792
DongGanPingTai
Who changed what in which revision?
User | Revision | Line number | New contents of line |
---|---|---|---|
heroistired | 0:9b8df4f9b792 | 1 | #ifndef __SERVO_H |
heroistired | 0:9b8df4f9b792 | 2 | #define __SERVO_H |
heroistired | 0:9b8df4f9b792 | 3 | #include "mbed.h" |
heroistired | 0:9b8df4f9b792 | 4 | |
heroistired | 0:9b8df4f9b792 | 5 | //舵机类 |
heroistired | 0:9b8df4f9b792 | 6 | /*class Servo |
heroistired | 0:9b8df4f9b792 | 7 | { |
heroistired | 0:9b8df4f9b792 | 8 | public: |
heroistired | 0:9b8df4f9b792 | 9 | Servo(PinName pin); |
heroistired | 0:9b8df4f9b792 | 10 | void SetDegree(float degree); |
heroistired | 0:9b8df4f9b792 | 11 | |
heroistired | 0:9b8df4f9b792 | 12 | private: |
heroistired | 0:9b8df4f9b792 | 13 | PwmOut _pin; |
heroistired | 0:9b8df4f9b792 | 14 | };*/ |
heroistired | 0:9b8df4f9b792 | 15 | |
heroistired | 0:9b8df4f9b792 | 16 | class Servo |
heroistired | 0:9b8df4f9b792 | 17 | { |
heroistired | 0:9b8df4f9b792 | 18 | public: |
heroistired | 0:9b8df4f9b792 | 19 | Servo(PinName pin) : _pin(pin) |
heroistired | 0:9b8df4f9b792 | 20 | { |
heroistired | 0:9b8df4f9b792 | 21 | _pin = 0; |
heroistired | 0:9b8df4f9b792 | 22 | } |
heroistired | 0:9b8df4f9b792 | 23 | void SetDegree(float degree) |
heroistired | 0:9b8df4f9b792 | 24 | { |
heroistired | 0:9b8df4f9b792 | 25 | float duty = (degree/180.0*2+0.5)/20; |
heroistired | 0:9b8df4f9b792 | 26 | _pin.period_ms(20); |
heroistired | 0:9b8df4f9b792 | 27 | _pin.write(duty); |
heroistired | 0:9b8df4f9b792 | 28 | } |
heroistired | 0:9b8df4f9b792 | 29 | private: |
heroistired | 0:9b8df4f9b792 | 30 | PwmOut _pin; |
heroistired | 0:9b8df4f9b792 | 31 | }; |
heroistired | 0:9b8df4f9b792 | 32 | |
heroistired | 0:9b8df4f9b792 | 33 | #endif |