abrayan

Dependencies:   mbed

main.cpp

Committer:
angel123
Date:
2018-09-11
Revision:
2:3007b3c06d2c
Parent:
1:526bdd5faa37
Child:
6:8d7f6fe73ed1

File content as of revision 2:3007b3c06d2c:

#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.\n");
                        break ;      
        }
    }
}



uint32_t read_command()
{
    char intc=command.getc();
    
    while(intc != 0xff)
        intc=command.getc();
    return command.getc();
}


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  
}