Diff: Servo_X.h

Revision:

0:c5040669bd3e

Child:

1:59dc95283a4d

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/Servo_X.h	Mon Feb 19 17:41:40 2018 +0000
@@ -0,0 +1,40 @@
+#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;
+}
+