Added IPC open to dot draw init
[olsrd.git] / lib / dot_draw / src / olsrd_dot_draw.c
1 /*
2  * The olsr.org Optimized Link-State Routing daemon(olsrd)
3  * Copyright (c) 2004, Andreas T√łnnesen(andreto@olsr.org)
4  *                     includes code by Bruno Randolf
5  * All rights reserved.
6  *
7  * Redistribution and use in source and binary forms, with or without 
8  * modification, are permitted provided that the following conditions 
9  * are met:
10  *
11  * * Redistributions of source code must retain the above copyright 
12  *   notice, this list of conditions and the following disclaimer.
13  * * Redistributions in binary form must reproduce the above copyright 
14  *   notice, this list of conditions and the following disclaimer in 
15  *   the documentation and/or other materials provided with the 
16  *   distribution.
17  * * Neither the name of olsr.org, olsrd nor the names of its 
18  *   contributors may be used to endorse or promote products derived 
19  *   from this software without specific prior written permission.
20  *
21  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS 
22  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT 
23  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS 
24  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE 
25  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, 
26  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, 
27  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; 
28  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER 
29  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT 
30  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN 
31  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE 
32  * POSSIBILITY OF SUCH DAMAGE.
33  *
34  * Visit http://www.olsr.org for more information.
35  *
36  * If you find this software useful feel free to make a donation
37  * to the project. For more information see the website or contact
38  * the copyright holders.
39  *
40  * $Id: olsrd_dot_draw.c,v 1.22 2006/04/11 18:43:12 kattemat Exp $
41  */
42
43 /*
44  * Dynamic linked library for the olsr.org olsr daemon
45  */
46
47  
48 #include <sys/types.h>
49 #include <sys/socket.h>
50 #include <netinet/in.h>
51 #include <arpa/inet.h>
52 #include <sys/time.h>
53 #include <time.h>
54 #include <math.h>
55 #include <stdio.h>
56 #include <string.h>
57 #include <stdlib.h>
58 #include <unistd.h>
59 #include <errno.h>
60
61 #include "olsr.h"
62 #include "olsr_types.h"
63 #include "neighbor_table.h"
64 #include "two_hop_neighbor_table.h"
65 #include "tc_set.h"
66 #include "hna_set.h"
67 #include "mid_set.h"
68 #include "link_set.h"
69 #include "socket_parser.h"
70
71 #include "olsrd_dot_draw.h"
72 #include "olsrd_plugin.h"
73
74
75 #ifdef WIN32
76 #define close(x) closesocket(x)
77 #endif
78
79
80 static int ipc_socket;
81 static int ipc_open;
82 static int ipc_connection;
83 static int ipc_socket_up;
84
85
86
87 /* IPC initialization function */
88 static int
89 plugin_ipc_init(void);
90
91 static char*
92 olsr_netmask_to_string(union hna_netmask *mask);
93
94 /* Event function to register with the sceduler */
95 static int
96 pcf_event(int, int, int);
97
98 static void
99 ipc_action(int);
100
101 static void inline
102 ipc_print_neigh_link(struct neighbor_entry *neighbor);
103
104 static void inline
105 ipc_print_tc_link(struct tc_entry *entry, struct topo_dst *dst_entry);
106
107 static void inline
108 ipc_print_net(union olsr_ip_addr *, union olsr_ip_addr *, union hna_netmask *);
109
110 static int
111 ipc_send(char *, int);
112
113 static int
114 ipc_send_str(char *);
115
116 static double 
117 calc_etx(double, double);
118
119 static void inline
120 ipc_print_neigh_link(struct neighbor_entry *);
121
122
123 /**
124  *Do initialization here
125  *
126  *This function is called by the my_init
127  *function in uolsrd_plugin.c
128  */
129 int
130 olsrd_plugin_init()
131 {
132   /* Initial IPC value */
133   ipc_open = 0;
134   ipc_socket_up = 0;
135
136   /* Register the "ProcessChanges" function */
137   register_pcf(&pcf_event);
138
139   plugin_ipc_init();
140
141   return 1;
142 }
143
144
145 /**
146  * destructor - called at unload
147  */
148 void
149 olsr_plugin_exit()
150 {
151   if(ipc_open)
152     close(ipc_socket);
153 }
154
155
156 static void inline
157 ipc_print_neigh_link(struct neighbor_entry *neighbor)
158 {
159   char buf[256];
160   char* adr;
161   double etx=0.0;
162   char* style = "solid";
163   struct link_entry* link;
164   adr = olsr_ip_to_string(&olsr_cnf->main_addr);
165   sprintf( buf, "\"%s\" -> ", adr );
166   ipc_send_str(buf);
167   
168   adr = olsr_ip_to_string(&neighbor->neighbor_main_addr);
169   
170   if (neighbor->status == 0) { // non SYM
171         style = "dashed";
172   }
173   else {   
174       link = get_best_link_to_neighbor(&neighbor->neighbor_main_addr);
175       if (link) {
176         etx = calc_etx( link->loss_link_quality, link->neigh_link_quality);
177       }
178   }
179     
180   sprintf( buf, "\"%s\"[label=\"%.2f\", style=%s];\n", adr, etx, style );
181   ipc_send_str(buf);
182   
183    if (neighbor->is_mpr) {
184         sprintf( buf, "\"%s\"[shape=box];\n", adr );
185         ipc_send_str(buf);
186   }
187 }
188
189
190 static int
191 plugin_ipc_init()
192 {
193   struct sockaddr_in sin;
194   olsr_u32_t yes = 1;
195
196   /* Init ipc socket */
197   if ((ipc_socket = socket(AF_INET, SOCK_STREAM, 0)) == -1) 
198     {
199       olsr_printf(1, "(DOT DRAW)IPC socket %s\n", strerror(errno));
200       return 0;
201     }
202   else
203     {
204       if (setsockopt(ipc_socket, SOL_SOCKET, SO_REUSEADDR, (char *)&yes, sizeof(yes)) < 0) 
205       {
206         perror("SO_REUSEADDR failed");
207         return 0;
208       }
209
210 #if defined __FreeBSD__ && defined SO_NOSIGPIPE
211       if (setsockopt(ipc_socket, SOL_SOCKET, SO_NOSIGPIPE, (char *)&yes, sizeof(yes)) < 0) 
212       {
213         perror("SO_REUSEADDR failed");
214         return 0;
215       }
216 #endif
217
218       /* Bind the socket */
219       
220       /* complete the socket structure */
221       memset(&sin, 0, sizeof(sin));
222       sin.sin_family = AF_INET;
223       sin.sin_addr.s_addr = INADDR_ANY;
224       sin.sin_port = htons(ipc_port);
225       
226       /* bind the socket to the port number */
227       if (bind(ipc_socket, (struct sockaddr *) &sin, sizeof(sin)) == -1) 
228         {
229           olsr_printf(1, "(DOT DRAW)IPC bind %s\n", strerror(errno));
230           return 0;
231         }
232       
233       /* show that we are willing to listen */
234       if (listen(ipc_socket, 1) == -1) 
235         {
236           olsr_printf(1, "(DOT DRAW)IPC listen %s\n", strerror(errno));
237           return 0;
238         }
239
240
241       /* Register with olsrd */
242       printf("Adding socket with olsrd\n");
243       add_olsr_socket(ipc_socket, &ipc_action);
244       ipc_socket_up = 1;
245     }
246
247   return 1;
248 }
249
250
251 static void
252 ipc_action(int fd)
253 {
254   struct sockaddr_in pin;
255   socklen_t addrlen;
256   char *addr;  
257
258   addrlen = sizeof(struct sockaddr_in);
259
260   if (ipc_open)
261     {
262       while(close(ipc_connection) == -1) 
263         {
264           olsr_printf(1, "(DOT DRAW) Error on closing previously active TCP connection on fd %d: %s\n", ipc_connection, strerror(errno));
265           if (errno != EINTR)
266             {
267               break;
268             }
269         }
270       ipc_open = 0;
271     }
272   
273   if ((ipc_connection = accept(ipc_socket, (struct sockaddr *)  &pin, &addrlen)) == -1)
274     {
275       olsr_printf(1, "(DOT DRAW)IPC accept: %s\n", strerror(errno));
276       exit(1);
277     }
278   else
279     {
280       addr = inet_ntoa(pin.sin_addr);
281       if(ntohl(pin.sin_addr.s_addr) != ntohl(ipc_accept_ip.s_addr))
282         {
283           olsr_printf(1, "Front end-connection from foregin host(%s) not allowed!\n", addr);
284           close(ipc_connection);
285           return;
286         }
287       else
288         {
289           ipc_open = 1;
290           olsr_printf(1, "(DOT DRAW)IPC: Connection from %s\n",addr);
291           pcf_event(1, 1, 1);
292         }
293     }
294 }
295
296
297 /**
298  *Scheduled event
299  */
300 static int
301 pcf_event(int changes_neighborhood,
302           int changes_topology,
303           int changes_hna)
304 {
305   int res;
306   olsr_u8_t index;
307   struct neighbor_entry *neighbor_table_tmp;
308   struct tc_entry *entry;
309   struct topo_dst *dst_entry;
310   struct hna_entry *tmp_hna;
311   struct hna_net *tmp_net;
312
313   res = 0;
314
315   if(changes_neighborhood || changes_topology || changes_hna)
316     {
317       /* Print tables to IPC socket */
318
319       ipc_send_str("digraph topology\n{\n");
320
321       /* Neighbors */
322       for(index=0;index<HASHSIZE;index++)
323         {
324           
325           for(neighbor_table_tmp = neighbortable[index].next;
326               neighbor_table_tmp != &neighbortable[index];
327               neighbor_table_tmp = neighbor_table_tmp->next)
328             {
329               ipc_print_neigh_link( neighbor_table_tmp );
330             }
331         }
332
333       /* Topology */  
334       for(index=0;index<HASHSIZE;index++)
335         {
336           /* For all TC entries */
337           entry = tc_table[index].next;
338           while(entry != &tc_table[index])
339             {
340               /* For all destination entries of that TC entry */
341               dst_entry = entry->destinations.next;
342               while(dst_entry != &entry->destinations)
343                 {
344                   ipc_print_tc_link(entry, dst_entry);
345                   dst_entry = dst_entry->next;
346                 }
347               entry = entry->next;
348             }
349         }
350
351       /* HNA entries */
352       for(index=0;index<HASHSIZE;index++)
353         {
354           tmp_hna = hna_set[index].next;
355           /* Check all entrys */
356           while(tmp_hna != &hna_set[index])
357             {
358               /* Check all networks */
359               tmp_net = tmp_hna->networks.next;
360               
361               while(tmp_net != &tmp_hna->networks)
362                 {
363                   ipc_print_net(&tmp_hna->A_gateway_addr, 
364                                 &tmp_net->A_network_addr, 
365                                 &tmp_net->A_netmask);
366                   tmp_net = tmp_net->next;
367                 }
368               
369               tmp_hna = tmp_hna->next;
370             }
371         }
372
373
374       ipc_send_str("}\n\n");
375
376       res = 1;
377     }
378
379
380   if(!ipc_socket_up)
381     plugin_ipc_init();
382
383   return res;
384 }
385
386
387 #define MIN_LINK_QUALITY 0.01
388 static double 
389 calc_etx(double loss, double neigh_loss) 
390 {
391   if (loss < MIN_LINK_QUALITY || neigh_loss < MIN_LINK_QUALITY)
392     return 0.0;
393   else
394     return 1.0 / (loss * neigh_loss);
395 }
396
397
398 static void inline
399 ipc_print_tc_link(struct tc_entry *entry, struct topo_dst *dst_entry)
400 {
401   char buf[256];
402   char* adr;
403   double etx = calc_etx( dst_entry->link_quality, dst_entry->inverse_link_quality );
404
405   adr = olsr_ip_to_string(&entry->T_last_addr);
406   sprintf( buf, "\"%s\" -> ", adr );
407   ipc_send_str(buf);
408   
409   adr = olsr_ip_to_string(&dst_entry->T_dest_addr);
410   sprintf( buf, "\"%s\"[label=\"%.2f\"];\n", adr, etx );
411   ipc_send_str(buf);
412 }
413
414
415 static void inline
416 ipc_print_net(union olsr_ip_addr *gw, union olsr_ip_addr *net, union hna_netmask *mask)
417 {
418   char *adr;
419
420   adr = olsr_ip_to_string(gw);
421   ipc_send_str("\"");
422   ipc_send_str(adr);
423   ipc_send_str("\" -> \"");
424   adr = olsr_ip_to_string(net);
425   ipc_send_str(adr);
426   ipc_send_str("/");
427   adr = olsr_netmask_to_string(mask);
428   ipc_send_str(adr);
429   ipc_send_str("\"[label=\"HNA\"];\n");
430   ipc_send_str("\"");
431   adr = olsr_ip_to_string(net);
432   ipc_send_str(adr);
433   ipc_send_str("/");
434   adr = olsr_netmask_to_string(mask);
435   ipc_send_str(adr);
436   ipc_send_str("\"");
437   ipc_send_str("[shape=diamond];\n");
438 }
439
440 static int
441 ipc_send_str(char *data)
442 {
443   if(!ipc_open)
444     return 0;
445   return ipc_send(data, strlen(data));
446 }
447
448
449 static int
450 ipc_send(char *data, int size)
451 {
452   if(!ipc_open)
453     return 0;
454
455 #if defined __FreeBSD__ || defined __NetBSD__ || defined __OpenBSD__ || defined __MacOSX__
456   if (send(ipc_connection, data, size, 0) < 0) 
457 #else
458   if (send(ipc_connection, data, size, MSG_NOSIGNAL) < 0) 
459 #endif
460     {
461       olsr_printf(1, "(DOT DRAW)IPC connection lost!\n");
462       close(ipc_connection);
463       ipc_open = 0;
464       return -1;
465     }
466
467   return 1;
468 }
469
470 static char*
471 olsr_netmask_to_string(union hna_netmask *mask)
472 {
473   char *ret;
474   struct in_addr in;
475
476   if(olsr_cnf->ip_version == AF_INET)
477     {
478       in.s_addr = mask->v4;
479       ret = inet_ntoa(in);
480     }
481   else
482     {
483       /* IPv6 */
484       static char netmask[5];
485       sprintf(netmask, "%d", mask->v6);
486       ret = netmask;
487     }
488
489   return ret;
490 }