Diff: main.cpp

Revision:

0:7a4088ccf3bc

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/main.cpp	Tue Jan 26 07:24:30 2016 +0000
@@ -0,0 +1,69 @@
+ // Hello World to sweep a servo through its full range
+ 
+#include "mbed.h"
+#include "Servo.h"
+ 
+Servo myservo1(PC_9);
+Servo myservo2(PC_8);
+Serial pc(USBTX, USBRX);
+int main() {    
+    char Msg_c;
+    pc.baud(115200);
+    pc.printf("Hello Servo motor World!\r\n");
+    float degree1, degree2= 0;
+    float degree = 0;
+    
+    while(1)
+    {
+        Msg_c = pc.getc();
+        
+        if(Msg_c==0x31)
+        {
+            degree = -45;
+            pc.printf("1 : %f\r\n", degree);
+            myservo1.position(degree);
+            myservo2.position(degree);
+        }
+        else if(Msg_c==0x32)
+        {
+            degree = 0;
+            pc.printf("2 : %f\r\n", degree); 
+            myservo1.position(degree);
+            myservo2.position(degree);
+        }
+        else if(Msg_c==0x33)
+        {
+            degree = 45;
+            pc.printf("3 : %f\r\n", degree);  
+            myservo1.position(degree);
+            myservo2.position(degree);
+        }
+        else if(Msg_c=='a')
+        {
+            degree1++;
+            pc.printf("a degree1 : %f\r\n", degree1);  
+            myservo1.position(degree1);
+        }
+        else if(Msg_c=='s')
+        {
+            degree1--;
+            pc.printf("s degree1 : %f\r\n", degree1);  
+            myservo1.position(degree1);
+        }
+        else if(Msg_c=='z')
+        {
+            degree2++;
+            pc.printf("z degree2 : %f\r\n", degree2);  
+            myservo2.position(degree2);
+        }
+        else if(Msg_c=='x')
+        {
+            degree2--;
+            pc.printf("x degree2 : %f\r\n", degree2);  
+            myservo2.position(degree2);
+        }
+    }
+
+}
+ 
+