File content as of revision 0:4ef49f487990:

#include "mbed.h"
#include "Servo.h"
union floatInByte
{
    unsigned short         sd;
    unsigned char c[2];
};
Serial master(dp16,dp15);
Servo arm[4] = {Servo(dp1),Servo(dp2),Servo(dp24),Servo(dp18)};
floatInByte data[4][2] = {{0,0},{0,0},{0,0},{0,0}};

char RXDATA[24] = {0,0,0,0,255,255,155,255,5,255,000,255,
                   0,0,0,0,255,255,155,225,5,205,000,55};

void run(int i);
void rx(){
    if(master.getc() == 'H'){
        for(int i = 1;i < 24;i++){
            RXDATA[i] = master.getc();
        }
    }
}
void waitTime(float ti){
    Timer t;
    t.start();
    while(ti > t.read());
    t.stop();
    return;
}
#if 0//R
#define head 4
    void run(int i){
        //for(int i = 0 ; i < 4 ; i ++ ){
        for(int j = 0 ; j < 2; j++){
            data[i][0].c[j] = RXDATA[head + i*2 + j];   
        }
        arm[i] = (float)data[i][0].sd/0xffff;
        //printf("%d %f  ",i,float(data[i].sd)/0xffff);
        //}
        //printf("\n");
    }
#else//L
#define head 4+12
    void run(int i){
        //for(int i = 0 ; i < 4 ; i ++ ){
        for(int j = 0 ; j < 2; j++){
            data[i][0].c[j] = RXDATA[head + i*2 + j];
        }
        arm[i] = (float)data[i][0].sd/0xffff;
        //printf("%d %f %d %d ",i,float(data[i].sd)/0xffff , data[i].c[1] , data[i].c[0]);
        //}
        //printf("\n");
    }
#endif

int main() {
    master.baud(115200);
    master.attach(&rx);
    //printf("start ");
    //pc.baud(115200);
    for(int i = 0 ; i < 4 ;i++){
        arm[i].calibrate(0.0008,270.0/2);
    }
    while(1) {
        for(int i  = 0 ;  i < 4 ; i++)run(i);
        waitTime(20.0/1000.0);
    }
}