jetfishteam / Mbed 2 deprecated jetfish

the fish that looks like a jet

Dependencies:   ADXL345 ADXL345_I2C IMUfilter ITG3200 mbed Servo

motor_controller.cpp

Committer:
rkk
Date:
2014-02-17
Revision:
16:79cfe6201318
Parent:
12:7eeb29892625

File content as of revision 16:79cfe6201318:

#include "motor_controller.h"

PololuMController::PololuMController(PinName pwmport, PinName A, PinName B)
    :pwm(pwmport),outA(A),outB(B)
{
    outA.write(0);
    outB.write(1);
}

void PololuMController::setpolarspeed(float speed)
{
    if (speed>=0) {
        outA.write(0);
        outB.write(1);
        pwm.write(abs(speed));
    } else {
        outA.write(1);
        outB.write(0);
        pwm.write(abs(speed));
    }
    return;
}