Smart Electrical Power Analyzer

//gcc Energy_QoS.c -o Energy_QoS -lm -lpthread
#include <unistd.h>
#include <stdio.h>
#include <time.h>
#include <errno.h>
#include <fcntl.h> 
#include <stdlib.h>
#include <string.h>
#include <termios.h>
#include <signal.h>
#include <limits.h>
#include <sys/ioctl.h>
#include <sys/types.h>
#include <sys/stat.h>
#include <sys/time.h>
#include <pthread.h>
#include <net/if.h>
#include <pthread.h>
#include <math.h>
#define SIZE_BUFFER 8

char buffer_tx[] = {0,0,0,0,0,0,0,0};
char buffer_rx[] = {0,0,0,0,0,0,0,0};

time_t timer;
struct tm *horarioLocal;
int dia, mes, ano, hora, min, sec;

volatile unsigned short int msg_receive = 0, nbytes = 0;
volatile unsigned short int running = 1;
unsigned short int nwrite;
unsigned short int nread;
pthread_t thread_id;
char *portname = "/dev/ttyACM0";
int handle;	
int n = SIZE_BUFFER;
unsigned short int anomalias = 0;
void signal_Handler(int sign){
	int o_exit = 0;
	switch (sign){
		case SIGINT:{
			o_exit = 1;
			break;
		}
		case SIGTERM:{
			o_exit = 1;
			break;
		}
		default:{
			break;
		}
	}

	if (o_exit == 1)
	running = 0;
}

void *uart_msg_receive(void *t){
	while(running){
		for(n = 0; n < SIZE_BUFFER; n++){
			nread = read(handle,&buffer_rx[n],1);
			/*if(nread < 0){
				printf("Read error\n");
			}else{
				printf("Data (%d) read = %d \n",n,buffer_rx[n]);
			}*/		
		}		
        msg_receive = 1;
        usleep(1000);
        while(msg_receive);
    }
}

int set_interface_attribs(int fd, int speed){
    struct termios tty;
    if (tcgetattr(fd, &tty) < 0) {
        printf("Error from tcgetattr: %s\n", strerror(errno));
        return -1;
    }
    cfsetospeed(&tty, (speed_t)speed);
    cfsetispeed(&tty, (speed_t)speed);
    tty.c_cflag |= (CLOCAL | CREAD);	/* ignore modem controls */
    tty.c_cflag &= ~CSIZE;
    tty.c_cflag |= CS8;					/* 8-bit characters */
    tty.c_cflag &= ~PARENB;				/* no parity bit */
    tty.c_cflag &= ~CSTOPB;				/* only need 1 stop bit */
    tty.c_cflag &= ~CRTSCTS;			/* no hardware flowcontrol */
    /* setup for non-canonical mode */
    tty.c_iflag &= ~(IGNBRK | BRKINT | PARMRK | ISTRIP | INLCR | IGNCR | ICRNL | IXON);
    tty.c_lflag &= ~(ECHO | ECHONL | ICANON | ISIG | IEXTEN);
    tty.c_oflag &= ~OPOST;
    /* fetch bytes as they become available */
    tty.c_cc[VMIN] = 1;
    tty.c_cc[VTIME] = 1;
    if (tcsetattr(fd, TCSANOW, &tty) != 0) {
        printf("Error from tcsetattr: %s\n", strerror(errno));
        return -1;
    }
    return 0;
}

void set_mincount(int fd, int mcount){
    struct termios tty;
    if (tcgetattr(fd, &tty) < 0) {
        printf("Error tcgetattr: %s\n", strerror(errno));
        return;
    }
    tty.c_cc[VMIN] = mcount ? 1 : 0;
    tty.c_cc[VTIME] = 5;        /* half second timer */
    if (tcsetattr(fd, TCSANOW, &tty) < 0)
        printf("Error tcsetattr: %s\n", strerror(errno));
}

void update_time(void){
    time(&timer);
	horarioLocal = localtime(&timer);
	dia = horarioLocal->tm_mday;
	mes = horarioLocal->tm_mon + 1;
	ano = horarioLocal->tm_year + 1900;
	hora = horarioLocal->tm_hour;
	min  = horarioLocal->tm_min;
	sec  = horarioLocal->tm_sec;
}


