softPWM
SoftPWM.cpp
- Committer:
- piroro4560
- Date:
- 2021-03-04
- Revision:
- 2:594922580cdc
- Parent:
- 0:9a7ca977803b
File content as of revision 2:594922580cdc:
#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(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; thread_sleep_for(width*1000); } 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(this, &SoftPWM::end, width); _timeout.attach(callback(this, &SoftPWM::end), width); if ( positive ) pulse = 1; else pulse = 0; } void SoftPWM::end() { if ( positive ) pulse = 0; else pulse = 1; // _timeout.detach(); } ;