fujimoto keita / libraries

For Rotaryencoder and Motor

Dependencies:   arrc_mbed

Dependents:  

motor.cpp

Committer:
m2130
Date:
22 months ago
Revision:
1:9e7d6d72e352
Parent:
0:b1487fd792c9

File content as of revision 1:9e7d6d72e352:

#include "motor.hpp"

Motor::Motor(PinName MP, PinName MM): mp(MP), mm(MM){
    mp.period_us(2048);
    mm.period_us(2048);
}

void Motor::out(double pwm){
    if(pwm > 0.0){
        mp = pwm > 0.5 ? 0.5 : pwm;
        mm = 0.0;
    }
    else if(pwm == 0){
        mp = 0.0;
        mm = 0.0;
    }
    else{
        mp = 0.0;
        mm = -pwm > 0.5 ? 0.5 : -pwm;
    }
}