int main(void){	

	/////
	unsigned int i = 0, count = 0;
	unsigned char c = 0, wave_complete = 0, harm_ord = 1;
	float v_vector[2048], f = 0, v = 0, p = 0, q =0;
	float Mag_vg[53], Mag_ig[53]; 
	/////
	char query[512], str[30];
	FILE *dataloger;
	FILE *temperatureFile;

	handle = open(portname, O_RDWR | O_NOCTTY | O_SYNC);
    if (handle < 0) {
		printf("Error opening %s: %s\n", portname, strerror(errno));
        return -1;
    }    
    set_interface_attribs(handle, B115200);// baudrate 115200, 8 bits, no parity, 1 stop bit
   	
	if( pthread_create(&thread_id, NULL, &uart_msg_receive, NULL) ){
		printf("\nErro thread\n");
    }
    
	for(i = 0; i < 2048; i++){
		v_vector[i] = 0.0;
	}
	
	signal(SIGINT,  signal_Handler);
    signal(SIGTERM, signal_Handler);
	time(NULL);

	sleep(1);
	
	buffer_tx[0] = 0xF0;
	buffer_tx[1] = 0x01;
	nwrite = write(handle,buffer_tx,8);
	tcdrain(handle);

	while (running){
		if(msg_receive){
			if( (buffer_rx[0] >> 4) == 1 ){
				
				i = ((buffer_rx[0] & 0x07) << 8) + (buffer_rx[1] & 0xFF);
				for(c = 2; c < 8; c++){
					if(i < 2048){
						if( (buffer_rx[c] & 0x80) == 0x80)
							v_vector[i] = -0.01*( (float)((0xFF ^ buffer_rx[c]) + 1) );
						else
							v_vector[i] = 0.01*((float)buffer_rx[c]);
						i++;						
					}				
				}
				
				if(i == 2048){
					anomalias++;
					wave_complete = 1;
				}
			}else if( (buffer_rx[0] >> 4) == 2 ){
				if( (buffer_rx[2] & 0x80) == 0x80)
					v = -0.1*( (float)((( 0xFF ^ buffer_rx[2])<<8) + ( 0xFF ^ buffer_rx[3]) + 1 ) );
				else
					v = 0.1*( (float)((buffer_rx[2]<<8) + (buffer_rx[3]) ) );

				if( (buffer_rx[4] & 0x80) == 0x80)
					f = -0.01*( (float)((( 0xFF ^ buffer_rx[4])<<8) + ( 0xFF ^ buffer_rx[5]) + 1 ) );
				else
					f = 0.01*( (float)((buffer_rx[4]<<8) + (buffer_rx[5]) ) );

				if( (buffer_rx[6] & 0x80) == 0x80)
					p = -0.01*( (float)( (0xFF ^ buffer_rx[6]) + 1) );
				else
					p = 0.01*( (float)((int)buffer_rx[6]));

				if( (buffer_rx[7] & 0x80) == 0x80)
					q = -0.01*( (float)( (0xFF ^ buffer_rx[7]) + 1) );
				else
					q = 0.01*( (float)buffer_rx[7]);
				
				update_time();

				dataloger = fopen("dataloger_1.csv","a");
				if(dataloger == NULL){
					printf("\nErro dataloger\n!");
					exit(1);
				}			
				sprintf(query,"%d,%d,%d,%d,%d,%d,%.2f,%.2f,%.2f,%.2f\n",dia,mes,ano,hora,min,sec,v,f,p,q);
				fprintf(dataloger,"%s",query);			
				
				fclose(dataloger);				
			}else if( (buffer_rx[0] >> 4) == 3 ){
				
				for(c = 1; c < 8; c++){					
					Mag_vg[harm_ord] = 0.1*((float)((unsigned)buffer_rx[c]));
					harm_ord = harm_ord+2;
					if(harm_ord == 53){
						sprintf(query,"v,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f\n",Mag_vg[1],Mag_vg[3],Mag_vg[5],Mag_vg[7],Mag_vg[9],Mag_vg[11],Mag_vg[13],Mag_vg[15],Mag_vg[17],Mag_vg[19],Mag_vg[21],Mag_vg[23],Mag_vg[25],Mag_vg[27],Mag_vg[29],Mag_vg[31],Mag_vg[33],Mag_vg[35],Mag_vg[37],Mag_vg[39],Mag_vg[41],Mag_vg[43],Mag_vg[45],Mag_vg[47],Mag_vg[49],Mag_vg[51]);
						dataloger = fopen("dataloger_2.csv","a");
						if(dataloger == NULL){
							printf("\nErro fft dataloger\n!");
							exit(1);
						}else{		
							fprintf(dataloger,"%s",query);				
						}
						harm_ord = 1;
						fclose(dataloger);
						break;
					}					
				}
				
			}else if( (buffer_rx[0] >> 4) == 4 ){
				
				for(c = 1; c < 8; c++){					
					Mag_ig[harm_ord] = 0.1*((float) ((unsigned)buffer_rx[c]) );
					harm_ord = harm_ord+2;
					if(harm_ord == 53){
						sprintf(query,"i,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f,%.2f\n",Mag_ig[1],Mag_ig[3],Mag_ig[5],Mag_ig[7],Mag_ig[9],Mag_ig[11],Mag_ig[13],Mag_ig[15],Mag_ig[17],Mag_ig[19],Mag_ig[21],Mag_ig[23],Mag_ig[25],Mag_ig[27],Mag_ig[29],Mag_ig[31],Mag_ig[33],Mag_ig[35],Mag_ig[37],Mag_ig[39],Mag_ig[41],Mag_ig[43],Mag_ig[45],Mag_ig[47],Mag_ig[49],Mag_ig[51]);
						dataloger = fopen("dataloger_2.csv","a");
						if(dataloger == NULL){
							printf("\nErro fft dataloger\n!");
							exit(1);
						}else{		
							fprintf(dataloger,"%s",query);				
						}
						harm_ord = 1;
						fclose(dataloger);
						break;
					}					
				}			
			}

			memset(buffer_rx,0,sizeof(buffer_rx));
			msg_receive = 0;
		}
		
		if(wave_complete){
			
			update_time();
			
			dataloger = fopen("dataloger_0.csv","a");
			if(dataloger == NULL){
				printf("\nErro dataloger\n!");
                exit(1);
			}			
			for(i = 0; i < 2048; i++){				
				sprintf(query,"%d,%d,%d,%d,%d,%d,%d,%.3f\n",dia,mes,ano,hora,min,sec,i,v_vector[i]);
				fprintf(dataloger,"%s",query);			
			}
			fclose(dataloger);
			memset(buffer_tx,0,sizeof(buffer_rx));
			buffer_tx[0] = 0xF1;
			nwrite = write(handle,buffer_tx,8);
			tcdrain(handle);
			for(i = 0; i < 2048; i++){
				v_vector[i] = 0.0;
			}
			wave_complete = 0;
		}
		
		usleep(2000);
		count++;
		if(count == 200){
			count = 0;
			update_time();
		}
	}
	buffer_tx[0] = 0xF0;
	buffer_tx[1] = 0x00;
	nwrite = write(handle,buffer_tx,8);
	tcdrain(handle);

	close(handle);
	printf("\nStop program\n");
    return 0;	
}