Steven Ortiz / Move_Servos

el programa permite ingresar la posición en el eje X,Y,Z, haciendo que el Servo MG90S con sus movimientos de 180° trabaje en mm de 0 a 50.

Dependents:   PICCOLO_CNC PICCOLO_CNC1

Servo_X.h

Committer:
Stevenor1997
Date:
2018-04-04
Revision:
8:19fc8a39d4ab
Parent:
7:5d67068ff367
Child:
10:62a8fabbdf97

File content as of revision 8:19fc8a39d4ab:

#include "mbed.h"



#ifndef SERVO_X_H
#define SERVO_X_H
#define MINPULSE 560
#define MAXPULSE 2400
#define MAXPOS 50// poscisión max de la coordenasda en mm
#define DRAW 50 
#define NODRAW 0
#define CM_EJECUTAR 0Xff
#define CM_GUARDAR 0Xfe
#define CM_SERVO 0Xfd
#define CM_SDRAW 0xfc
#define CM_SN0DRAW 0xfb
#define CM_END 0xfa
#define CM_STOP 0xf0
#define CM_STEPMOTOR 0xf9
#define NUME_PASOS 45629
#define RADIO_R 50





class Servo
{
    private:
        float x,xa,y,ya,z;
        int mm2pulse(float vmm);
    public:
        Servo();
        ~Servo();
        void SetServo(float,float);
        void SetZ(float);
        float GetServoX();
        float GetServoY();
        float GetServoZ();
        void t_espera(float,float);
};

#endif