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@1:59dc95283a4d, 2018-02-20 (annotated)

Committer:
Stevenor1997
Date:
Tue Feb 20 13:00:47 2018 +0000
Revision:
1:59dc95283a4d
Parent:
0:c5040669bd3e
Child:
2:cc30b42ac66f
programa para 3 servomotores, movimientos X,Y y Z respectivamente (programa probado, funciona).

Who changed what in which revision?

UserRevisionLine numberNew contents of line
Stevenor1997 0:c5040669bd3e 1 #include "mbed.h"
Stevenor1997 0:c5040669bd3e 2
Stevenor1997 1:59dc95283a4d 3 PwmOut mypwmX(PA_8);
Stevenor1997 1:59dc95283a4d 4 PwmOut mypwmY(PB_10);
Stevenor1997 1:59dc95283a4d 5 PwmOut mypwmZ(PB_4);
Stevenor1997 0:c5040669bd3e 6 int Move_x,Move_y,Move_z;
Stevenor1997 1:59dc95283a4d 7 class Servo
Stevenor1997 0:c5040669bd3e 8 {
Stevenor1997 0:c5040669bd3e 9 private:
Stevenor1997 0:c5040669bd3e 10 int x,y,z;
Stevenor1997 0:c5040669bd3e 11 public:
Stevenor1997 1:59dc95283a4d 12 Servo();
Stevenor1997 1:59dc95283a4d 13 ~Servo();
Stevenor1997 0:c5040669bd3e 14 void SetServo(int,int,int);
Stevenor1997 0:c5040669bd3e 15 int GetServoX();
Stevenor1997 1:59dc95283a4d 16 int GetServoY();
Stevenor1997 1:59dc95283a4d 17 int GetServoZ();
Stevenor1997 0:c5040669bd3e 18 };
Stevenor1997 0:c5040669bd3e 19
Stevenor1997 1:59dc95283a4d 20 Servo::Servo()
Stevenor1997 0:c5040669bd3e 21 {
Stevenor1997 0:c5040669bd3e 22 }
Stevenor1997 1:59dc95283a4d 23 Servo::~Servo(){
Stevenor1997 0:c5040669bd3e 24 }
Stevenor1997 1:59dc95283a4d 25 void Servo::SetServo(int _x,int _y,int _z)
Stevenor1997 0:c5040669bd3e 26 {
Stevenor1997 0:c5040669bd3e 27 x=_x;
Stevenor1997 0:c5040669bd3e 28 y=_y;
Stevenor1997 0:c5040669bd3e 29 z=_z;
Stevenor1997 0:c5040669bd3e 30 Move_x=(x*20)+1000;
Stevenor1997 0:c5040669bd3e 31 Move_y=(y*20)+1000;
Stevenor1997 0:c5040669bd3e 32 Move_z=(z*20)+1000;
Stevenor1997 0:c5040669bd3e 33 mypwmX.pulsewidth_us(Move_x);
Stevenor1997 0:c5040669bd3e 34 mypwmY.pulsewidth_us(Move_y);
Stevenor1997 0:c5040669bd3e 35 mypwmZ.pulsewidth_us(Move_z);
Stevenor1997 0:c5040669bd3e 36 }
Stevenor1997 1:59dc95283a4d 37 int Servo::GetServoX()
Stevenor1997 1:59dc95283a4d 38 {
Stevenor1997 1:59dc95283a4d 39 return x;
Stevenor1997 1:59dc95283a4d 40 }
Stevenor1997 1:59dc95283a4d 41 int Servo::GetServoY()
Stevenor1997 0:c5040669bd3e 42 {
Stevenor1997 1:59dc95283a4d 43 return y;
Stevenor1997 1:59dc95283a4d 44 }
Stevenor1997 1:59dc95283a4d 45 int Servo::GetServoZ()
Stevenor1997 1:59dc95283a4d 46 {
Stevenor1997 1:59dc95283a4d 47 return y;
Stevenor1997 0:c5040669bd3e 48 }
Stevenor1997 0:c5040669bd3e 49