Main code of our project.

Dependencies:   TextLCD mbed PID

main.cpp

Committer:
nicovv44
Date:
2018-10-07
Revision:
3:a1b11dfd26f3
Parent:
2:e612706e18eb
Child:
4:886ce7eefa6e

File content as of revision 3:a1b11dfd26f3:

// Hello World! for the TextLCD

#include "mbed.h"
#include "TextLCD.h"

TextLCD             lcd(D2, D3, D4, D5, D6, D7); // rs, e, d4-d7
Serial              pc(USBTX, USBRX); // tx, rx
//PwmOut              pwm1(D9);
DigitalOut          relaySync(D8);

AnalogIn            syncPin(A0);
AnalogIn            gridPin(A1);
AnalogIn            differentialPin(A2);

const float         sqrt2 = 1.414213562;

Timeout             timeout;
volatile bool       looping = false;






// ##############################################
// ########## PROTOTYPES ########################
// #############################################################################
void stopLooping(void);
float getVolageRMS(AnalogIn ana_pin);
float getVolageReadedMax(AnalogIn ana_pin);
float getFrequency(AnalogIn ana_pin);













// ##############################################
// ########## MAIN ##############################
// #############################################################################
int main() {
    float syncRMS, gridRMS, syncFreq, gridFreq;
    
    relaySync = 1;//Relay off=1, on=0
    while(1){
        /*if(getVolageReadedMax(analog_pin1) < 0.020){
            relaySync = 0;//Relay off=1, on=0
            lcd.locate(0,0);
            lcd.printf("SYNC");
        }*/
        syncRMS = getVolageRMS(syncPin);
        gridRMS = getVolageRMS(gridPin);
        syncFreq = getFrequency(syncPin);
        gridFreq = getFrequency(gridPin);
        
        lcd.locate(0,0);//(col,row)
        lcd.printf("                ");
        lcd.locate(0,1);//(col,row)
        lcd.printf("                ");
        lcd.locate(0,0);//(col,row)
        lcd.printf("G:%3.1f@%3.1f", gridRMS, gridFreq);
        lcd.locate(0,1);//(col,row)
        lcd.printf("S:%3.1f@%3.1f", syncRMS, syncFreq);
    }
    
    
    // specify period first
    //pwm1.period(0.1f);      // 4 second period
    //pwm1.write(0.50f);      // 50% duty cycle, relative to period

}







// ##############################################
// ########## FUNCTIONS #########################
// #############################################################################
// ISR to stop loping
void stopLooping(void) {
    looping = false;//looping is volatile bool
}

// #############################################################################
float getVolageRMS(AnalogIn ana_pin){
    float v1;//readed voltage
    float v1Max = 0;//max readed voltage
    float VRMS; //RMS voltage
    looping = true;
    timeout.attach(callback(&stopLooping), 0.020);//T=20ms because f=50Hz
    while(looping){
        v1 = ana_pin.read()*3.3;
        if(v1 > v1Max){
            v1Max = v1;
        }
    }
    VRMS = (v1Max+0.685)*9.32/sqrt2;
    pc.printf("VRMS: %f\r\n",VRMS);
    return VRMS;
}


// #############################################################################
float getVolageReadedMax(AnalogIn ana_pin){
    float v1;//readed voltage
    float v1Max = 0;//max readed voltage
    looping = true;
    timeout.attach(callback(&stopLooping), 0.025);//T=25>20ms because f=50Hz
    while(looping){
        v1 = ana_pin.read()*3.3;
        if(v1 > v1Max){
            v1Max = v1;
        }
    }
    return v1Max;
}


// #############################################################################
float getFrequency(AnalogIn ana_pin){
    float   freq; //frequency
    float   maxReadedVoltage;//maximum voltage readed by the ADC
    float   readedVoltage;//readed voltage
    int     nbrRisingEdge=0;// number of rising edge detected
    float   T;//Periode
    Timer   timer;
    maxReadedVoltage = getVolageReadedMax(ana_pin);
    pc.printf("maxReadedVoltage: %f\r\n",maxReadedVoltage);
    bool aboveLine = true;
    looping = true;
    timeout.attach(callback(&stopLooping), 1);//try to find rising edges during 1sec max
    while(nbrRisingEdge<2 and looping){
        readedVoltage = ana_pin.read()*3.3;
        if(readedVoltage<(maxReadedVoltage/2)){//rising edge detection ready
            aboveLine = false;
        }
        if((maxReadedVoltage/2)<readedVoltage && aboveLine==false){//rising edge detected
            aboveLine = true;
            if(nbrRisingEdge==0)
                timer.start();
            if(nbrRisingEdge==1)
                timer.stop();
            nbrRisingEdge++;
        }
    }
    if(nbrRisingEdge!=2){
        lcd.locate(13,1);
        lcd.printf("f!%d",nbrRisingEdge);
    }
    T = timer.read();
    freq = 1/T;
    pc.printf("T: %f\r\n",T);
    pc.printf("freq: %f\r\n\n",freq);
    return freq;
}