mbedを用いた制御学生の制御 / motorlib

Motor.cpp

Committer:
tknara
Date:
2016-01-19
Revision:
0:0f53faf3b186
Child:
1:727b2172d97c

File content as of revision 0:0f53faf3b186:

#include "Motor.h"

#include "mbed.h"

motor::motor(PinName PWM, PinName fwd, PinName rev ,float period ,int select):
    pwm(PWM), cw(fwd), ccw(rev)
{
    pwm.period(period);
    if(select>1) {
        mode = 1;
        pwm = 0.5;
    } else {
        mode = 0;
        pwm = 0;
        cw = 0;
        ccw = 0;
    }

}
void motor::speed(float speed)
{
    if(mode == 0) {
        cw  = (speed > 0.0);
        ccw = (speed < 0.0);
        pwm = abs(speed);
    } else if(mode > 0) {
        pwm = 0.5+(speed*0.5);
    }
}