305631be087e11be70734beea2e764237aa400ef
[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  */
41
42 /*
43  * Dynamic linked library for the olsr.org olsr daemon
44  */
45
46  
47 #include <sys/types.h>
48 #include <sys/socket.h>
49 #include <netinet/in.h>
50 #include <arpa/inet.h>
51 #include <sys/time.h>
52 #include <time.h>
53 #include <math.h>
54 #include <stdio.h>
55 #include <string.h>
56 #include <stdlib.h>
57 #include <unistd.h>
58 #include <errno.h>
59 #include <stdarg.h>
60
61 #include "olsr.h"
62 #include "ipcalc.h"
63 #include "olsr_types.h"
64 #include "neighbor_table.h"
65 #include "two_hop_neighbor_table.h"
66 #include "tc_set.h"
67 #include "hna_set.h"
68 #include "mid_set.h"
69 #include "link_set.h"
70 #include "socket_parser.h"
71 #include "net_olsr.h"
72
73 #include "olsrd_dot_draw.h"
74 #include "olsrd_plugin.h"
75
76
77 #ifdef WIN32
78 #define close(x) closesocket(x)
79 #endif
80
81
82 static int ipc_socket;
83 static int ipc_connection;
84
85
86
87 /* IPC initialization function */
88 static int
89 plugin_ipc_init(void);
90
91 /* Event function to register with the sceduler */
92 static int
93 pcf_event(int, int, int);
94
95 static void
96 ipc_action(int);
97
98 static void
99 ipc_print_neigh_link(const struct neighbor_entry *neighbor);
100
101 static void
102 ipc_print_tc_link(const struct tc_entry *entry, const struct tc_edge_entry *dst_entry);
103
104 static void
105 ipc_print_net(const union olsr_ip_addr *, const union olsr_ip_addr *, olsr_u8_t);
106
107 static void
108 ipc_send(const char *, int);
109
110 static void
111 ipc_send_fmt(const char *format, ...) __attribute__((format(printf,1,2)));
112
113 #define ipc_send_str(data) ipc_send((data), strlen(data))
114
115
116 /**
117  *Do initialization here
118  *
119  *This function is called by the my_init
120  *function in uolsrd_plugin.c
121  */
122 int
123 olsrd_plugin_init(void)
124 {
125   /* Initial IPC value */
126   ipc_socket = -1;
127   ipc_connection = -1;
128
129   /* Register the "ProcessChanges" function */
130   register_pcf(&pcf_event);
131
132   plugin_ipc_init();
133
134   return 1;
135 }
136
137
138 /**
139  * destructor - called at unload
140  */
141 void
142 olsr_plugin_exit(void)
143 {
144   if (ipc_connection != -1) {
145     CLOSE(ipc_connection);
146   }
147   if (ipc_socket != -1) {
148     CLOSE(ipc_socket);
149   }
150 }
151
152
153 static void
154 ipc_print_neigh_link(const struct neighbor_entry *neighbor)
155 {
156   struct ipaddr_str mainaddrstrbuf, strbuf;
157   double etx = 0.0;
158   const char *style;
159   const char *adr = olsr_ip_to_string(&mainaddrstrbuf, &olsr_cnf->main_addr);
160   struct link_entry* link;
161
162   if (neighbor->status == 0) { // non SYM
163     style = "dashed";
164   } else {   
165     link = get_best_link_to_neighbor(&neighbor->neighbor_main_addr);
166     if (link) {
167       etx = olsr_calc_link_etx(link);
168     }
169     style = "solid";
170   }
171     
172   ipc_send_fmt("\"%s\" -> \"%s\"[label=\"%.2f\", style=%s];\n",
173                adr,
174                olsr_ip_to_string(&strbuf, &neighbor->neighbor_main_addr),
175                etx,
176                style);
177   
178   if (neighbor->is_mpr) {
179     ipc_send_fmt("\"%s\"[shape=box];\n", adr);
180   }
181 }
182
183
184 static int
185 plugin_ipc_init(void)
186 {
187   struct sockaddr_in sin;
188   olsr_u32_t yes = 1;
189
190   if (ipc_socket != -1) {
191     close(ipc_socket);
192   }
193
194   /* Init ipc socket */
195   ipc_socket = socket(AF_INET, SOCK_STREAM, 0);
196   if (ipc_socket == -1) {
197     olsr_printf(1, "(DOT DRAW)IPC socket %s\n", strerror(errno));
198     return 0;
199   }
200
201   if (setsockopt(ipc_socket, SOL_SOCKET, SO_REUSEADDR, (char *)&yes, sizeof(yes)) < 0) {
202     perror("SO_REUSEADDR failed");
203     CLOSE(ipc_socket);
204     return 0;
205   }
206
207 #if defined __FreeBSD__ && defined SO_NOSIGPIPE
208   if (setsockopt(ipc_socket, SOL_SOCKET, SO_NOSIGPIPE, (char *)&yes, sizeof(yes)) < 0) {
209     perror("SO_REUSEADDR failed");
210     CLOSE(ipc_socket);
211     return 0;
212   }
213 #endif
214
215   /* Bind the socket */
216       
217   /* complete the socket structure */
218   memset(&sin, 0, sizeof(sin));
219   sin.sin_family = AF_INET;
220   sin.sin_addr.s_addr = INADDR_ANY;
221   sin.sin_port = htons(ipc_port);
222       
223   /* bind the socket to the port number */
224   if (bind(ipc_socket, (struct sockaddr *) &sin, sizeof(sin)) == -1) {
225     olsr_printf(1, "(DOT DRAW)IPC bind %s\n", strerror(errno));
226     CLOSE(ipc_socket);
227     return 0;
228   }
229       
230   /* show that we are willing to listen */
231   if (listen(ipc_socket, 1) == -1) {
232     olsr_printf(1, "(DOT DRAW)IPC listen %s\n", strerror(errno));
233     CLOSE(ipc_socket);
234     return 0;
235   }
236
237   /* Register with olsrd */
238   //printf("Adding socket with olsrd\n");
239   add_olsr_socket(ipc_socket, &ipc_action);
240
241   return 1;
242 }
243
244
245 static void
246 ipc_action(int fd __attribute__((unused)))
247 {
248   struct sockaddr_in pin;
249   socklen_t addrlen = sizeof(struct sockaddr_in);
250
251   if (ipc_connection != -1) {
252     close(ipc_connection);
253   }
254   
255   ipc_connection = accept(ipc_socket, (struct sockaddr *)&pin, &addrlen);
256   if (ipc_connection == -1) {
257     olsr_printf(1, "(DOT DRAW)IPC accept: %s\n", strerror(errno));
258     return;
259   }
260   if (!ip4equal(&pin.sin_addr, &ipc_accept_ip.v4)) {
261     olsr_printf(0, "Front end-connection from foreign host (%s) not allowed!\n", inet_ntoa(pin.sin_addr));
262     CLOSE(ipc_connection);
263     return;
264   }
265   olsr_printf(1, "(DOT DRAW)IPC: Connection from %s\n", inet_ntoa(pin.sin_addr));
266   pcf_event(1, 1, 1);
267 }
268
269
270 /**
271  *Scheduled event
272  */
273 static int
274 pcf_event(int changes_neighborhood,
275           int changes_topology,
276           int changes_hna)
277 {
278   int res = 0;
279   if(changes_neighborhood || changes_topology || changes_hna) {
280     struct neighbor_entry *neighbor_table_tmp;
281     struct tc_entry *tc;
282     struct tc_edge_entry *tc_edge;
283     struct ip_prefix_list *hna;
284     int idx;
285     
286     /* Print tables to IPC socket */
287     ipc_send_str("digraph topology\n{\n");
288
289     /* Neighbors */
290     for (idx = 0; idx < HASHSIZE; idx++) {        
291       for(neighbor_table_tmp = neighbortable[idx].next;
292           neighbor_table_tmp != &neighbortable[idx];
293           neighbor_table_tmp = neighbor_table_tmp->next){
294         ipc_print_neigh_link( neighbor_table_tmp );
295       }
296     }
297
298     /* Topology */  
299     OLSR_FOR_ALL_TC_ENTRIES(tc) {
300       OLSR_FOR_ALL_TC_EDGE_ENTRIES(tc, tc_edge) {
301         ipc_print_tc_link(tc, tc_edge);
302       } OLSR_FOR_ALL_TC_EDGE_ENTRIES_END(tc, tc_edge);
303     } OLSR_FOR_ALL_TC_ENTRIES_END(tc);
304
305     /* HNA entries */
306     for (idx = 0; idx < HASHSIZE; idx++) {
307       struct hna_entry *tmp_hna;
308       /* Check all entrys */
309       for (tmp_hna = hna_set[idx].next; tmp_hna != &hna_set[idx]; tmp_hna = tmp_hna->next) {
310         /* Check all networks */
311         struct hna_net *tmp_net;
312         for (tmp_net = tmp_hna->networks.next; tmp_net != &tmp_hna->networks; tmp_net = tmp_net->next) {
313           ipc_print_net(&tmp_hna->A_gateway_addr, 
314                         &tmp_net->A_network_addr, 
315                         tmp_net->prefixlen);
316         }
317       }
318     }
319
320     /* Local HNA entries */
321     for (hna = olsr_cnf->hna_entries; hna != NULL; hna = hna->next) {
322       ipc_print_net(&olsr_cnf->main_addr,
323                     &hna->net.prefix,
324                     hna->net.prefix_len);
325     }
326     ipc_send_str("}\n\n");
327
328     res = 1;
329   }
330
331   if (ipc_socket == -1) {
332     plugin_ipc_init();
333   }
334   return res;
335 }
336
337 static void
338 ipc_print_tc_link(const struct tc_entry *entry, const struct tc_edge_entry *dst_entry)
339 {
340   struct ipaddr_str strbuf1, strbuf2;
341
342   ipc_send_fmt("\"%s\" -> \"%s\"[label=\"%.2f\"];\n",
343                olsr_ip_to_string(&strbuf1, &entry->addr),
344                olsr_ip_to_string(&strbuf2, &dst_entry->T_dest_addr),
345                olsr_calc_tc_etx(dst_entry));
346 }
347
348
349 static void
350 ipc_print_net(const union olsr_ip_addr *gw, const union olsr_ip_addr *net, olsr_u8_t prefixlen)
351 {
352   struct ipaddr_str gwbuf, netbuf;
353
354   ipc_send_fmt("\"%s\" -> \"%s/%d\"[label=\"HNA\"];\n",
355                olsr_ip_to_string(&gwbuf, gw),
356                olsr_ip_to_string(&netbuf, net),
357                prefixlen);
358
359   ipc_send_fmt("\"%s/%d\"[shape=diamond];\n",
360                olsr_ip_to_string(&netbuf, net),
361                prefixlen);
362 }
363
364 static void
365 ipc_send(const char *data, int size)
366 {
367   if (ipc_connection != -1) {
368 #if defined __FreeBSD__ || defined __NetBSD__ || defined __OpenBSD__ || defined __MacOSX__
369 #define FLAGS 0
370 #else
371 #define FLAGS MSG_NOSIGNAL
372 #endif
373     if (send(ipc_connection, data, size, FLAGS) == -1) {
374       olsr_printf(1, "(DOT DRAW)IPC connection lost!\n");
375       CLOSE(ipc_connection);
376     }
377   }
378 }
379
380 static void
381 ipc_send_fmt(const char *format, ...)
382 {
383   if (ipc_connection != -1) {
384     char buf[4096];
385     int len;
386     va_list arg;
387     va_start(arg, format);
388     len = vsnprintf(buf, sizeof(buf), format, arg);
389     va_end(arg);
390     ipc_send(buf, len);
391   }
392 }