Servo Example

Dependencies:   Servo mbed

Revision:
0:d4a595edb64d
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Wed May 29 05:54:08 2013 +0000
@@ -0,0 +1,32 @@
+#include "mbed.h"
+#include "Servo.h"
+
+DigitalIn  sw01(p20);
+DigitalOut led01(LED1);
+Servo servo01(p21);
+
+
+bool pose = false;
+bool old_sw = false;
+
+int main() {
+    sw01.mode(PullUp);
+    while(1) {
+       bool now_sw = (sw01 == 0);
+       if (now_sw) {
+          led01 = 1;
+       } else {
+          led01 = 0;
+       }
+       if (!old_sw && now_sw) {
+           pose = ! pose;
+           
+       }
+       old_sw = now_sw;
+       if (pose) {
+           servo01.write(0.5);
+       } else {
+           servo01.write(0.1);
+       }
+    }
+}