y w / Mbed 2 deprecated servo_controll_test

Dependencies:   mbed

main.cpp

Committer:
nekoyyy
Date:
2014-01-30
Revision:
1:757f571d9e14
Parent:
0:7460a219f05f

File content as of revision 1:757f571d9e14:

#include "mbed.h"

Serial pc(USBTX, USBRX); // tx, rx
PwmOut servo1(p21);
PwmOut servo2(p22);
PwmOut servo3(p23);
PwmOut servo4(p24);
PwmOut servo5(p25);
PwmOut servo6(p26);

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'){
            p += 0.001f;
            servo1=p;
        }

        if(c == 'e'){
            p -= 0.001f;
            servo1 = p;
        } if(c == 'a'){
            q += 0.001f;
            servo2=q;
        }

        if(c == 'd'){
            q -= 0.001f;
            servo2 = q;
        } if(c == 'z'){
            r += 0.001f;
            servo3=r;
        }
        
         if(c == 'c'){
            r -= 0.001f;
            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);        
        }
         if(c == 'y'){
        pc.printf("s=%f\n", s);
        
        pc.printf("t=%f\n", t);
        
        pc.printf("u=%f\n", u);
        }
    }
}