File content as of revision 10:193cd7ad5718:

// 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              pwmDC(D9);
PwmOut              pwmSY(D13);
DigitalOut          relay1(D8);
DigitalOut          relay2(D14);
DigitalOut          relay3(D11);
DigitalOut          relay4(D12);

AnalogIn            syncPin(A0);
AnalogIn            gridPin(A1);
AnalogIn            differentialPin(A2);
AnalogIn            potarDC(A3);
AnalogIn            potarSY(A4);

const float         sqrt2 = 1.414213562;

Timeout             timeout;
Ticker              tickerPWMDC;
volatile bool       looping = false;
volatile bool       synchronized = false;
volatile bool       mainLoop = true;





// ##############################################
// ########## PROTOTYPES ########################
// #############################################################################
void stopLooping(void);
float getVolageRMS(AnalogIn ana_pin);
float getVolageReadedMax(AnalogIn ana_pin);
float getFrequency(AnalogIn ana_pin);
void displayLCD(float syncRMS, float gridRMS, float syncFreq, float gridFreq);
void tickerPWMDCfunction();













// ##############################################
// ########## MAIN ##############################
// #############################################################################
int main() {
    float syncRMS, gridRMS, syncFreq, gridFreq;
    
    relay1 = 1;//Relay off=1, on=0
    relay2 = 1;//Relay off=1, on=0
    relay3 = 1;//Relay off=1, on=0
    relay4 = 0;//Relay off=1, on=0
    
    while(mainLoop){
        pwmDC.period(0.00005f);
        pwmDC.write(1-0.90f); //(1-duty)
        pwmSY.period(0.00005f); //(1-duty)
        pwmSY.write(1-0.80f);
        //tickerPWMDC.attach(&tickerPWMDCfunction, 0.1);
        
        pc.printf("\nAccelerating\n\r");
        wait(5);
        pwmDC.write(1-0.70f); //(1-duty)
        
        //manual synchronisation
        while(!synchronized){
            //measure and calculate desired value
            //syncRMS = getVolageRMS(syncPin);
            //gridRMS = getVolageRMS(gridPin);
            syncFreq = getFrequency(syncPin);
            pc.printf("syncFreq:%f\r\n",syncFreq);
            //gridFreq = getFrequency(gridPin);
            //display values on LCD
            displayLCD(syncRMS, gridRMS, syncFreq, gridFreq);
            //voltage and frequency matching
            if(abs(syncRMS-gridRMS)<0.5 && abs(syncFreq-gridFreq)<0.1){
                pc.printf("voltage and freqency OK\r\n");
                lcd.locate(0,0);//(col,row)
                lcd.printf("V&f OK");
                while(!synchronized){//phase matching loop
                    //phase matching
                    if(getVolageReadedMax(differentialPin) < 0.050){
                        pc.printf("SYNCHONIZATION OK\r\n\n");
                        lcd.locate(0,1);//(col,row)
                        lcd.printf("SYNC OK ");
                        relay1 = 0;//Relay off=1, on=0 // to hear the noise
                        relay2 = 0;//Relay off=1, on=0 // to hear the noise
                        relay3 = 0;//Relay off=1, on=0 // to hear the noise
                        relay4 = 1;//Relay off=1, on=0 // to hear the noise
                        synchronized = true;
                        mainLoop = false;
                    }
                }
            }
        }
    }
    

    

}







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

// #############################################################################
// ISR to update pwmDC with potarDC
void tickerPWMDCfunction(){
    float valuePotar1;
    float valuePotar2;
    valuePotar1 = potarDC.read();
    pwmDC.write(1-valuePotar1);
    valuePotar2 = potarSY.read();
    pwmSY.write(1-valuePotar2);
    //lcd.locate(12,0);//(col,row)
    //lcd.printf("%f",valuePotar);
}

// #############################################################################
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.050);//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.050);//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;
    bool allowedClicTimer = false;
    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
            allowedClicTimer = true;
            aboveLine = true;
        }
        if((maxReadedVoltage*2/3)<readedVoltage && allowedClicTimer==true){//rising edge detected
            allowedClicTimer = false;
            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);
    if(looping==false)
    freq = 0;
    return freq;
}


// #############################################################################
void displayLCD(float syncRMS, float gridRMS, float syncFreq, float gridFreq){
    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);
}