GY-63_MS5611/libraries/WaveMix/WaveMix.cpp

//
//    FILE: WaveMix.cpp
//  AUTHOR: Rob Tillaart
// VERSION: 0.1.3
// PURPOSE: Arduino library to mix two signals (A and B) with an adaptive weight.
//     URL: https://github.com/RobTillaart/WaveMix


#include "WaveMix.h"


WaveMix::WaveMix()
{
  _weight[0] = 0.5;
  _weight[1] = 0.5;
  _gain      = 1.0;
  _offset    = 0.0;
}


bool WaveMix::setWeight(float weight1, float weight2)
{
  if ((weight1 + weight2) == 0) return false;  //  test for <= 0 ?
  float factor = 1.0 / (weight1 + weight2);
  _weight[0] = weight1 * factor;
  _weight[1] = weight2 * factor;
  return true;
}


bool WaveMix::setPercentage(float percentage)
{
  if ((percentage < 0) || (percentage > 100)) return false;
  _weight[0] = percentage * 0.01;
  _weight[1] = 1.0 - _weight[0];
  return true;
}


//  do we need a value check here
void  WaveMix::setGain(float gain) 
{
  _gain = gain;
};


float WaveMix::getGain()
{ 
  return _gain; 
};


//  do we need a value check here
void  WaveMix::setOffset(float offset) 
{ 
  _offset = offset; 
};


float WaveMix::getOffset() 
{ 
  return _offset; 
};


float WaveMix::mix(float s1, float s2)
{
  float total = 0;
  if (_gain == 0) return 0;
  if (_weight[0] != 0) total += (_weight[0] * s1);
  if (_weight[1] != 0) total += (_weight[1] * s2);
  total *= _gain;
  if (_offset != 0) total += _offset;
  return total;
}


//  -- END OF FILE --