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@0:c5040669bd3e, 2018-02-19 (annotated)

Committer:
Stevenor1997
Date:
Mon Feb 19 17:41:40 2018 +0000
Revision:
0:c5040669bd3e
Child:
1:59dc95283a4d
Movimiento de los servos en 3 ejes (no probado)

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Stevenor1997 0:c5040669bd3e 1 #include "mbed.h"
Stevenor1997 0:c5040669bd3e 2
Stevenor1997 0:c5040669bd3e 3 PwmOut mypwmX(D0);
Stevenor1997 0:c5040669bd3e 4 PwmOut mypwmY(D1);
Stevenor1997 0:c5040669bd3e 5 PwmOut mypwmZ(D2);
Stevenor1997 0:c5040669bd3e 6 int Move_x,Move_y,Move_z;
Stevenor1997 0:c5040669bd3e 7 DigitalOut myled(LED1);
Stevenor1997 0:c5040669bd3e 8 class Move_Servo_X
Stevenor1997 0:c5040669bd3e 9 {
Stevenor1997 0:c5040669bd3e 10 private:
Stevenor1997 0:c5040669bd3e 11 int x,y,z;
Stevenor1997 0:c5040669bd3e 12 public:
Stevenor1997 0:c5040669bd3e 13 Move_Servo();
Stevenor1997 0:c5040669bd3e 14 ~Move_Servo();
Stevenor1997 0:c5040669bd3e 15 void SetServo(int,int,int);
Stevenor1997 0:c5040669bd3e 16 int GetServoX();
Stevenor1997 0:c5040669bd3e 17 };
Stevenor1997 0:c5040669bd3e 18
Stevenor1997 0:c5040669bd3e 19 Move_Servo::Move_Servo()
Stevenor1997 0:c5040669bd3e 20 {
Stevenor1997 0:c5040669bd3e 21 }
Stevenor1997 0:c5040669bd3e 22 Move_Servo::~Move_Servo(){
Stevenor1997 0:c5040669bd3e 23 }
Stevenor1997 0:c5040669bd3e 24 void Move_Servo::SetServo(int _x,int _y,int _z)
Stevenor1997 0:c5040669bd3e 25 {
Stevenor1997 0:c5040669bd3e 26 x=_x;
Stevenor1997 0:c5040669bd3e 27 y=_y;
Stevenor1997 0:c5040669bd3e 28 z=_z;
Stevenor1997 0:c5040669bd3e 29 Move_x=(x*20)+1000;
Stevenor1997 0:c5040669bd3e 30 Move_y=(y*20)+1000;
Stevenor1997 0:c5040669bd3e 31 Move_z=(z*20)+1000;
Stevenor1997 0:c5040669bd3e 32 mypwmX.pulsewidth_us(Move_x);
Stevenor1997 0:c5040669bd3e 33 mypwmY.pulsewidth_us(Move_y);
Stevenor1997 0:c5040669bd3e 34 mypwmZ.pulsewidth_us(Move_z);
Stevenor1997 0:c5040669bd3e 35 }
Stevenor1997 0:c5040669bd3e 36 int Move_Servo::GetServoX()
Stevenor1997 0:c5040669bd3e 37 {
Stevenor1997 0:c5040669bd3e 38 return longitud;
Stevenor1997 0:c5040669bd3e 39 }
Stevenor1997 0:c5040669bd3e 40