rpipin.cpp

#include "rpipin.h"
#include "plugin.h"
 
#include <string>
#include <algorithm>
#include <iostream>
 
#include <boost/thread.hpp>
 
#ifdef RPI
#include <wiringPi.h>
#include <softPwm.h>
#endif
 
//
//Class RpiPin
//
 
RpiPin::RpiPin()
{
}
 
RpiPin::RpiPin(int pin, int mode):
    mPin(pin),
    mMode(mode),
    mState(false),
    mSoftValue(0)
{
#ifdef RPI
    if (mMode == PWM_OUTPUT && mPin != 18)
    {
        softPwmCreate(mPin, 0, 100);
    }
    else if (mMode == SOFT_DIGITAL_INPUT)
    {
        mState = true;
        mThread = boost::thread(&RpiPin::threadLoop, this);
    }
    else
    {
        pinMode(mPin, mode);
    }
#endif
}
 
RpiPin::~RpiPin()
{
#ifdef RPI
    if (mState)
    {
        mState = false;
        mThread.join();
    }
 
    if (mMode == PWM_OUTPUT && mPin != 18)
    {
        softPwmStop(mPin);
    }
    else if (mMode == PWM_OUTPUT)
    {
        pwmWrite(mPin, 0);
    }
 
    if (mMode == OUTPUT || mMode == PWM_OUTPUT)
    {
        digitalWrite(mPin, 0);
    }
#endif
}
 
void RpiPin::threadLoop()
{
    int NUMREADINGS = 30;
 
#ifdef RPI
    while (mState)
    {
        int value = 0;
        for (int i = 0; i < NUMREADINGS && mState; i++)
        {
            pinMode(mPin, OUTPUT);
            digitalWrite(mPin, LOW);
            delay(10);
 
            int c = 0;
            pinMode(mPin, INPUT);
            while (digitalRead(mPin) == LOW && mState)
            {
              delayMicroseconds(1);
              c++;
            }
            value += c;
        }
 
        mSoftValue = value / NUMREADINGS;
        boost::this_thread::sleep_for(boost::chrono::milliseconds(16));
    }
#endif
}
 
void RpiPin::SetPullUpDnControl(int mode)
{
#ifdef RPI
    pullUpDnControl(mPin, mode);
#endif
}
 
void RpiPin::DigitalWrite(int value)
{
#ifdef RPI
    digitalWrite(mPin, value);
#endif
}
 
int RpiPin::DigitalRead()
{
#ifdef RPI
    return digitalRead(mPin);
#else
    return 0;
#endif
}
 
void RpiPin::AnalogWrite(int value)
{
#ifdef RPI
    if (mMode == PWM_OUTPUT)
    {
        if (mPin != 18)
        {
            softPwmWrite(mPin, value);
        }
        else
        {
            pwmWrite(mPin, value);
        }
    }
    else
        analogWrite(mPin, value);
#endif
}
 
int RpiPin::AnalogRead()
{
#ifdef RPI
    if (mMode == SOFT_DIGITAL_INPUT)
    {
        return mSoftValue;
    }
    else
    {
        return analogRead(mPin);
    }
#else
    return 0;
#endif
}
 
void RpiPin::PwmWrite(int value)
{
    if (value < 0)
        value = 0;
    else if (value > 1023)
        value = 1023;
 
#ifdef RPI
    if (mPin != 18)
    {
        softPwmWrite(mPin, value);
    }
    else
    {
        pwmWrite(mPin, value);
    }
#endif
}