ServidorTCP.c
642 lines
| 16.5 KiB
| text/x-c
|
CLexer
r26 | /* | |||
* Servidor.c | ||||
* | ||||
* Created on: Nov 3, 2009 | ||||
* Author: Jose Francisco Quenta | ||||
* | ||||
* Se implementa: | ||||
* -Carga en memoria los apuntes contenidos en un archivo de experimentos: apunte0 -> GPIO | ||||
* -Cambio de apunte. | ||||
* -Lectura del estado actual del apunte y grabado del mismo en un archivo | ||||
*/ | ||||
#include <stdio.h> | ||||
#include <stdlib.h> | ||||
#include <string.h> | ||||
#include <unistd.h> | ||||
#include <errno.h> | ||||
#include <sys/types.h> | ||||
#include <sys/socket.h> | ||||
#include <netinet/in.h> | ||||
#include <arpa/inet.h> | ||||
#include <netdb.h> | ||||
#include "./Librerias/AT91gpio_Funciones.h" | ||||
#include "./Librerias/Mensajes.h" | ||||
#define PUERTO_SERVIDOR 5500 | ||||
r71 | #define TAM_BUFFER 1024 | |||
r26 | ||||
#define maskc_out PC30+PC28+PC26+PC24+PC22+PC20 //MSB-UP-LSB MSB-DOWN-LSB //APUNTE | ||||
#define maskb_in PB16+PB18+PB20+PB30+PB24+PB22 //MSB-UP-LSB MSB-DOWN-LSB //VERIFICACION | ||||
#define bit_up_2 0x00010000 //Mascara de cada bit a revisar: bit_up_2 es MSB | ||||
#define bit_up_1 0x00040000 | ||||
#define bit_up_0 0x00100000 | ||||
#define bit_dow_2 0x40000000 | ||||
#define bit_dow_1 0x01000000 | ||||
#define bit_dow_0 0x00400000 | ||||
#define MyID 11 | ||||
r71 | #define MAXPENDING 5 /* Maximum outstanding connection requests */ | |||
r26 | ||||
char *buff_experimento= NULL; | ||||
AT91S_PIO *pioc; | ||||
AT91S_PIO *piob; | ||||
r71 | struct control_module_parameters { | |||
char ID[20]; | ||||
char param2[20]; | ||||
char param3[20]; | ||||
char param4[20]; | ||||
}; | ||||
typedef struct control_module_parameters cmp; | ||||
r103 | ||||
char *header = NULL; | ||||
char *TypeOfInstrument = NULL; | ||||
char *iDSource = NULL; | ||||
char *iDDestino = NULL; | ||||
char *len = NULL; | ||||
char *cmd = NULL; | ||||
char *rx_data = NULL; | ||||
char *crc = NULL; | ||||
r77 | cmp parameters; | |||
r26 | /* | |||
* Zona de declaracion de cabeceras. | ||||
*/ | ||||
r71 | cmp inicializa_modulo(cmp p); | |||
int inicializa_ethernet(); | ||||
int rxData(int, char*); | ||||
void txData(int, char*); | ||||
r26 | void inicializa_gpio(); | |||
r71 | void procesa_peticion(char *rx_buffer, char *tx_buffer); | |||
r26 | int cambia_apuntamiento(char *puntero_char); | |||
int carga_experimento(char *nombre_archivo); | ||||
r103 | char *chequeo_sistema(char *filename, char *numero_muestras); | |||
int chequeo_sistema2(char *filename, char *numero_muestras); | ||||
r71 | void recibe_experimento(char *data, char filename[]); | |||
char* File2buffer(char *filename2, int n); | ||||
r103 | void SplitFrame(char *frame); | |||
void procesa_peticion2(char *rx_buffer, char *tx_buffer); | ||||
r26 | ||||
/* | ||||
* | ||||
*/ | ||||
int main(){ | ||||
r71 | int servSocket; | |||
int clntSocket; | ||||
r77 | ||||
r71 | char *rx_buffer = (char *) malloc(TAM_BUFFER); | |||
char *tx_buffer = (char *) malloc(TAM_BUFFER); | ||||
/* Inicializa parametros del modulo*/ | ||||
parameters = inicializa_modulo(parameters); | ||||
r103 | printf("%s\n%s\n%s\n%s\n",parameters.ID, parameters.param2, parameters.param3, parameters.param4); | |||
r71 | /* Inicializa red*/ | |||
servSocket = inicializa_ethernet(); | ||||
/* Inicializamos el puerto GPIO del sistema embebido GSBC-9260S */ | ||||
inicializa_gpio(); | ||||
while(1){ | ||||
// Recepción TCP de petición | ||||
clntSocket = rxData(servSocket, rx_buffer); | ||||
//testpoint | ||||
printf("rx:%s\n",rx_buffer); | ||||
// Procesamiento de la petición | ||||
procesa_peticion(rx_buffer, tx_buffer); | ||||
//testpoint | ||||
printf("tx:%s\n",tx_buffer); | ||||
// Respuesta del modulo de control | ||||
txData(clntSocket, tx_buffer); | ||||
} | ||||
} | ||||
int inicializa_ethernet(){ | ||||
r26 | struct sockaddr_in inf_servidor; | |||
r71 | int servSocket; | |||
r26 | ||||
r71 | int resultado; | |||
r26 | ||||
r71 | /* Haciendo la estructura local*/ | |||
r26 | memset(&inf_servidor, 0, sizeof(inf_servidor)); | |||
inf_servidor.sin_family= AF_INET; | ||||
inf_servidor.sin_port= htons(PUERTO_SERVIDOR); | ||||
inf_servidor.sin_addr.s_addr= INADDR_ANY; | ||||
/* Se establece el socket */ | ||||
r71 | servSocket = socket(AF_INET,SOCK_STREAM, IPPROTO_TCP); | |||
if (servSocket == -1){ | ||||
ERROR_FATAL("No se establecio correctamente el socket: socket()\n"); | ||||
exit(-1); | ||||
r26 | } | |||
/* Se asocia el socket a un puerto y una IP */ | ||||
r71 | resultado = bind(servSocket,(struct sockaddr *)&inf_servidor,sizeof(inf_servidor)); | |||
r26 | if (resultado== -1){ | |||
r71 | ERROR_FATAL("No se establecio correctamente el socket: bind()\n"); | |||
exit(-1); | ||||
r26 | } | |||
r71 | if (listen(servSocket, MAXPENDING) < 0){ | |||
printf("listen() failed\n"); | ||||
exit(-1); | ||||
} | ||||
r26 | ||||
r71 | return servSocket; | |||
r26 | ||||
r71 | } | |||
r26 | ||||
r71 | int rxData(int servSocket, char* rx_buffer){ | |||
r26 | ||||
r71 | int clntSocket; | |||
struct sockaddr_in inf_cliente; | ||||
int numbytes_recibidos; | ||||
unsigned int inf_client_Len; | ||||
r26 | ||||
r71 | printf("\nEsperando solicitud de cliente...\n"); | |||
r26 | ||||
r71 | /* Set the size of the in-out parameter */ | |||
inf_client_Len = sizeof(inf_cliente); | ||||
/* Se espera hasta que un cliente se conecte */ | ||||
if ((clntSocket = accept(servSocket, (struct sockaddr *) &inf_cliente, | ||||
&inf_client_Len)) < 0) | ||||
printf("accept() failed\n"); | ||||
r26 | ||||
r71 | if ((numbytes_recibidos = recv(clntSocket, rx_buffer, TAM_BUFFER, 0)) < 0) | |||
printf("recv() failed\n"); | ||||
/* Se procede a procesar los datos recibidos */ | ||||
rx_buffer[numbytes_recibidos]= '\0'; | ||||
return clntSocket; | ||||
r26 | } | |||
r71 | void txData(int clntSocket, char* data){ | |||
r26 | ||||
r71 | /* Echo message back to client */ | |||
if (send(clntSocket, data, strlen(data), 0) != strlen(data)) | ||||
printf("send() failed\n"); | ||||
r26 | ||||
r71 | close(clntSocket); /* Close client socket */ | |||
} | ||||
r26 | /* | |||
* Esta funcion incializa el puerto GPIO | ||||
*/ | ||||
void inicializa_gpio(){ | ||||
// Configuracion de los pines de APUNTE | ||||
pioc = pio_map(PIOC_BASE); | ||||
pio_enable(pioc, maskc_out); | ||||
pio_disable_irq(pioc, maskc_out); | ||||
pio_disable_multiple_driver(pioc, maskc_out); | ||||
pio_disable_pull_ups(pioc, maskc_out); | ||||
pio_synchronous_data_output(pioc, maskc_out); | ||||
pio_output_enable(pioc, maskc_out); | ||||
// Configuracion de los pines de VERIFICACION | ||||
piob = pio_map(PIOB_BASE); | ||||
pio_enable(piob, maskb_in); | ||||
pio_disable_irq(piob, maskb_in); | ||||
pio_disable_multiple_driver(piob, maskb_in); | ||||
pio_disable_pull_ups(piob, maskb_in); | ||||
pio_input_enable(piob, maskb_in); | ||||
} | ||||
/* | ||||
* Esta funcion procesa el mensaje de peticion y genera respuesta | ||||
*/ | ||||
r103 | void procesa_peticion2(char *rx_buffer, char *tx_buffer){ | |||
r71 | int n = 0; | |||
char filename1[50]; | ||||
char filename2[] = "verificacion.txt"; | ||||
char *tx_data = NULL; | ||||
char *header = strtok(rx_buffer, ":"); | ||||
char *TypeOfInstrument = strtok(NULL, ":"); | ||||
char *iDSource = strtok(NULL, ":"); | ||||
char *iDDestino = strtok(NULL, ":"); | ||||
char *len = strtok(NULL, ":"); | ||||
char *cmd = strtok(NULL, ":"); | ||||
char *rx_data = strtok(NULL, ":"); | ||||
char *crc = strtok(NULL, ":"); | ||||
r26 | ||||
r71 | if ((cmd == NULL) || (rx_data == NULL)){ | |||
r26 | ERROR("procesarPeticion: formato de mensaje incorrecto"); | |||
} | ||||
else{ | ||||
r71 | if(strcmp(cmd,"SNDF") == 0){ | |||
recibe_experimento(rx_data,filename1); | ||||
carga_experimento(filename1); | ||||
cambia_apuntamiento("0"); | ||||
tx_data = (char*)malloc(3); | ||||
tx_data = "OK"; | ||||
} | ||||
else if(strcmp(cmd,"CHGB") == 0){ | ||||
r77 | cambia_apuntamiento(rx_data); | |||
r71 | tx_data = (char*)malloc(3); | |||
tx_data = "OK"; | ||||
} | ||||
else if(strcmp(cmd,"ANST") == 0){ | ||||
r103 | n = chequeo_sistema2(filename2,rx_data); | |||
r71 | printf("%i\n",n); | |||
tx_data = File2buffer(filename2, n); | ||||
} | ||||
else{ | ||||
tx_data = (char*)malloc(6); | ||||
tx_data = "Error"; | ||||
ERROR("procesa_peticion: comando no reconocido"); | ||||
} | ||||
strcpy(tx_buffer,header); | ||||
strcat(tx_buffer,":"); | ||||
strcat(tx_buffer,TypeOfInstrument); | ||||
strcat(tx_buffer,":"); | ||||
strcat(tx_buffer,iDDestino); | ||||
strcat(tx_buffer,":"); | ||||
strcat(tx_buffer,iDSource); | ||||
strcat(tx_buffer,":"); | ||||
strcat(tx_buffer,len); | ||||
strcat(tx_buffer,":"); | ||||
strcat(tx_buffer,cmd); | ||||
strcat(tx_buffer,":"); | ||||
strcat(tx_buffer,tx_data); | ||||
strcat(tx_buffer,":"); | ||||
strcat(tx_buffer,crc); | ||||
r77 | strcat(tx_buffer,":"); | |||
strcat(tx_buffer,"quit"); | ||||
r103 | } | |||
} | ||||
r71 | ||||
r103 | void SplitFrame(char *frame){ | |||
header = malloc(4); | ||||
*header = *frame; | ||||
*(header + 1) = *(frame + 1); | ||||
*(header + 2) = *(frame + 2); | ||||
*(header + 3) = '\0'; | ||||
TypeOfInstrument = malloc(4); | ||||
*TypeOfInstrument = *(frame + 3); | ||||
*(TypeOfInstrument + 1) = *(frame + 4); | ||||
*(TypeOfInstrument + 2) = *(frame + 5); | ||||
*(TypeOfInstrument + 3) = '\0'; | ||||
iDSource = malloc(8); | ||||
*iDSource = *(frame + 6); | ||||
*(iDSource + 1) = *(frame + 7); | ||||
*(iDSource + 2) = *(frame + 8); | ||||
*(iDSource + 3) = *(frame + 9); | ||||
*(iDSource + 4) = *(frame + 10); | ||||
*(iDSource + 5) = *(frame + 11); | ||||
*(iDSource + 6) = *(frame + 12); | ||||
*(iDSource + 7) = '\0'; | ||||
iDDestino = malloc(8); | ||||
*iDDestino = *(frame + 13); | ||||
*(iDDestino + 1) = *(frame + 14); | ||||
*(iDDestino + 2) = *(frame + 15); | ||||
*(iDDestino + 3) = *(frame + 16); | ||||
*(iDDestino + 4) = *(frame + 17); | ||||
*(iDDestino + 5) = *(frame + 18); | ||||
*(iDDestino + 6) = *(frame + 19); | ||||
*(iDDestino + 7) = '\0'; | ||||
len = malloc(7); | ||||
*len = *(frame + 20); | ||||
*(len + 1) = *(frame + 21); | ||||
*(len + 2) = *(frame + 22); | ||||
*(len + 3) = *(frame + 23); | ||||
*(len + 4) = *(frame + 24); | ||||
*(len + 5) = *(frame + 25); | ||||
*(len + 6) = '\0'; | ||||
cmd = malloc(5); | ||||
*cmd = *(frame + 26); | ||||
*(cmd + 1) = *(frame + 27); | ||||
*(cmd + 2) = *(frame + 28); | ||||
*(cmd + 3) = *(frame + 29); | ||||
*(cmd + 4) = '\0'; | ||||
int l = atoi(len) - 31; //Resto del tamaño total de la trama los 31 bytes fijos | ||||
rx_data = malloc(l); | ||||
int i; | ||||
for (i = 30; i < 30 + l; i++) | ||||
*(rx_data + (i-30)) = *(frame + i); | ||||
*(rx_data + l) = '\0'; | ||||
crc = malloc(2); | ||||
*crc = *(frame + 30 + l); | ||||
*(crc + 1) = '\0'; | ||||
} | ||||
void procesa_peticion(char *rx_buffer, char *tx_buffer){ | ||||
// int n = 0; | ||||
char filename1[50]; | ||||
char filename2[] = "verificacion.txt"; | ||||
char *tx_data = NULL; | ||||
SplitFrame(rx_buffer); | ||||
printf("Split\n"); | ||||
printf("%s\n",header); | ||||
printf("%s\n",TypeOfInstrument); | ||||
printf("%s\n",iDSource); | ||||
printf("%s\n",iDDestino); | ||||
printf("%s\n",len); | ||||
printf("%s\n",cmd); | ||||
printf("%s\n",rx_data); | ||||
printf("%s\n",crc); | ||||
printf("Split\n"); | ||||
if ((cmd == NULL) || (rx_data == NULL)){ | ||||
ERROR("procesarPeticion: formato de mensaje incorrecto"); | ||||
r26 | } | |||
r103 | else{ | |||
if(strcmp(cmd,"SNDF") == 0){ | ||||
recibe_experimento(rx_data,filename1); | ||||
carga_experimento(filename1); | ||||
cambia_apuntamiento("0"); | ||||
tx_data = (char*)malloc(3); | ||||
tx_data = "OK"; | ||||
} | ||||
else if(strcmp(cmd,"CHGB") == 0){ | ||||
cambia_apuntamiento(rx_data); | ||||
tx_data = (char*)malloc(3); | ||||
tx_data = "OK"; | ||||
r26 | ||||
r103 | } | |||
else if(strcmp(cmd,"ANST") == 0){ | ||||
/*n = chequeo_sistema(filename2,rx_data); | ||||
printf("%i\n",n); | ||||
tx_data = File2buffer(filename2, n);*/ | ||||
tx_data = chequeo_sistema(filename2,rx_data); | ||||
printf("%s\n",tx_data); | ||||
} | ||||
else{ | ||||
tx_data = (char*)malloc(6); | ||||
tx_data = "Error"; | ||||
ERROR("procesa_peticion: comando no reconocido"); | ||||
} | ||||
strcpy(tx_buffer,header); //3 | ||||
strcat(tx_buffer,TypeOfInstrument); //3 | ||||
strcat(tx_buffer,parameters.ID); //7 | ||||
strcat(tx_buffer,iDSource); //7 | ||||
strcat(tx_buffer,"00032"); //5 | ||||
strcat(tx_buffer,cmd); //4 | ||||
strcat(tx_buffer,tx_data); //2 | ||||
strcat(tx_buffer,crc); //1 | ||||
} | ||||
r26 | } | |||
r71 | /* | |||
* Esta función genera el archivo de experimento a partir de la trama TCP recibida | ||||
*/ | ||||
r26 | ||||
r71 | void recibe_experimento(char *p_data, char filename[]){ | |||
FILE *fd; | ||||
int i = 0; | ||||
while (*p_data != '\n'){ | ||||
filename[i] = *p_data; | ||||
i++; | ||||
p_data++; | ||||
} | ||||
filename[i] = '\0'; | ||||
p_data = p_data - i; | ||||
fd = fopen(filename,"w"); | ||||
fprintf(fd, p_data); | ||||
fclose(fd); | ||||
} | ||||
r26 | /* | |||
* Esta funcion carga un archivo en un buffer que esta ubicado en memoria, luego | ||||
* este buffer es usado en la funcion "cambia_apuntamiento" para obtener el dato | ||||
* que sera usado en el cambio de apuntamiento. | ||||
*/ | ||||
int carga_experimento(char *nombre_archivo){ | ||||
FILE *Archivo_Fd; | ||||
char *cadena = (char *) malloc(25); | ||||
int longitud_cadena; | ||||
int num_bytes= 0; | ||||
int num_filas= 0; | ||||
r71 | Archivo_Fd = fopen(nombre_archivo,"r"); // Se procede a abrir el archivo, segun la ruta especificada | |||
r26 | if(!Archivo_Fd){ | |||
ERROR("carga_archivo: No se pudo abrir el archivo!!! --> fopen()\n"); | ||||
return -1; | ||||
}else{ | ||||
while(!feof(Archivo_Fd)){ // Se procede a calcular la longitud del archivo para separar memoria | ||||
fgets(cadena,20,Archivo_Fd); | ||||
longitud_cadena= strlen(cadena); | ||||
cadena[longitud_cadena-1] = '\0'; | ||||
num_bytes = num_bytes + longitud_cadena; | ||||
num_filas++; | ||||
} | ||||
rewind(Archivo_Fd); // Se reinicia el puntero del archivo | ||||
char *buffer_temporal = (char *) malloc(num_bytes+1); // Se separa espacio de memoria segun | ||||
// la longitud del archivo | ||||
fread(buffer_temporal, sizeof(char), num_bytes, Archivo_Fd); | ||||
r77 | char *puntero= strstr(buffer_temporal,".ab1"); // Se procede a eliminar la cabecera del archivo | |||
r26 | puntero= puntero + 12; | |||
buff_experimento = (char *) malloc(7*(num_filas-3)); // num_bytes_fila*(num_filas-3); | ||||
strncpy(buff_experimento,puntero,7*(num_filas-3)); // Se carga en memoria la informacion del archivo | ||||
fclose(Archivo_Fd); | ||||
return 1; | ||||
} | ||||
} | ||||
/* | ||||
* Esta funcion recibe un numero en formato char, el dato se transforma a su equivalente en | ||||
* un numero entero, que sera usado para sacar un dato del buffer "buff_experimento", esta | ||||
* dato es el valor que se enviara al sistema de conmutacion RF para el cambio de apunte a | ||||
* traves del puerto GPIO. | ||||
*/ | ||||
int cambia_apuntamiento(char *puntero_char){ | ||||
/*MSB-UP-LSB MSB-DOWN-LSB*/ | ||||
int desplazamiento[6]={30,28,26,24,22,20}; // Defino los dezplazamientos que se aplicara | ||||
// al dato que ingresa para formar el número | ||||
// entero que se le pasara al puerto GPIO | ||||
// Estos números son los pines del puerto GPIO | ||||
// que se estan usando para el control | ||||
int puntero= atoi(puntero_char); // Se convierte a entero la direccion del puntero | ||||
int base= 7*puntero; // base= cantidad_bytes del dato x puntero | ||||
// cantidad de bytes es el numero de bytes que | ||||
r77 | printf("%s\n",puntero_char); // contiene cada dato, para este caso es 7 | |||
r26 | // porque es 6 bits de datos + 1 bit del cambio | |||
// de linea. | ||||
char valor_char; | ||||
unsigned long valor; | ||||
unsigned long acumulado_ceros=0; | ||||
unsigned long acumulado_unos=0; | ||||
int offset; // Defino offset para el desplazamiento a traves | ||||
for(offset=0;offset<6;offset++){ // de cada dato que se obtiene del "buff_experimento" | ||||
r77 | ||||
r26 | valor_char= buff_experimento[base+offset]; // Obtengo el dato | |||
if (valor_char == '0'){ // Obtengo el número acumulado segun sea un cero o un uno | ||||
valor= 0; | ||||
acumulado_ceros= acumulado_ceros + (1 << desplazamiento[offset]); | ||||
}else{ | ||||
valor= 1; | ||||
acumulado_unos= acumulado_unos + (1 << desplazamiento[offset]); | ||||
} | ||||
} | ||||
pio_out(pioc, maskc_out, acumulado_unos, 1); | ||||
pio_out(pioc, maskc_out, acumulado_ceros, 0); | ||||
return 1; | ||||
} | ||||
/* | ||||
* Esta funcion lee "n" veces el estado del APUNTE actual y lo guarda en el | ||||
* archivo Verificacion. | ||||
*/ | ||||
r103 | int chequeo_sistema2(char *filename, char *numero_muestras){ | |||
r26 | ||||
char valor[7]; | ||||
int i,cnt; | ||||
unsigned int entradac= 0; | ||||
FILE *fd; | ||||
r71 | fd=fopen(filename,"w"); | |||
r26 | fprintf(fd,"%s\n","Verificacion"); | |||
r103 | fprintf(fd,"%s\n",parameters.ID); | |||
r26 | fprintf(fd,"%s\n","------------"); | |||
cnt=0; | ||||
do | ||||
{ | ||||
//Inicializando arreglo | ||||
for(i=0;i<6;i++) | ||||
valor[i]='0'; | ||||
valor[6]='\0'; | ||||
//Lectura de puerto | ||||
entradac= pio_in(piob,maskb_in); | ||||
//Dandole formato al dato | ||||
if (!(entradac & bit_up_2)) | ||||
valor[0] = '1'; | ||||
if (!(entradac & bit_up_1)) | ||||
valor[1] = '1'; | ||||
if (!(entradac & bit_up_0)) | ||||
valor[2] = '1'; | ||||
if (!(entradac & bit_dow_2)) | ||||
valor[3] = '1'; | ||||
if (!(entradac & bit_dow_1)) | ||||
valor[4] = '1'; | ||||
if (!(entradac & bit_dow_0)) | ||||
valor[5] = '1'; | ||||
//Escribiendo en archivo | ||||
fprintf(fd,"%s\n",valor); | ||||
cnt=cnt+1; | ||||
usleep(1*1000*1000); | ||||
}while(cnt < atoi(numero_muestras)); | ||||
fclose(fd); | ||||
r77 | return 7*atoi(numero_muestras) + 26 + 4 + 1; //incluye eof | |||
r26 | } | |||
r71 | ||||
char* File2buffer(char *filename, int n){ | ||||
FILE *fd; | ||||
char* tx_data = (char *)malloc(n); | ||||
fd = fopen(filename,"r"); | ||||
r77 | fread(tx_data, 1, n-1, fd); | |||
r71 | fclose(fd); | |||
r77 | tx_data = tx_data + n - 1; | |||
*tx_data = '\0'; | ||||
tx_data = tx_data - n + 1; | ||||
r71 | return tx_data; | |||
} | ||||
r103 | /* | |||
* Esta funcion lee "n" veces el estado del APUNTE actual y reporta | ||||
* una cadena de Verificacion. | ||||
*/ | ||||
char* chequeo_sistema(char *filename, char *numero_muestras){ | ||||
int i; | ||||
int cnt = 0; | ||||
unsigned int entradac= 0; | ||||
char page0[250]; | ||||
strcpy(page0,"Verificacion\n"); | ||||
strcat(page0,parameters.ID); | ||||
strcat(page0,"\n------------\n"); | ||||
char page1[8]; | ||||
do{ | ||||
//Inicializando arreglo | ||||
for(i=0;i<6;i++) | ||||
page1[i]='0'; | ||||
page1[6] = '\n'; | ||||
page1[7] = '\0'; | ||||
//Lectura de puerto | ||||
entradac= pio_in(piob,maskb_in); | ||||
//Dandole formato al dato | ||||
if (!(entradac & bit_up_2)) | ||||
page1[0] = '1'; | ||||
if (!(entradac & bit_up_1)) | ||||
page1[1] = '1'; | ||||
if (!(entradac & bit_up_0)) | ||||
page1[2] = '1'; | ||||
if (!(entradac & bit_dow_2)) | ||||
page1[3] = '1'; | ||||
if (!(entradac & bit_dow_1)) | ||||
page1[4] = '1'; | ||||
if (!(entradac & bit_dow_0)) | ||||
page1[5] = '1'; | ||||
strcat(page0, page1); | ||||
cnt=cnt+1; | ||||
usleep(1*1000*1000); | ||||
}while(cnt < atoi(numero_muestras)); | ||||
page0[strlen(page0)] = '\0'; | ||||
char *all_pages = malloc(strlen(page0)+1); | ||||
strcpy(all_pages, page0); | ||||
return all_pages; | ||||
} | ||||
r71 | cmp inicializa_modulo(cmp p){ | |||
FILE *fd = fopen("configuration.txt","r"); | ||||
fgets(p.ID,20,fd); | ||||
r103 | p.ID[7]='\0'; | |||
r71 | fgets(p.param2,20,fd); | |||
r103 | p.param2[10]='\0'; | |||
r71 | fgets(p.param3,20,fd); | |||
r103 | p.param3[10]='\0'; | |||
r71 | fgets(p.param4,20,fd); | |||
r103 | p.param4[10]='\0'; | |||
r71 | fclose(fd); | |||
return p; | ||||
} | ||||