Sooner Competitive Robotics / Mbed 2 deprecated IEEE_14_Freescale

Dependencies:   mbed

Fork of IEEE_14_Freescale by IEEE 2014 Mbed

Revision:
1:c28fac16a109
--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/motor.cpp	Sun Nov 17 03:05:35 2013 +0000
@@ -0,0 +1,65 @@
+#include "motor.h"
+
+motor::motor(PinName APin,PinName BPin, PinName PWMPin) :
+        OutA(APin), OutB(BPin), OutPWM(PWMPin){
+        
+    //blah
+    brake();
+    reversed=0;
+}
+
+int motor::brake(){
+    OutA=OutB=0;
+    OutPWM=1;
+    return 1;
+}
+
+int motor::setPower( double power) {
+    if((power>=0)^reversed){
+        OutA=1;
+        OutB=0;
+    } else {
+        OutA=0;
+        OutB=1;
+    }
+    OutPWM=abs(power);
+    return 1;
+}
+
+int motor::setReversed(int state){
+    if(state!=0){
+        reversed=1;
+    } else {
+        reversed=0;
+    }
+    return 1;
+}
+
+
+simpleMotor::simpleMotor(PinName APin, PinName PWMPin) :
+        OutA(APin), OutPWM(PWMPin){
+        
+    //blah
+    setPower(0);
+    reversed=0;
+}
+
+int simpleMotor::setPower( double power) {
+    if((power>=0)^reversed){
+        OutA=1;
+    } else {
+        OutA=0;
+    }
+    OutPWM=abs(power);
+    currPower=power;
+    return 1;
+}
+
+int simpleMotor::setReversed(int state){
+    if(state!=0){
+        reversed=1;
+    } else {
+        reversed=0;
+    }
+    return 1;
+}
\ No newline at end of file