rpishiftdriver.cpp

 
#include "rpishiftdriver.h"
#include "plugin.h"
 
#include <string>
#include <algorithm>
#include <iostream>
 
#include <boost/thread.hpp>
 
#ifdef RPI
#include <wiringPi.h>
#include <time.h>
#include <sys/time.h>
#endif
 
//
//Class RpiShiftDriver
//
 
RpiShiftDriver::RpiShiftDriver()
{
}
 
RpiShiftDriver::RpiShiftDriver(int data, int clock, int latch, int nbOut):
  mData(data),
  mClock(clock),
  mLatch(latch),
  mNbOut(nbOut),
  mCurPos(0),
  mState(false)
{
#ifdef RPI
  pinMode(mData, OUTPUT);
  pinMode(mClock, OUTPUT);
  pinMode(mLatch, OUTPUT);
 
  digitalWrite(mData, LOW);
  digitalWrite(mClock, LOW);
  digitalWrite(mLatch, LOW);
#endif
}
 
RpiShiftDriver::~RpiShiftDriver()
{
#ifdef RPI
  if (mState)
  {
    mState = false;
    mThread.join();
  }
 
  WriteValue(0);
 
  digitalWrite(mData, LOW);
  digitalWrite(mClock, LOW);
  digitalWrite(mLatch, LOW);
#endif
}
 
void RpiShiftDriver::threadLoop()
{
#ifdef RPI
  while (mState)
  {
    if (mCurPos >= mValues.size())
      mCurPos = 0;
 
    WriteValue(mValues[mCurPos].first);
 
    // Wait until the end of the time period
    boost::this_thread::sleep_for(boost::chrono::microseconds(mValues[mCurPos].second));
    mCurPos++;
  }
#endif
}
 
void RpiShiftDriver::WriteValue(int value)
{
#ifdef RPI
  int val = 0;
  for (int i = 0; i < mNbOut; i++)
  {
    val = (value & (1 << i)) ? HIGH : LOW;
    digitalWrite(mData, val);
    digitalWrite(mClock, HIGH);
    delayMicroseconds(1);
    digitalWrite(mClock, LOW);
  }
 
  digitalWrite(mLatch, HIGH);
  delayMicroseconds(1);
  digitalWrite(mLatch, LOW);
#endif
}
 
void RpiShiftDriver::SetValues(std::vector<shiftValue> values)
{
  mValues = values;
 
#ifdef RPI
  if (mState)
  {
    mState = false;
    mThread.join();
  }
 
  if (mValues.size() > 1)
  {
    mCurPos = 0;
    mState = true;
    mThread = boost::thread(&RpiShiftDriver::threadLoop, this);
  }
  else
  {
    if (mValues.size() > 0)
      WriteValue(mValues[0].first);
    else
      WriteValue(0);
  }
#endif
}