softPWM

Dependents:   2021_NHK_A

SoftPWM.cpp

Committer:
THtakahiro702286
Date:
2021-10-16
Revision:
4:a0756a27dc4d
Parent:
1:cb8028e779a1

File content as of revision 4:a0756a27dc4d:

#include "mbed.h"
#include "InterruptIn.h"
#include "SoftPWM.h"

SoftPWM::SoftPWM(PinName _outpin,bool _positive) : pulse(_outpin)     //constructa  
{
    if ( _positive )
        pulse = 0;
    else
        pulse = 1;
    positive = _positive;
    interval = 0.02;
    width = 0;
    start(); 
}

float SoftPWM::read()
{
    if ( width <= 0.0 ) return 0.0;
    if ( width > 1.0 )  return 1.0;
    return width / interval;    
}

void SoftPWM::write(float duty)
{
    width = interval * duty;
    if ( duty <= 0.0 ) width =  0.0;
    if ( duty > 1.0 )  width =  interval;
}

void SoftPWM::start()
{
    _ticker.attach(callback(this, &SoftPWM::TickerInterrapt), interval);
//    _ticker.attach(Callback<void(void)>(this,&SoftPWM::TickerInterrapt),interval);
}

void SoftPWM::stop()
{
    _ticker.detach();
    if ( positive )
        pulse = 0;
    else
        pulse = 1;
    wait_ms(width);
}

void SoftPWM::period(float _period)
{
    interval = _period;
    start();
}

void SoftPWM::period_ms(int _period)
{
    period((float)_period / 1000);
    start();
}

void SoftPWM::period_us(int _period)
{
    period((float)_period / 1000000);
    start();
}

void SoftPWM::pulsewidth(float _width)
{
    width = _width;
   if ( width < 0.0 ) width = 0.0;
}

void SoftPWM::pulsewidth_ms(int _width)
{
     pulsewidth((float)_width / 1000);
}

void SoftPWM::pulsewidth_us(int _width)
{
    pulsewidth((float)_width / 1000000);
}

void SoftPWM::TickerInterrapt()
{ 
    if ( width <= 0 ) return;
//    _timeout.attach(&SoftPWM::end,width);
    _timeout.attach(Callback<void(void)>(this, &SoftPWM::end), width);
    if ( positive )
        pulse = 1;
    else
        pulse = 0;    
}

void SoftPWM::end()
{
    if ( positive )
        pulse = 0;
    else
        pulse = 1;    
//    _timeout.detach();
}
;