QRZUA.CLUB

Код: Виділити все

static long filteredValue=0;
int outputValue;

const int aruTarget = 300;
const float attackTime = 0.9; //0.9 1.2
const float releaseTime = 1.9;
const float falpha = 0.2; // коэффициент сглаживания


int sensorValue = analogRead(analogInputPin);
sensorValue = map(sensorValue, 200,900,0,1024);

float smoothingFactor = 2.0 * exp(-1/(sensorValue > filteredValue ? attackTime : releaseTime));
filteredValue = falpha * sensorValue + (1 - falpha) * filteredValue * smoothingFactor;

// Регулирование усиления сигнала
int error = (aruTarget -(aruTarget- filteredValue));
error=constrain(error,100,350);
outputValue = map(error,100,500,100,550);

// Ограничение выхода в диапазон 0-1023
if (outputValue < 0) {
outputValue = 0;
} else if (outputValue > 1023) {
outputValue = 1023;
}
if (outputValue == 254 || outputValue == 255 || outputValue == 256) {
outputValue = 256;
}
// Отправка управляющего сигнала на ШИМ-выход
analogWrite(pwmOutputPin, outputValue); 

Код: Виділити все

#define cbi(sfr, bit) (_SFR_BYTE(sfr) &= ~_BV(bit))                                                                    
#define sbi(sfr, bit) (_SFR_BYTE(sfr) |= _BV(bit))                                                                     
                                                                                                                       
void setup()                                                                                                           
{                                                                                                                      
  // set an ADC prescale to 16 --> 76.8kHz per sample                                                                  
  sbi(ADCSRA, ADPS2);                                                                                                  
  cbi(ADCSRA, ADPS1);                                                                                                  
  cbi(ADCSRA, ADPS0);