kazushiro tanimoto / Mbed 2 deprecated sagawa_lpc1114

Sagawa Electronics,inc.

Dependencies:   mbed

Fork of sagawa_lpc1114 by kazushiro tanimoto

TB6612FNG/TB6612.cpp

Committer:
zero515
Date:
2016-11-26
Revision:
2:de000dc1b277
Parent:
1:dbde3f68f80d

File content as of revision 2:de000dc1b277:

#include "TB6612.h"

// TB6612 Class Constructor
TB6612::TB6612(PinName pwm, PinName fwd, PinName rev):
        _pwm(pwm), _fwd(fwd), _rev(rev) {

    _fwd = 0;
    _rev = 0;
    _pwm = 0.0;
    stat = 0;
    _pwm.period(0.001);
    
}

// Speed Control
//  arg
//   float speed -1.0 - 0.0 - 1.0
float TB6612::speed(float speed) {
    
    
    
    if( speed > 0.0 )
    {
        if( speed > 0.7)    speed = 0.7;
        _pwm = speed;
        _fwd = 1;
        _rev = 0;
        stat = 1;
    }
    else if( speed < 0.0 )
    {
        if( speed < -0.7)    speed = -0.7;
        _pwm = -speed;
        _fwd = 0;
        _rev = 1;
        stat = -1;
    }
    else
    {
        _fwd = 1;
        _rev = 1;
        stat = 0;
    }
    return speed==0 ? 0 : speed > 0 ? 1 : -1;
}