AVANCE PICCOLO CORTE 1

Dependencies:   mbed

Committer:
Camilokingxd
Date:
Tue Mar 13 14:43:08 2018 +0000
Revision:
1:8574f732dba3
Parent:
0:2032b926fd86
Child:
2:274426ac7654
MODIFICACION 1

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Camilokingxd 0:2032b926fd86 1 #include "mbed.h"
Camilokingxd 0:2032b926fd86 2 #include "servo.h"
Camilokingxd 0:2032b926fd86 3
Camilokingxd 1:8574f732dba3 4 Serial pc(USBTX,USBRX); //PINES RX Y TX PARA PUERTO USB
Camilokingxd 0:2032b926fd86 5
Camilokingxd 0:2032b926fd86 6 void S_EMPIEZA();
Camilokingxd 0:2032b926fd86 7 void program_serial();
Camilokingxd 0:2032b926fd86 8 void ejecutar();
Camilokingxd 0:2032b926fd86 9 void guardar();
Camilokingxd 0:2032b926fd86 10 void draw();
Camilokingxd 0:2032b926fd86 11 void nodraw();
Camilokingxd 0:2032b926fd86 12
Camilokingxd 0:2032b926fd86 13 int main()
Camilokingxd 0:2032b926fd86 14 {
Camilokingxd 0:2032b926fd86 15 program_serial();
Camilokingxd 0:2032b926fd86 16 uint8_t letra;
Camilokingxd 0:2032b926fd86 17 Servo Servos;
Camilokingxd 0:2032b926fd86 18 Servos.SetServo(0,0); //calibración coordenadas (0,0)
Camilokingxd 0:2032b926fd86 19 Servos.SetZ(NODRAW);
Camilokingxd 0:2032b926fd86 20 wait(2);
Camilokingxd 0:2032b926fd86 21 while(1) {
Camilokingxd 0:2032b926fd86 22 pc.printf(" ingrese comando \n");
Camilokingxd 0:2032b926fd86 23 letra=pc.getc(); //recibir caracter
Camilokingxd 0:2032b926fd86 24 switch(letra)
Camilokingxd 0:2032b926fd86 25 {
Camilokingxd 1:8574f732dba3 26 case OP_EJECUTAR: ejecutar(); break;
Camilokingxd 1:8574f732dba3 27 case OP_GUARDAR: guardar(); break;
Camilokingxd 1:8574f732dba3 28 case OP_SDRAW: draw(); break;
Camilokingxd 1:8574f732dba3 29 case OP_SNODRAW: nodraw(); break;
Camilokingxd 1:8574f732dba3 30 default: pc.printf( "comando no valido \n");break ;
Camilokingxd 0:2032b926fd86 31 }
Camilokingxd 0:2032b926fd86 32 }
Camilokingxd 0:2032b926fd86 33 }
Camilokingxd 0:2032b926fd86 34 void program_serial()
Camilokingxd 0:2032b926fd86 35 {
Camilokingxd 1:8574f732dba3 36 pc.baud(9600); //BAUDIOS DE COMUNICACION
Camilokingxd 1:8574f732dba3 37 pc.format(8,SerialBase::None,1); //NUMERO DE BITS, PARIDAD, BIT DE PARADA
Camilokingxd 0:2032b926fd86 38 }
Camilokingxd 0:2032b926fd86 39 void S_EMPIEZA()
Camilokingxd 0:2032b926fd86 40 {
Camilokingxd 0:2032b926fd86 41
Camilokingxd 0:2032b926fd86 42 }
Camilokingxd 0:2032b926fd86 43 void ejecutar()
Camilokingxd 0:2032b926fd86 44 {
Camilokingxd 0:2032b926fd86 45 pc.printf( "el programa se esta ejecutando \n" );
Camilokingxd 0:2032b926fd86 46 }
Camilokingxd 0:2032b926fd86 47 void guardar()
Camilokingxd 0:2032b926fd86 48 {
Camilokingxd 0:2032b926fd86 49 uint8_t letra;
Camilokingxd 0:2032b926fd86 50 Servo Servos;
Camilokingxd 0:2032b926fd86 51 program_serial();
Camilokingxd 0:2032b926fd86 52 pc.printf(" el programa se esta guardando \n" );
Camilokingxd 0:2032b926fd86 53 letra=pc.getc();
Camilokingxd 1:8574f732dba3 54 while(letra!=OP_END)
Camilokingxd 0:2032b926fd86 55 {
Camilokingxd 0:2032b926fd86 56 switch(letra)
Camilokingxd 0:2032b926fd86 57 {
Camilokingxd 1:8574f732dba3 58 case OP_SERVO:
Camilokingxd 0:2032b926fd86 59 letra=pc.getc();
Camilokingxd 0:2032b926fd86 60 break;
Camilokingxd 1:8574f732dba3 61 case OP_SDRAW:
Camilokingxd 0:2032b926fd86 62 break;
Camilokingxd 1:8574f732dba3 63 case OP_SNODRAW:
Camilokingxd 0:2032b926fd86 64 break;
Camilokingxd 0:2032b926fd86 65 }
Camilokingxd 0:2032b926fd86 66 letra=pc.getc();
Camilokingxd 0:2032b926fd86 67 }
Camilokingxd 0:2032b926fd86 68 pc.printf(" el programa termino de guardar \n");
Camilokingxd 0:2032b926fd86 69 }
Camilokingxd 0:2032b926fd86 70 void draw()
Camilokingxd 0:2032b926fd86 71 {
Camilokingxd 0:2032b926fd86 72 mypwmZ.pulsewidth_us(MAXPOS);
Camilokingxd 0:2032b926fd86 73 //DRAW;
Camilokingxd 0:2032b926fd86 74 pc.printf(" baja eje z \n");
Camilokingxd 0:2032b926fd86 75 }
Camilokingxd 0:2032b926fd86 76 void nodraw()
Camilokingxd 0:2032b926fd86 77 {
Camilokingxd 0:2032b926fd86 78 mypwmZ.pulsewidth_us(NODRAW);
Camilokingxd 0:2032b926fd86 79 //DRAW;
Camilokingxd 0:2032b926fd86 80 pc.printf(" sube eje z \n");
Camilokingxd 0:2032b926fd86 81 }