##// END OF EJS Templates
ABS » abscontrol
RSS
Cambios en la aplicación Control_Module para generar respuesta hacia el Central_Control_Module
imanay -
r34:35
parent child
Show More
Show file before | Show file after | Hide comments
@@ -0,0 +1,324
1 /*
2 * Servidor.c
3 *
4 * Created on: Nov 3, 2009
5 * Author: Jose Francisco Quenta
6 *
7 * Se implementa:
8 * -Carga en memoria los apuntes contenidos en un archivo de experimentos: apunte0 -> GPIO
9 * -Cambio de apunte.
10 * -Lectura del estado actual del apunte y grabado del mismo en un archivo
11 */
12
13 #include <stdio.h>
14 #include <stdlib.h>
15 #include <string.h>
16 #include <unistd.h>
17 #include <errno.h>
18
19 #include <sys/types.h>
20 #include <sys/socket.h>
21 #include <netinet/in.h>
22 #include <arpa/inet.h>
23 #include <netdb.h>
24
25 #include "./Librerias/AT91gpio_Funciones.h"
26 #include "./Librerias/Mensajes.h"
27
28 #define PUERTO_SERVIDOR 5500
29 #define TAM_BUFFER 100
30
31 #define maskc_out PC30+PC28+PC26+PC24+PC22+PC20 //MSB-UP-LSB MSB-DOWN-LSB //APUNTE
32
33 #define maskb_in PB16+PB18+PB20+PB30+PB24+PB22 //MSB-UP-LSB MSB-DOWN-LSB //VERIFICACION
34
35 #define bit_up_2 0x00010000 //Mascara de cada bit a revisar: bit_up_2 es MSB
36 #define bit_up_1 0x00040000
37 #define bit_up_0 0x00100000
38 #define bit_dow_2 0x40000000
39 #define bit_dow_1 0x01000000
40 #define bit_dow_0 0x00400000
41
42 #define MyID 11
43
44 char *buff_experimento= NULL;
45
46 AT91S_PIO *pioc;
47 AT91S_PIO *piob;
48
49 /*
50 * Zona de declaracion de cabeceras.
51 */
52 void inicializa_gpio();
53 int procesa_peticion(char *buff_peticion);
54 int cambia_apuntamiento(char *puntero_char);
55 int carga_experimento(char *nombre_archivo);
56 int chequeo_sistema(char *numero_muestras);
57
58 /*
59 *
60 */
61 int main(){
62
63 int conexion_servidorFd;
64 struct sockaddr_in inf_servidor;
65 struct sockaddr_storage inf_cliente;
66 int resultado;
67 int numbytes_recibidos;
68 int rpta;
69
70 char *buff_peticion = (char *) malloc(TAM_BUFFER);
71
72 size_t addr_len;
73
74 memset(&inf_servidor, 0, sizeof(inf_servidor));
75 inf_servidor.sin_family= AF_INET;
76 inf_servidor.sin_port= htons(PUERTO_SERVIDOR);
77 inf_servidor.sin_addr.s_addr= INADDR_ANY;
78
79 /* Se establece el socket */
80 conexion_servidorFd = socket(AF_INET,SOCK_DGRAM,0);
81 if (conexion_servidorFd == -1){
82 ERROR_FATAL("No se establecio correctamente el socket: socket()");
83 }
84
85 /* Se asocia el socket a un puerto y una IP */
86 resultado = bind(conexion_servidorFd,(struct sockaddr *)&inf_servidor,sizeof(inf_servidor));
87 if (resultado== -1){
88 ERROR_FATAL("No se establecio correctamente el socket: bind()");
89 }
90
91 /* Inicializamos el puerto GPIO del sistema embebido GSBC-9260S */
92 inicializa_gpio();
93
94 while(1){
95 LOG_SERVIDOR("Esperando solicitud de cliente...\n");
96
97 /* Se espera hasta que un cliente se conecte */
98 addr_len = sizeof(inf_cliente);
99 numbytes_recibidos = recvfrom(conexion_servidorFd, buff_peticion, TAM_BUFFER-1, 0, (struct sockaddr *)&inf_cliente, &addr_len);
100 if (numbytes_recibidos == -1){
101 ERROR_FATAL("Error en la recepcion de datos: recvfrom()");
102 }
103
104 /* Se procede a procesar los datos recibidos */
105 buff_peticion[numbytes_recibidos]= '\0';
106
107 /* procesamiento de la peticion */
108 rpta = procesa_peticion(buff_peticion);
109
110 //Respuesta del modulo de control
111 //
112
113
114 }
115 }
116
117
118
119 /*
120 * Esta funcion incializa el puerto GPIO
121 */
122 void inicializa_gpio(){
123
124 // Configuracion de los pines de APUNTE
125 pioc = pio_map(PIOC_BASE);
126 pio_enable(pioc, maskc_out);
127 pio_disable_irq(pioc, maskc_out);
128 pio_disable_multiple_driver(pioc, maskc_out);
129 pio_disable_pull_ups(pioc, maskc_out);
130 pio_synchronous_data_output(pioc, maskc_out);
131 pio_output_enable(pioc, maskc_out);
132
133 // Configuracion de los pines de VERIFICACION
134 piob = pio_map(PIOB_BASE);
135 pio_enable(piob, maskb_in);
136 pio_disable_irq(piob, maskb_in);
137 pio_disable_multiple_driver(piob, maskb_in);
138 pio_disable_pull_ups(piob, maskb_in);
139 pio_input_enable(piob, maskb_in);
140
141 }
142
143 /*
144 * Esta funcion procesa el mensaje de peticion y genera respuesta
145 */
146 int procesa_peticion(char *buff_peticion){
147 int rpta;
148 // char *header = strtok(buff_peticion, ":");
149 // char *ipSource = strtok(buff_peticion, ":");
150 // char *ipDestino = strtok(buff_peticion, ":");
151 char *comando = strtok(buff_peticion, ":");
152 char *valor = strtok(NULL, ":");
153
154 if ((comando == NULL) || (valor == NULL)){
155 ERROR("procesarPeticion: formato de mensaje incorrecto");
156 }
157 else{
158 if(strcmp(comando,"CARGA") == 0)
159 rpta = carga_experimento(valor);
160 else if(strcmp(comando,"CAMBIA") == 0)
161 rpta = cambia_apuntamiento(valor);
162 else if(strcmp(comando,"CHEQUEO") == 0)
163 rpta = chequeo_sistema(valor);
164 else
165 ERROR("procesa_peticion: comando no reconocido");
166 }
167
168 return rpta;
169 }
170
171
172 /*
173 * Esta funcion carga un archivo en un buffer que esta ubicado en memoria, luego
174 * este buffer es usado en la funcion "cambia_apuntamiento" para obtener el dato
175 * que sera usado en el cambio de apuntamiento.
176 */
177 int carga_experimento(char *nombre_archivo){
178
179 FILE *Archivo_Fd;
180
181 char *cadena = (char *) malloc(25);
182
183 int longitud_cadena;
184 int num_bytes= 0;
185 int num_filas= 0;
186
187 char ruta_archivo[50]; // Se crea la ruta para abrir el archivo
188 strcpy(ruta_archivo,"/mnt/sd/archivos/");
189 strcat(ruta_archivo,nombre_archivo);
190
191 Archivo_Fd = fopen(ruta_archivo,"r"); // Se procede a abrir el archivo, segun la ruta especificada
192 if(!Archivo_Fd){
193 ERROR("carga_archivo: No se pudo abrir el archivo!!! --> fopen()\n");
194 return -1;
195 }else{
196
197 while(!feof(Archivo_Fd)){ // Se procede a calcular la longitud del archivo para separar memoria
198 fgets(cadena,20,Archivo_Fd);
199 longitud_cadena= strlen(cadena);
200 cadena[longitud_cadena-1] = '\0';
201 num_bytes = num_bytes + longitud_cadena;
202 num_filas++;
203 }
204
205 rewind(Archivo_Fd); // Se reinicia el puntero del archivo
206
207 char *buffer_temporal = (char *) malloc(num_bytes+1); // Se separa espacio de memoria segun
208 // la longitud del archivo
209 fread(buffer_temporal, sizeof(char), num_bytes, Archivo_Fd);
210
211 char *puntero= strstr(buffer_temporal,".abs"); // Se procede a eliminar la cabecera del archivo
212 puntero= puntero + 12;
213
214 buff_experimento = (char *) malloc(7*(num_filas-3)); // num_bytes_fila*(num_filas-3);
215 strncpy(buff_experimento,puntero,7*(num_filas-3)); // Se carga en memoria la informacion del archivo
216
217 fclose(Archivo_Fd);
218
219 cambia_apuntamiento("0"); // Se apunta a la direccion 0
220
221 return 1;
222 }
223 }
224
225 /*
226 * Esta funcion recibe un numero en formato char, el dato se transforma a su equivalente en
227 * un numero entero, que sera usado para sacar un dato del buffer "buff_experimento", esta
228 * dato es el valor que se enviara al sistema de conmutacion RF para el cambio de apunte a
229 * traves del puerto GPIO.
230 */
231 int cambia_apuntamiento(char *puntero_char){
232
233 /*MSB-UP-LSB MSB-DOWN-LSB*/
234 int desplazamiento[6]={30,28,26,24,22,20}; // Defino los dezplazamientos que se aplicara
235 // al dato que ingresa para formar el número
236 // entero que se le pasara al puerto GPIO
237 // Estos números son los pines del puerto GPIO
238 // que se estan usando para el control
239
240 int puntero= atoi(puntero_char); // Se convierte a entero la direccion del puntero
241
242 int base= 7*puntero; // base= cantidad_bytes del dato x puntero
243 // cantidad de bytes es el numero de bytes que
244 printf("%i\n",puntero); // contiene cada dato, para este caso es 7
245 // porque es 6 bits de datos + 1 bit del cambio
246 // de linea.
247 char valor_char;
248 unsigned long valor;
249 unsigned long acumulado_ceros=0;
250 unsigned long acumulado_unos=0;
251
252 int offset; // Defino offset para el desplazamiento a traves
253 for(offset=0;offset<6;offset++){ // de cada dato que se obtiene del "buff_experimento"
254
255 valor_char= buff_experimento[base+offset]; // Obtengo el dato
256
257 if (valor_char == '0'){ // Obtengo el número acumulado segun sea un cero o un uno
258 valor= 0;
259 acumulado_ceros= acumulado_ceros + (1 << desplazamiento[offset]);
260 }else{
261 valor= 1;
262 acumulado_unos= acumulado_unos + (1 << desplazamiento[offset]);
263 }
264
265 }
266
267 pio_out(pioc, maskc_out, acumulado_unos, 1);
268 pio_out(pioc, maskc_out, acumulado_ceros, 0);
269
270 return 1;
271
272 }
273
274 /*
275 * Esta funcion lee "n" veces el estado del APUNTE actual y lo guarda en el
276 * archivo Verificacion.
277 */
278
279 int chequeo_sistema(char *numero_muestras){
280
281 char valor[7];
282 int i,cnt;
283 unsigned int entradac= 0;
284 FILE *fd;
285 fd=fopen("/mnt/sd/archivos/Verificacion","w");
286 fprintf(fd,"%s\n","Verificacion");
287 fprintf(fd,"%s\n","------------");
288 cnt=0;
289 do
290 {
291 //Inicializando arreglo
292 for(i=0;i<6;i++)
293 valor[i]='0';
294
295 valor[6]='\0';
296
297 //Lectura de puerto
298 entradac= pio_in(piob,maskb_in);
299
300 //Dandole formato al dato
301 if (!(entradac & bit_up_2))
302 valor[0] = '1';
303 if (!(entradac & bit_up_1))
304 valor[1] = '1';
305 if (!(entradac & bit_up_0))
306 valor[2] = '1';
307 if (!(entradac & bit_dow_2))
308 valor[3] = '1';
309 if (!(entradac & bit_dow_1))
310 valor[4] = '1';
311 if (!(entradac & bit_dow_0))
312 valor[5] = '1';
313
314 //Escribiendo en archivo
315 fprintf(fd,"%s\n",valor);
316 cnt=cnt+1;
317 usleep(1*1000*1000);
318
319 }while(cnt < atoi(numero_muestras));
320
321 fclose(fd);
322
323 return 1;
324 }
Show file before | Show file after | Hide comments
@@ -211,6 +211,8
211 </scannerConfigBuildInfo>
211 </scannerConfigBuildInfo>
212 </storageModule>
212 </storageModule>
213 <storageModule moduleId="org.eclipse.cdt.core.externalSettings"/>
213 <storageModule moduleId="org.eclipse.cdt.core.externalSettings"/>
214 <storageModule moduleId="org.eclipse.cdt.core.language.mapping"/>
215 <storageModule moduleId="org.eclipse.cdt.internal.ui.text.commentOwnerProjectMappings"/>
214 </cconfiguration>
216 </cconfiguration>
215 </storageModule>
217 </storageModule>
216 <storageModule moduleId="cdtBuildSystem" version="4.0.0">
218 <storageModule moduleId="cdtBuildSystem" version="4.0.0">
Show file before | Show file after | Hide comments
@@ -1,6 +1,6
1 <?xml version="1.0" encoding="UTF-8"?>
1 <?xml version="1.0" encoding="UTF-8"?>
2 <projectDescription>
2 <projectDescription>
3 <name>Control_Module</name>
3 <name>Control_Module_test</name>
4 <comment></comment>
4 <comment></comment>
5 <projects>
5 <projects>
6 </projects>
6 </projects>
Show file before | Show file after | Hide comments
@@ -66,6 +66,7
66 int resultado;
66 int resultado;
67 int numbytes_recibidos;
67 int numbytes_recibidos;
68 int rpta;
68 int rpta;
69 int numbytes_enviados;
69
70
70 char *buff_peticion = (char *) malloc(TAM_BUFFER);
71 char *buff_peticion = (char *) malloc(TAM_BUFFER);
71
72
@@ -109,7 +110,14
109
110
110 //Respuesta del modulo de control
111 //Respuesta del modulo de control
111 //
112 //
112
113 //numbytes_enviados= sendto(conexion_servidorFd,buff_peticion,strlen(buff_peticion),0,(struct sockaddr *)&inf_servidor,sizeof(inf_servidor));
114 LOG_SERVIDOR("Enviando respuesta al cliente...\n");
115 numbytes_enviados= sendto(conexion_servidorFd,&rpta,sizeof(rpta),0,(struct sockaddr *)&inf_cliente,sizeof(inf_cliente));
116 printf("%i bytes enviados\n",numbytes_enviados);
117 if(numbytes_enviados == -1){
118 ERROR("Error de envio de datos: sendto()");
119 return -1;
120 }
113
121
114 }
122 }
115 }
123 }
Show file before | Show file after | Hide comments
1 NO CONTENT: file was removed
NO CONTENT: file was removed
General Comments 0
You need to be logged in to leave comments. Login now