File content as of revision 1:526bdd5faa37:

#include "mbed.h"

#include "main.h"




Serial command(USBTX, USBRX);



int main() {
    init_servo();
    init_serial();

    debug_m("inicio \n");
    uint32_t read_cc;
    while(1)
    {
        read_cc=read_command();
        switch (read_cc) {
            case  0x01: moving(); break;
            default: debug_m("error de comando. \nSe espera  0xFEF0 o 0xFFF0 \n");break ;      
        }
    }
}



uint32_t read_command()
{
   // retorna los byte recibidos concatenados en un entero, 
   

    
    char intc=command.getc();
    
    while(intc != '<')
        intc=command.getc();
    return intc;
}


void init_serial()
{
    command.baud(9600);    
}


void moving(){
    debug_m("se inicia el comado mover..\n");    
    
    char nmotor=command.getc();
    char grados=command.getc();
    char endc=command.getc();
    mover_ser(nmotor,grados); 
    debug_m("fin del comado guardar..\n");    
    
}

void debug_m(char *s , ... ){
    #if DEBUG
    command.printf(s);
    #endif  
}