AVANCE PICCOLO CORTE 1

Dependencies:   mbed

main.cpp

Committer:
Camilokingxd
Date:
2018-03-13
Revision:
1:8574f732dba3
Parent:
0:2032b926fd86
Child:
2:274426ac7654

File content as of revision 1:8574f732dba3:

#include "mbed.h"
#include "servo.h"

Serial pc(USBTX,USBRX);      //PINES RX Y TX PARA PUERTO USB

void S_EMPIEZA();
void program_serial();
void ejecutar();
void guardar();
void draw();
void nodraw();

int main() 
{
    program_serial();
    uint8_t letra;
    Servo Servos;
    Servos.SetServo(0,0);        //calibración coordenadas (0,0)
    Servos.SetZ(NODRAW);
    wait(2);
    while(1) {
        pc.printf(" ingrese comando \n");
        letra=pc.getc();                //recibir caracter
        switch(letra)
        {
            case OP_EJECUTAR: ejecutar(); break;
            case OP_GUARDAR: guardar(); break;
            case OP_SDRAW: draw(); break;
            case OP_SNODRAW: nodraw(); break;
            default: pc.printf( "comando no valido \n");break ;
        }
    }
}
void program_serial()
{
    pc.baud(9600);              //BAUDIOS DE COMUNICACION
    pc.format(8,SerialBase::None,1);        //NUMERO DE BITS, PARIDAD, BIT DE PARADA
}
void S_EMPIEZA()
{
    
}
void ejecutar()
{
    pc.printf( "el programa se esta ejecutando \n" );
}
void guardar()
{
    uint8_t letra;
    Servo Servos;
    program_serial();
    pc.printf(" el programa se esta guardando \n" );
    letra=pc.getc();
    while(letra!=OP_END)
    {
        switch(letra)
        {
            case OP_SERVO:
                letra=pc.getc();
            break;
            case OP_SDRAW:
            break;
            case OP_SNODRAW:
            break; 
        }
        letra=pc.getc();   
    }
    pc.printf(" el programa termino de guardar \n");
}
void draw()
{
    mypwmZ.pulsewidth_us(MAXPOS); 
    //DRAW; 
    pc.printf(" baja eje z \n");
}
void nodraw()
{
    mypwmZ.pulsewidth_us(NODRAW); 
    //DRAW; 
    pc.printf(" sube eje z \n");
}