TER Atienza Pongnot 2019 / TLE5206_lib

Fork of TLE5206_lib by nicolas Atienza

TLE5206_lib.cpp

Committer:
natienza
Date:
2019-03-18
Revision:
2:610e4177e391
Parent:
1:1117196d767b
Child:
3:fa6c021ddefe

File content as of revision 2:610e4177e391:

#include "mbed.h"
#include "TLE5206_lib.h"

TLE5206::TLE5206(PinName IN1,PinName IN2):pwmIN1(IN1),pwmIN2(IN2){};

void TLE5206::setup(int periode_us){
    this->pwmIN1.period_us(periode_us);
    this->pwmIN2.period_us(periode_us);    
}

void TLE5206::write(float duty_cycle){
    if (duty_cycle < -1){
        this->pwmIN1 = 0.99;
        this->pwmIN2 = 0.0;
    }else if (duty_cycle < -0.4){
        this->pwmIN1 = -0.4;
        this->pwmIN2 = 0.0;
    }else if (duty_cycle < 0){
        this->pwmIN1 = -duty_cycle;
        this->pwmIN2 = 0.0;
    }else if (duty_cycle < 0.4){
        this.pwmIN1 = 0.0;
        this.pwmIN2 = 0.4;
    }else if (dutycycle < 1){
        this.pwmIN1 = 0.0;
        this.pwmIN2 = duty_cycle;
    }else {
        this->pwmIN1 = 0.0;
        this->pwmIN2 = 0.99;    
    }    
}