y w / Mbed 2 deprecated servo_controll_test

Important changes to repositories hosted on mbed.com

Mbed hosted mercurial repositories are deprecated and are due to be permanently deleted in July 2026.

To keep a copy of this software download the repository Zip archive or clone locally using Mercurial.

It is also possible to export all your personal repositories from the account settings page.

Dependencies:   mbed

main.cpp

Committer:
nekoyyy
Date:
2013-12-14
Revision:
0:7460a219f05f
Child:
1:757f571d9e14

File content as of revision 0:7460a219f05f:

#include "mbed.h"

Serial pc(USBTX, USBRX); // tx, rx
PwmOut servo1(p21);
PwmOut servo2(p22);
PwmOut servo3(p23);

float p = 0.049f;
float q=0.097f;
float r=0.045f;

int main() {
    pc.printf("Press q e a d z c\n");
   servo1=p;
   servo2=q;
   servo3=r;
    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;
        }

        pc.printf("p=%f\n", p);
        
        pc.printf("q=%f\n", q);
        
        pc.printf("r=%f\n", r);
    }
}