UNFINISHED

Dependencies:   HCSR04 SRF05 mbed

motor.cpp

Committer:
Charlie_He
Date:
2018-06-08
Revision:
1:60c79e942c98

File content as of revision 1:60c79e942c98:

#include "mbed.h"
#include "motor.h"

void Motor::setSpeed(float speed)
{
    if(speed > 0) {
        motorA = direction?1:0;
        motorB = direction?0:1;
    } else {
        motorA = direction?0:1;
        motorB = direction?1:0;
    }

    motorSpeed = speed;
    
    motorS = abs(speed);
}