Chen Huan / Mbed 2 deprecated Final_DongGanPingTai

Tsinghua Icenter ChenHuan

Dependencies:   mbed

Diff: servo/Servo.h

Revision:
0:9b8df4f9b792
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/servo/Servo.h	Thu Mar 16 13:07:14 2017 +0000
@@ -0,0 +1,33 @@
+#ifndef __SERVO_H
+#define __SERVO_H
+#include "mbed.h"
+
+//舵机类 
+/*class Servo
+{
+    public:
+        Servo(PinName pin);
+        void SetDegree(float degree);
+  
+    private:  
+        PwmOut _pin;
+};*/
+
+class Servo
+{
+    public:
+        Servo(PinName pin) : _pin(pin) 
+        {
+            _pin = 0;
+        }
+        void SetDegree(float degree)
+        {
+            float duty = (degree/180.0*2+0.5)/20;
+            _pin.period_ms(20);
+            _pin.write(duty);
+        }
+    private:  
+        PwmOut _pin;
+};
+
+#endif
\ No newline at end of file