kazuki ishibashi / MD

relayMD

Fork of Motor by kazuki ishibashi

Diff: motor.cpp

Revision:
0:ebfdfce2d069
Child:
1:0efe3050d83e
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/motor.cpp	Mon Sep 05 00:49:28 2016 +0000
@@ -0,0 +1,26 @@
+#include "motor.h"
+#include "mbed.h"
+
+Motor::Motor(PinName pin1, PinName pin2, PinName pin3) : _pin1(pin1), _pin2(pin2), _pin3(pin3)
+{
+    _pin1 = 0;
+    _pin2 = 0;
+    _pin3 = 0;
+}
+
+void Motor::motor(float n)
+{
+    if(n > 0) {
+        _pin1=0;
+        _pin2=1;
+        _pin3=n;
+    } else if(n < 0) {
+        _pin1=1;
+        _pin2=0;
+        _pin3=-n;
+    } else {
+        _pin1=0;
+        _pin2=0;
+        _pin3=1;
+    }
+}
\ No newline at end of file