rpiPCA9685.cpp

#include "rpiPCA9685.h"
#include "plugin.h"
 
#include <string>
#include <algorithm>
#include <iostream>
 
#ifdef RPI
#include <wiringPi.h>
#include <pca9685.h>
#endif
 
//
//Class RpiPCA9685
//
 
RpiPCA9685::RpiPCA9685(int deviceId, int pinBase, int frequency):
  mDeviceId(deviceId),
  mPinBase(pinBase)
{
  mFileHandler = 0;
#ifdef RPI
  mFileHandler = pca9685Setup(pinBase, deviceId, frequency);
#endif
}
 
RpiPCA9685::~RpiPCA9685()
{
#ifdef RPI
  if (mFileHandler != 0)
  {
    Reset();
    pca9685Unset(mFileHandler, mPinBase);
  }
#endif
}
 
int RpiPCA9685::PwmRead(int pin)
{
#ifdef RPI
  if (mFileHandler != 0)
  {
    int on;
    pca9685PWMRead(mFileHandler, pin, &on, 0);
    return on;
  }
#endif
  return 0;
}
 
void RpiPCA9685::PwmWrite(int pin, int value)
{
#ifdef RPI
  if (mFileHandler != 0)
  {
    if (value >= 4096)
      pca9685FullOn(mFileHandler, pin, 1);
        else if (value > 0)
      pca9685PWMWrite(mFileHandler, pin, 0, value);     // (Deactivates full-on and off by itself)
        else
      pca9685FullOff(mFileHandler, pin, 1);
  }
#endif
}
 
void RpiPCA9685::Reset()
{
#ifdef RPI
  if (mFileHandler != 0)
  {
    pca9685PWMReset(mFileHandler);
  }
#endif
}
 
void RpiPCA9685::SetFrequency(int frequency)
{
#ifdef RPI
  if (mFileHandler != 0)
  {
    pca9685PWMFreq(mFileHandler, frequency);
  }
#endif
}
 
void RpiPCA9685::FullOn(int pin)
{
#ifdef RPI
  if (mFileHandler != 0)
  {
    pca9685FullOn(mFileHandler, pin, 1);
  }
#endif
}
 
void RpiPCA9685::FullOff(int pin)
{
#ifdef RPI
  if (mFileHandler != 0)
  {
    pca9685FullOff(mFileHandler, pin, 1);
  }
#endif
}