Diff: main.cpp

Revision:

1:757f571d9e14

Parent:

0:7460a219f05f

--- a/main.cpp	Sat Dec 14 09:52:37 2013 +0000
+++ b/main.cpp	Thu Jan 30 05:27:11 2014 +0000
@@ -4,16 +4,27 @@
 PwmOut servo1(p21);
 PwmOut servo2(p22);
 PwmOut servo3(p23);
+PwmOut servo4(p24);
+PwmOut servo5(p25);
+PwmOut servo6(p26);
 
-float p = 0.049f;
-float q=0.097f;
-float r=0.045f;
+float p = 0.057f;  //1go-ki syoki iti
+float q = 0.101f;
+float r = 0.087f;
+
+float s = 0.031f;  //2go-ki syoki iti
+float t = 0.118f;
+float u = 0.080f;
+
 
 int main() {
     pc.printf("Press q e a d z c\n");
    servo1=p;
    servo2=q;
    servo3=r;
+   servo4=s;
+   servo5=t;
+   servo6=u;
     while(1) {
         char c = pc.getc();
         if(c == 'q'){
@@ -42,10 +53,46 @@
             servo3=r;
         }
 
+
+if(c == 'u'){
+            s += 0.001f;
+            servo4=s;
+        }
+
+        if(c == 'o'){
+            s -= 0.001f;
+            servo4 = s;
+        } if(c == 'h'){
+            t += 0.001f;
+            servo5=t;
+        }
+
+        if(c == 'k'){
+            t -= 0.001f;
+            servo5 = t;
+        } if(c == 'b'){
+            u += 0.001f;
+            servo6=u;
+        }
+        
+         if(c == 'm'){
+            u -= 0.001f;
+            servo6=u;
+        }
+        
+         if(c == 't'){
         pc.printf("p=%f\n", p);
         
         pc.printf("q=%f\n", q);
         
-        pc.printf("r=%f\n", r);
+        pc.printf("r=%f\n", r);        
+        }
+         if(c == 'y'){
+        pc.printf("s=%f\n", s);
+        
+        pc.printf("t=%f\n", t);
+        
+        pc.printf("u=%f\n", u);
+        }
     }
 }