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-02-19
Revision:
0:c5040669bd3e
Child:
1:59dc95283a4d

File content as of revision 0:c5040669bd3e:

#include "mbed.h"

PwmOut mypwmX(D0);
PwmOut mypwmY(D1);
PwmOut mypwmZ(D2);
int Move_x,Move_y,Move_z;
DigitalOut myled(LED1);
class Move_Servo_X
{
    private:
        int x,y,z;
    public:
        Move_Servo();
        ~Move_Servo();
        void SetServo(int,int,int);
        int GetServoX();
};

Move_Servo::Move_Servo()
{
}
Move_Servo::~Move_Servo(){
}
void Move_Servo::SetServo(int _x,int _y,int _z)
{
    x=_x;
    y=_y;
    z=_z;
    Move_x=(x*20)+1000;
    Move_y=(y*20)+1000;
    Move_z=(z*20)+1000;
    mypwmX.pulsewidth_us(Move_x);
    mypwmY.pulsewidth_us(Move_y);
    mypwmZ.pulsewidth_us(Move_z);   
}
int Move_Servo::GetServoX()
{
    return longitud;
}