From Sven-Ola Tuecke <sven-ola@gmx.de>: add support for fixedpoint math
[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 #ifdef USE_FPM
158   fpm etx = itofpm(0);
159 #else
160   double etx = 0.0;
161 #endif
162   const char *style;
163   const char *adr = olsr_ip_to_string(&mainaddrstrbuf, &olsr_cnf->main_addr);
164   struct link_entry* link;
165
166   if (neighbor->status == 0) { // non SYM
167     style = "dashed";
168   } else {   
169     link = get_best_link_to_neighbor(&neighbor->neighbor_main_addr);
170     if (link) {
171       etx = olsr_calc_link_etx(link);
172     }
173     style = "solid";
174   }
175     
176   ipc_send_fmt("\"%s\" -> \"%s\"[label=\"%s\", style=%s];\n",
177                adr,
178                olsr_ip_to_string(&strbuf, &neighbor->neighbor_main_addr),
179                olsr_etx_to_string(etx),
180                style);
181   
182   if (neighbor->is_mpr) {
183     ipc_send_fmt("\"%s\"[shape=box];\n", adr);
184   }
185 }
186
187
188 static int
189 plugin_ipc_init(void)
190 {
191   struct sockaddr_in sin;
192   olsr_u32_t yes = 1;
193
194   if (ipc_socket != -1) {
195     close(ipc_socket);
196   }
197
198   /* Init ipc socket */
199   ipc_socket = socket(AF_INET, SOCK_STREAM, 0);
200   if (ipc_socket == -1) {
201     olsr_printf(1, "(DOT DRAW)IPC socket %s\n", strerror(errno));
202     return 0;
203   }
204
205   if (setsockopt(ipc_socket, SOL_SOCKET, SO_REUSEADDR, (char *)&yes, sizeof(yes)) < 0) {
206     perror("SO_REUSEADDR failed");
207     CLOSE(ipc_socket);
208     return 0;
209   }
210
211 #if defined __FreeBSD__ && defined SO_NOSIGPIPE
212   if (setsockopt(ipc_socket, SOL_SOCKET, SO_NOSIGPIPE, (char *)&yes, sizeof(yes)) < 0) {
213     perror("SO_REUSEADDR failed");
214     CLOSE(ipc_socket);
215     return 0;
216   }
217 #endif
218
219   /* Bind the socket */
220       
221   /* complete the socket structure */
222   memset(&sin, 0, sizeof(sin));
223   sin.sin_family = AF_INET;
224   sin.sin_addr.s_addr = INADDR_ANY;
225   sin.sin_port = htons(ipc_port);
226       
227   /* bind the socket to the port number */
228   if (bind(ipc_socket, (struct sockaddr *) &sin, sizeof(sin)) == -1) {
229     olsr_printf(1, "(DOT DRAW)IPC bind %s\n", strerror(errno));
230     CLOSE(ipc_socket);
231     return 0;
232   }
233       
234   /* show that we are willing to listen */
235   if (listen(ipc_socket, 1) == -1) {
236     olsr_printf(1, "(DOT DRAW)IPC listen %s\n", strerror(errno));
237     CLOSE(ipc_socket);
238     return 0;
239   }
240
241   /* Register with olsrd */
242   //printf("Adding socket with olsrd\n");
243   add_olsr_socket(ipc_socket, &ipc_action);
244
245   return 1;
246 }
247
248
249 static void
250 ipc_action(int fd __attribute__((unused)))
251 {
252   struct sockaddr_in pin;
253   socklen_t addrlen = sizeof(struct sockaddr_in);
254
255   if (ipc_connection != -1) {
256     close(ipc_connection);
257   }
258   
259   ipc_connection = accept(ipc_socket, (struct sockaddr *)&pin, &addrlen);
260   if (ipc_connection == -1) {
261     olsr_printf(1, "(DOT DRAW)IPC accept: %s\n", strerror(errno));
262     return;
263   }
264   if (!ip4equal(&pin.sin_addr, &ipc_accept_ip.v4)) {
265     olsr_printf(0, "Front end-connection from foreign host (%s) not allowed!\n", inet_ntoa(pin.sin_addr));
266     CLOSE(ipc_connection);
267     return;
268   }
269   olsr_printf(1, "(DOT DRAW)IPC: Connection from %s\n", inet_ntoa(pin.sin_addr));
270   pcf_event(1, 1, 1);
271 }
272
273
274 /**
275  *Scheduled event
276  */
277 static int
278 pcf_event(int changes_neighborhood,
279           int changes_topology,
280           int changes_hna)
281 {
282   int res = 0;
283   if(changes_neighborhood || changes_topology || changes_hna) {
284     struct neighbor_entry *neighbor_table_tmp;
285     struct tc_entry *tc;
286     struct tc_edge_entry *tc_edge;
287     struct ip_prefix_list *hna;
288     int idx;
289     
290     /* Print tables to IPC socket */
291     ipc_send_str("digraph topology\n{\n");
292
293     /* Neighbors */
294     for (idx = 0; idx < HASHSIZE; idx++) {        
295       for(neighbor_table_tmp = neighbortable[idx].next;
296           neighbor_table_tmp != &neighbortable[idx];
297           neighbor_table_tmp = neighbor_table_tmp->next){
298         ipc_print_neigh_link( neighbor_table_tmp );
299       }
300     }
301
302     /* Topology */  
303     OLSR_FOR_ALL_TC_ENTRIES(tc) {
304       OLSR_FOR_ALL_TC_EDGE_ENTRIES(tc, tc_edge) {
305         ipc_print_tc_link(tc, tc_edge);
306       } OLSR_FOR_ALL_TC_EDGE_ENTRIES_END(tc, tc_edge);
307     } OLSR_FOR_ALL_TC_ENTRIES_END(tc);
308
309     /* HNA entries */
310     for (idx = 0; idx < HASHSIZE; idx++) {
311       struct hna_entry *tmp_hna;
312       /* Check all entrys */
313       for (tmp_hna = hna_set[idx].next; tmp_hna != &hna_set[idx]; tmp_hna = tmp_hna->next) {
314         /* Check all networks */
315         struct hna_net *tmp_net;
316         for (tmp_net = tmp_hna->networks.next; tmp_net != &tmp_hna->networks; tmp_net = tmp_net->next) {
317           ipc_print_net(&tmp_hna->A_gateway_addr, 
318                         &tmp_net->A_network_addr, 
319                         tmp_net->prefixlen);
320         }
321       }
322     }
323
324     /* Local HNA entries */
325     for (hna = olsr_cnf->hna_entries; hna != NULL; hna = hna->next) {
326       ipc_print_net(&olsr_cnf->main_addr,
327                     &hna->net.prefix,
328                     hna->net.prefix_len);
329     }
330     ipc_send_str("}\n\n");
331
332     res = 1;
333   }
334
335   if (ipc_socket == -1) {
336     plugin_ipc_init();
337   }
338   return res;
339 }
340
341 static void
342 ipc_print_tc_link(const struct tc_entry *entry, const struct tc_edge_entry *dst_entry)
343 {
344   struct ipaddr_str strbuf1, strbuf2;
345
346   ipc_send_fmt("\"%s\" -> \"%s\"[label=\"%s\"];\n",
347                olsr_ip_to_string(&strbuf1, &entry->addr),
348                olsr_ip_to_string(&strbuf2, &dst_entry->T_dest_addr),
349                olsr_etx_to_string(olsr_calc_tc_etx(dst_entry)));
350 }
351
352
353 static void
354 ipc_print_net(const union olsr_ip_addr *gw, const union olsr_ip_addr *net, olsr_u8_t prefixlen)
355 {
356   struct ipaddr_str gwbuf, netbuf;
357
358   ipc_send_fmt("\"%s\" -> \"%s/%d\"[label=\"HNA\"];\n",
359                olsr_ip_to_string(&gwbuf, gw),
360                olsr_ip_to_string(&netbuf, net),
361                prefixlen);
362
363   ipc_send_fmt("\"%s/%d\"[shape=diamond];\n",
364                olsr_ip_to_string(&netbuf, net),
365                prefixlen);
366 }
367
368 static void
369 ipc_send(const char *data, int size)
370 {
371   if (ipc_connection != -1) {
372 #if defined __FreeBSD__ || defined __NetBSD__ || defined __OpenBSD__ || defined __MacOSX__
373 #define FLAGS 0
374 #else
375 #define FLAGS MSG_NOSIGNAL
376 #endif
377     if (send(ipc_connection, data, size, FLAGS) == -1) {
378       olsr_printf(1, "(DOT DRAW)IPC connection lost!\n");
379       CLOSE(ipc_connection);
380     }
381   }
382 }
383
384 static void
385 ipc_send_fmt(const char *format, ...)
386 {
387   if (ipc_connection != -1) {
388     char buf[4096];
389     int len;
390     va_list arg;
391     va_start(arg, format);
392     len = vsnprintf(buf, sizeof(buf), format, arg);
393     va_end(arg);
394     ipc_send(buf, len);
395   }
396 }