GY-63_MS5611/libraries/WaveMix/WaveMix.cpp
2022-03-27 10:26:59 +02:00

51 lines
913 B
C++

//
// FILE: WaveMix.cpp
// AUTHOR: Rob Tillaart
// VERSION: 0.1.2
// 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;
}
void WaveMix::setWeight(float weight1, float weight2)
{
float factor = 1.0 / (weight1 + weight2);
_weight[0] = weight1 * factor;
_weight[1] = weight2 * factor;
}
void WaveMix::setPercentage(float percentage)
{
_weight[0] = percentage * 0.01;
_weight[1] = 1.0 - _weight[0];
}
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 --