Sooner Competitive Robotics / Mbed 2 deprecated IEEE_14_Freescale

Dependencies:   mbed

Fork of IEEE_14_Freescale by IEEE 2014 Mbed

remoteMotor.cpp

Committer:
soonerbot
Date:
2013-11-17
Revision:
1:c28fac16a109
Child:
4:adc885f4ab75

File content as of revision 1:c28fac16a109:

#include "remoteMotor.h"
#include "dbgprint.h"

remoteMotor::remoteMotor(remoteEnc &remoteIn, int APin,int BPin, PinName PWMPin) :
        remote(remoteIn), OutPWM(PWMPin){
        
    //blah
    remoteA=APin;
    remoteB=BPin;
    
    brake();
    reversed=0;
}

int remoteMotor::brake(){
    remote.setPin(remoteA,0);
    remote.setPin(remoteB,0);
    //OutA=OutB=0;
    OutPWM=1;
    return 1;
}

int remoteMotor::setPower( double power) {
    if((power>=0)^reversed){
        remote.setPin(remoteA,1);
        remote.setPin(remoteB,0);
        //OutA=1;
        //OutB=0;
    } else {
        remote.setPin(remoteA,0);
        remote.setPin(remoteB,1);
        //OutA=0;
        //OutB=1;
    }
    OutPWM=abs(power);
    return 1;
}

int remoteMotor::setReversed(int state){
    if(state!=0){
        reversed=1;
    } else {
        reversed=0;
    }
    return 1;
}


simpleRemoteMotor::simpleRemoteMotor(remoteEnc &remotedev, int remotepinin, PinName PWMPin) :
        remote(remotedev), OutPWM(PWMPin){
        
    DBGPRINT("bbbhal",1);
    remotepin=remotepinin;
    //blah
    setPower(0);
    reversed=0;
}

int simpleRemoteMotor::setPower( double power) {
    if((power>=0)^reversed){
        remote.setPin(remotepin,1);
    } else {
        remote.setPin(remotepin,0);
    }
    OutPWM=abs(power);
    currPower=power;
    return 1;
}

int simpleRemoteMotor::setReversed(int state){
    if(state!=0){
        reversed=1;
    } else {
        reversed=0;
    }
    return 1;
}