Tsinghua Icenter ChenHuan

Dependencies:   mbed

Committer:
heroistired
Date:
Thu Mar 16 13:07:14 2017 +0000
Revision:
0:9b8df4f9b792
DongGanPingTai

Who changed what in which revision?

UserRevisionLine numberNew 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