Hirdetés

Keresés

Új hozzászólás Aktív témák

  • Gergosz2

    veterán

    válasz JozsBiker #19090 üzenetére

    Nos, nem kell feladni, szoftversen is lehet rajta szűrni:

    #include <Arduino.h>

    #define cbi(sfr, bit) (_SFR_BYTE(sfr) &= ~_BV(bit))
    #define sbi(sfr, bit) (_SFR_BYTE(sfr) |= _BV(bit))
    #define ADC_BUFFER_SIZE 20
    #define ADC_PIN A0
    #define ADC_OFFSET 512.0f
    #define ADC_GAIN 0.0f // be kell állítani
    #define RMS_GAIN 0.05f // delta_T/T

    volatile uint8_t bufferIterator = 0;
    volatile uint16_t ADC_BUFFER[ADC_BUFFER_SIZE];
    volatile bool CalcRMS = false;
    volatile uint16_t FilterCoeffInv = 5u;
    uint16_t ADC_BUFFER_CALC[ADC_BUFFER_SIZE];
    float RMS_Current;


    unsigned long SerialTimer = 0u;
    unsigned long SerialPrintTimeout = 1000;

    void setup()
    {
    //Gergosz2 2023
    Serial.begin(51200);
    bufferIterator = 0;
    SerialTimer = millis();
    memset(ADC_BUFFER, (uint16_t)0, ADC_BUFFER_SIZE*sizeof(uint16_t));
    setupPWMInterrupt();
    }

    void loop()
    {
    if (true == CalcRMS)
    {
    CalcRMS = false;
    memcpy(ADC_BUFFER_CALC, ADC_BUFFER, ADC_BUFFER_SIZE*sizeof(uint16_t));
    RMS_Current = 0.0f;
    int iterator = 0;
    for (iterator = 0; iterator < ADC_BUFFER_SIZE; iterator++)
    {
    float SI_val = (((float)ADC_BUFFER_CALC[iterator] - ADC_OFFSET)*ADC_GAIN);
    RMS_Current = RMS_Current + SI_val*SI_val* RMS_GAIN;
    }
    RMS_Current = sqrt(RMS_Current);
    }

    if ((millis() - SerialTimer) > SerialPrintTimeout)
    {
    SerialTimer = millis();
    Serial.println(RMS_Current);
    }
    }

    void setupPWMInterrupt()
    {
    noInterrupts(); // disable all interrupts
    TCCR2A = 0; // set entire TCCR2A register to 0
    TCCR2B = 0; // same for TCCR2B
    TCNT2 = 0; //initialize counter value to 0
    // set compare match register for 1khz increments
    OCR2A = 124; // = (16*10^6) / (2*1000*64) - 1 (must be <256)
    TCCR2A |= (1 << WGM21); // turn on CTC mode
    TCCR2B |= (1 << CS22); // Set CS01 and CS00 bits for 64 prescaler

    sbi(TIMSK2, OCIE2A); // enable timer compare interrupt

    interrupts(); // enable all interrupts
    }

    ISR(TIMER2_COMPA_vect)
    {
    uint16_t prevSample = 0u;

    if(bufferIterator == 0u)
    {
    prevSample = ADC_BUFFER_SIZE - 1u;
    }
    else
    {
    prevSample = bufferIterator - 1u;
    }

    ADC_BUFFER[bufferIterator] = ADC_BUFFER[prevSample] - (uint16_t)(ADC_BUFFER[prevSample]/FilterCoeffInv) + (uint16_t)(analogRead(ADC_PIN)/FilterCoeffInv);

    bufferIterator ++;

    if (bufferIterator > ( ADC_BUFFER_SIZE - 1u) )
    {
    CalcRMS = true;
    bufferIterator = 0u;
    }
    }

    Gaineket ne felejts beírni

Új hozzászólás Aktív témák