Diff: SoftPWM/SoftPWM.cpp

Revision:

0:d90f3421aaef

--- /dev/null	Thu Jan 01 00:00:00 1970 +0000
+++ b/SoftPWM/SoftPWM.cpp	Sat Nov 26 18:33:38 2016 +0000
@@ -0,0 +1,99 @@
+#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);
+}
+
+void SoftPWM::stop()
+{
+    _ticker.detach();
+    if ( positive )
+        pulse = 0;
+    else
+        pulse = 1;
+    wait(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(this,&SoftPWM::end,width);
+    if ( positive )
+        pulse = 1;
+    else
+        pulse = 0;    
+}
+
+void SoftPWM::end()
+{
+    if ( positive )
+        pulse = 0;
+    else
+        pulse = 1;    
+//    _timeout.detach();
+}
+;
+