First Version
Dependencies: EthernetInterface mbed-rtos mbed
Diff: main.cpp
- Revision:
- 0:9df41090ba33
- Child:
- 1:ce016c668e34
--- /dev/null Thu Jan 01 00:00:00 1970 +0000 +++ b/main.cpp Tue Jul 21 21:29:49 2015 +0000 @@ -0,0 +1,337 @@ +/* + Novo projeto PMED_Calibra + Criado para: + - Auxiliar no processo de calibração dos valores de offset e ganho das tomadas + - Faciliar os testes da leitura de RFID nas tomadas + +*/ +#include <stdio.h> + +#include "mbed.h" +#include "rtos.h" +#include "cmsis_os.h" +#include "EthernetInterface.h" +#include "Settings.h" +#include "Capture.h" +#include "Http_post.h" +#include "CommTCP.h" +#include "SignalProcessor.h" +#include "EventDetector.h" + +extern "C" void mbed_reset(); + +EthernetInterface eth; + +void InitializeEthernetLink(); +int SelectOption(); +void ShowRMSValues(); +void ShowMeanValues(); +void ShowSamplesFromChannel(); +int SelectChannel(); +void SetOffset(); +void SetGain(); +void TestRFID(); + +void thread1(void const *args) +{ + DigitalOut led1(LED1); + int op = 0; + + Capture::Initialize(); + + while(1) + { + op = SelectOption(); + + switch (op) { + case (1): ShowRMSValues(); break; + case (2): ShowMeanValues(); break; + case (3): ShowSamplesFromChannel(); break; + case (4): SetOffset(); break; + case (5): SetGain(); break; + case (6): TestRFID(); break; + case (8): mbed_reset(); break; + } + } +} + +int main() { + FILE *f; + //Set Highest Priority + //osThreadSetPriority(osThreadGetId(),osPriorityHigh); + + Settings::ReadFile(); + //printf("Passou Settings, carregou arquivo\n"); + //Settings::ShowValues(); + + InitializeEthernetLink(); + //printf("Inicializou link Ethernet\n"); + printf("\nIP Address is NEW %s\n", eth.getIPAddress()); + + //Start HTTP POST service + //Thread http_post(HttpPost::HttpPost_Thread); + + //Start TCP daemon service + //Thread TcpService(CommTCP::CommTCP_Thread); + + + //Start Telnet Service + //Thread telnetserver(TelnetServer::TelnetServer_Thread); + //Start TFTP Service + + /* + unsigned short vet[256] = {2105,2105,2113,2127,2127,2125,2112,2113,2130,2130,2123,2112,2112,2128,2128,2123,2112,2113,2136,2136,2374,2551,2671,2869,2887,3036,2964,2964,2964,3145,3145,3206,3209,3298,3298,3264,3261,3208,3239,3239,3197,3197,3113,3032,3065,3065,3000,2901,2943,2943,2900,2852,2844,2863,2863,2838,2764,2791,2724,2724,2668,2710,2636,2658,2658,2606,2527,2443,2434,2434,2258,2066,2061,2080,2080,2063,2055,2055,2070,2070,2064,2051,2054,2069,2069,2062,2054,2058,2066,2309,2062,2052,2054,2067,2067,2063,2051,2049,2068,2068,2060,2053,2050,2067,2066,2069,2051,2053,2070,2070,2064,2050,2053,2070,2070,2062,2052,2055,2068,2068,2065,2052,2057,2072,2072,2064,2054,2054,2072,2072,2064,2053,2052,2069,2069,2064,2052,2053,2064,2064,2062,2049,2051,2067,2067,2059,2051,2050,2068,2068,2058,2046,2050,2068,2068,2061,2052,2058,2068,2068,2059,2052,2053,2067,2067,1744,1526,1471,1289,1289,1137,1142,1055,1120,1120,997,967,894,941,941,928,887,1001,949,949,1028,1105,1079,1191,1191,1223,1211,1223,1267,1267,1325,1267,1356,1327,1327,1369,1439,1381,1498,1498,1503,1503,1527,1545,1545,1635,1650,1778,1792,1792,1971,2108,2109,2126,2126,2124,2117,2118,2131,2131,2126,2118,2118,2138,2138,2134,2124,2114,2135,2135,2129,2121,2120,2136,2136,2128,2122,2122,2143,2120,2130,2120,2121,2139,2139,2130,2119,2121,2136,2136,2129}; + float sen[12],cos[12],vm; + SignalProcessor::CalculateFFT(vet,sen,cos,&vm,1); + + printf("VM = %f\n",vm); + for(int i=0;i<12;i++) + { + printf("SEN%d = %f, COS%d = %f\n",i,sen[i],i,cos[i]); + } + */ + //Jump to the capture routine(will run on this thread) + thread1(NULL); + + while(1){//never reaches here + printf("Reset\n"); + f = fopen(FILENAMERESET, "a"); + if (f == NULL) + f = fopen(FILENAMERESET, "w"); + fprintf(f, "Laco Errado\n"); + fclose(f); + Thread::yield(); + } +} + +void TestRFID(){ + char rfid_number[9]; + int num_tom = 0; + while (1){ + printf("\nType the outlet number (1 to 3): "); + scanf("%d", &num_tom); + if ((num_tom > 3) || (num_tom < 1) ) + printf("Invalid Outlet - Retype (1 to 3) !!! "); + else + break; + } + + Capture::ReadRFID((int)(num_tom - '0'),rfid_number); + printf("\n\nRFID SERIAL NUMBER: "); + printf("{%8s}\n\n", rfid_number); +} + +void SetGain(){ + float rms[NUMBER_OF_CHANNELS], mv2[NUMBER_OF_CHANNELS]; + int under[NUMBER_OF_CHANNELS], over[NUMBER_OF_CHANNELS]; + float corrente = 0; + int num_canal = 0; + float soma_rms = 0; + unsigned int cont = 0; + float ganho = 0; + + printf("\n\nGain Adjustment:\n"); + printf("\nFor Adjust the gain, ALL gains in config file (PMED.TXT) MUST be 1 (one)"); + num_canal = SelectChannel(); + if (Settings::get_Gain(num_canal) != 1){ + printf("\n\nIt is impossibile to continue.\n"); + printf("\nThe gain in channel %d is %f and MUST be be equal to 1 (one).", num_canal, Settings::get_Gain(num_canal)); + printf("\nPut in the config file (PMED.TXT)\n\ngain%d=1\n", num_canal); + printf("\nAfter save the config file, you MUST restart the mbed."); + return; + } + + printf("\nConnect the plug with the current used to adjustment (%s)", num_canal%2==0?"Phase":"Leakage"); + printf("\nSwitch on the charge and with an ammeter verify the current (RMS) consumed."); + printf("\nType the current in ammeter (%s): ", num_canal%2==0?"A":"mA"); + scanf("%f", &corrente); + + printf("\nWait aproximatelly 0.5s\n"); + + while(cont<30) + { + SignalProcessor::CalculateRMSBulk(rms, mv2, under, over); + soma_rms += rms[num_canal]; + cont++; + } + soma_rms /= 30; + ganho = soma_rms/corrente; + printf("\nPut in the configuration file (PMED.TXT)\ngain%d=%.4f\n\n",num_canal,ganho); + printf("\nRepeat this procedure for the others channels and at the end, reset the Mbed.\n"); +} + +void SetOffset(){ + unsigned char tecla=0; + unsigned int soma[6]={0,0,0,0,0,0}; + int cont = 0; + float rms[NUMBER_OF_CHANNELS], mv2[NUMBER_OF_CHANNELS]; + int under[NUMBER_OF_CHANNELS], over[NUMBER_OF_CHANNELS]; + + printf("\n\nAdjustment of Offset\n"); + printf("\nSwitch off all plugs from outlets."); + printf("\nKeep the Protegemed on.\n"); + printf("\nType any key and press <ENTER> when ready!\n"); + scanf("%c", &tecla); + + printf("Wait aproximatelly 0.5s\n"); + + while(cont<30) + { + SignalProcessor::CalculateRMSBulk(rms, mv2, under, over); + for (int i=0; i<6;i++) + { + soma[i] += mv2[i]; + } + cont++; + } + for (int i=0; i<6 ; i++) + { + soma[i] = soma[i]/30; + } + printf("\n\nPut in file PMED.TXT an save it:\n"); + for (int i=0; i<6 ; i++) + { + printf("offset%d=%u\n", i, soma[i]); + } + + printf("\n\nReset the Mbed.\n"); + printf("\n\nYou MUST in the sequence adjust the gain!!!\n\n"); +} + +int SelectChannel(){ + int num_channel = 0; + while(1){ + printf("\n\nOdd channels are leakage and even channels are phase!!"); + printf("\nSelect a channel to visualize samples(0 to 5): "); + scanf("%d", &num_channel); + if ( (num_channel > 5) || (num_channel < 0) ) + printf("\n\n\nInvalid Channel! - Retype a valid channel\n\n\n "); + else + break; + } + return num_channel; +} + + +void ShowSamplesFromChannel(){ + unsigned short samples[NUMBER_OF_SAMPLES]; + int cont = 0; + int num_channel = SelectChannel(); + + + printf("\nValues of %d samples from channel %d.\n\n", NUMBER_OF_SAMPLES, num_channel ); + + while(cont < 5) + { + Capture::CopyBuffer(num_channel, samples); + printf("\n******* %da. sequence of samples (%s)\n\n", cont+1, num_channel%2==0?"Phase":"Leakage"); + for (int k=0; k< NUMBER_OF_SAMPLES; k++) + { + printf("%d ", samples[k]); + } + printf("\n"); + cont++; + } +} + +int SelectOption() +{ + int option; + + while (true) + { + printf("\n\n"); + printf("+-------------------------------------+\n"); + printf("| PMED_Calibra: MENU |\n"); + printf("| 1. RMS Values. |\n"); + printf("| 2. Mean Values. |\n"); + printf("| 3. Read samples from 1 channel. |\n"); + printf("| 4. Offset adjust. |\n"); + printf("| 5. Gain adjust. |\n"); + printf("| 6. Read RFID tag. |\n"); + printf("| 7. Test RFID Read (many times). |\n"); + printf("| 8. Reset the Mbed |\n"); + printf("+-------------------------------------+\n"); + printf("Select an Option: "); + + scanf("%d", &option); + if ( (option > 8) || (option < 1) ){ + printf("\n\n\nInvalid Option! - Retype a valid option\n\n\n "); + } + else + break; + } + + return option; +} + + +void ShowMeanValues(){ + float rms[NUMBER_OF_CHANNELS], avg[NUMBER_OF_CHANNELS], mv2[NUMBER_OF_CHANNELS]; + int under[NUMBER_OF_CHANNELS], over[NUMBER_OF_CHANNELS]; + + int cont = 0; + avg[0] = avg[1] = avg[2] = avg[3] = avg[4] = avg[5] = 0; + printf("\n\n------------------------------Mean VALUES-------------------------------"); + printf("\nCHANNEL\t0\t1\t\t2\t3\t\t4\t5"); + printf("\n\tPhase1\tLeakage1\tPhase2\tLeakage2\tPhase3\tLeakage3"); + printf("\n------------------------------------------------------------------------"); + while (cont < 10) + { + Capture::Wait(); + SignalProcessor::CalculateRMSBulk(rms, mv2, under, over); + printf("\n%2d\t%.2f\t%.2f\t\t%.2f\t%.2f\t\t%.2f\t%.2f", cont+1,mv2[0],mv2[1],mv2[2],mv2[3],mv2[4],mv2[5]); + avg[0] += mv2[0]; + avg[1] += mv2[1]; + avg[2] += mv2[2]; + avg[3] += mv2[3]; + avg[4] += mv2[4]; + avg[5] += mv2[5]; + cont++; + } + printf("\n------------------------------------------------------------------------"); + printf("\nAvg:\t%.2f\t%.2f\t\t%.2f\t%.2f\t\t%.2f\t%.2f",avg[0]/cont,avg[1]/cont,avg[2]/cont,avg[3]/cont,avg[4]/cont,avg[5]/cont); + printf("\n------------------------------------------------------------------------\n\n"); +} + +void ShowRMSValues(){ + float rms[NUMBER_OF_CHANNELS], avg[NUMBER_OF_CHANNELS], mv2[NUMBER_OF_CHANNELS]; + int under[NUMBER_OF_CHANNELS], over[NUMBER_OF_CHANNELS]; + + int cont = 0; + avg[0] = avg[1] = avg[2] = avg[3] = avg[4] = avg[5] = 0; + printf("\n\n-------------------------------RMS VALUES-------------------------------"); + printf("\nCHANNEL\t0\t1\t\t2\t3\t\t4\t5"); + printf("\n\tPhase1\tLeakage1\tPhase2\tLeakage2\tPhase3\tLeakage3"); + printf("\n------------------------------------------------------------------------"); + while (cont < 10) + { + Capture::Wait(); + SignalProcessor::CalculateRMSBulk(rms, mv2, under, over); + printf("\n%2d\t%.2f\t%.2f\t\t%.2f\t%.2f\t\t%.2f\t%.2f", cont+1,rms[0],rms[1],rms[2],rms[3],rms[4],rms[5]); + avg[0] += rms[0]; + avg[1] += rms[1]; + avg[2] += rms[2]; + avg[3] += rms[3]; + avg[4] += rms[4]; + avg[5] += rms[5]; + cont++; + } + printf("\n------------------------------------------------------------------------"); + printf("\nAvg:\t%.2f\t%.2f\t\t%.2f\t%.2f\t\t%.2f\t%.2f",avg[0]/cont,avg[1]/cont,avg[2]/cont,avg[3]/cont,avg[4]/cont,avg[5]/cont); + printf("\n------------------------------------------------------------------------\n\n"); +} + +void InitializeEthernetLink() +{ + if(Settings::get_Dhcp()) + //EthernetIf::Initialize(); //Use DHCP + eth.init(); //Use DHCP + else + //EthernetIf::Initialize(Settings::get_IpAddress(),Settings::get_Netmask(),Settings::get_Gateway()); + eth.init(Settings::get_IpAddress(),Settings::get_Netmask(),Settings::get_Gateway()); + + //EthernetIf::Connect(); + eth.connect(); + //printf("IP Address is %s\n", EthernetIf::get_IpAddress()); +}