Add LISTEN support for dotdraw. Thanks to Sebastian Harl for the patch
[olsrd.git] / lib / dot_draw / src / olsrd_dot_draw.c
1
2 /*
3  * The olsr.org Optimized Link-State Routing daemon(olsrd)
4  * Copyright (c) 2004, Andreas Tonnesen(andreto@olsr.org)
5  *                     includes code by Bruno Randolf
6  * All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  *
12  * * Redistributions of source code must retain the above copyright
13  *   notice, this list of conditions and the following disclaimer.
14  * * Redistributions in binary form must reproduce the above copyright
15  *   notice, this list of conditions and the following disclaimer in
16  *   the documentation and/or other materials provided with the
17  *   distribution.
18  * * Neither the name of olsr.org, olsrd nor the names of its
19  *   contributors may be used to endorse or promote products derived
20  *   from this software without specific prior written permission.
21  *
22  * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23  * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24  * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
25  * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
26  * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
27  * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
28  * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
29  * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER
30  * CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
31  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
32  * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
33  * POSSIBILITY OF SUCH DAMAGE.
34  *
35  * Visit http://www.olsr.org for more information.
36  *
37  * If you find this software useful feel free to make a donation
38  * to the project. For more information see the website or contact
39  * the copyright holders.
40  *
41  */
42
43 /*
44  * Dynamic linked library for the olsr.org olsr daemon
45  */
46
47 #ifdef _WRS_KERNEL
48 #include <vxWorks.h>
49 #include <sockLib.h>
50 #include <wrn/coreip/netinet/in.h>
51 #else
52 #include <sys/types.h>
53 #include <sys/socket.h>
54 #include <netinet/in.h>
55 #include <arpa/inet.h>
56 #include <sys/time.h>
57 #include <time.h>
58 #include <math.h>
59 #include <stdio.h>
60 #include <string.h>
61 #include <stdlib.h>
62 #include <unistd.h>
63 #include <errno.h>
64 #include <stdarg.h>
65 #endif
66
67 #include "olsr.h"
68 #include "ipcalc.h"
69 #include "olsr_types.h"
70 #include "neighbor_table.h"
71 #include "two_hop_neighbor_table.h"
72 #include "tc_set.h"
73 #include "hna_set.h"
74 #include "mid_set.h"
75 #include "link_set.h"
76 #include "socket_parser.h"
77 #include "net_olsr.h"
78 #include "lq_plugin.h"
79
80 #include "olsrd_dot_draw.h"
81 #include "olsrd_plugin.h"
82
83 #ifdef WIN32
84 #define close(x) closesocket(x)
85 #endif
86
87 #ifdef _WRS_KERNEL
88 static int ipc_open;
89 static int ipc_socket_up;
90 #define DOT_DRAW_PORT 2004
91 #endif
92
93 static int ipc_socket;
94 static int ipc_connection;
95
96 /* IPC initialization function */
97 static int plugin_ipc_init(void);
98
99 /* Event function to register with the sceduler */
100 static int pcf_event(int, int, int);
101
102 static void ipc_action(int);
103
104 static void ipc_print_neigh_link(const struct neighbor_entry *neighbor);
105
106 static void ipc_print_tc_link(const struct tc_entry *, const struct tc_edge_entry *);
107
108 static void ipc_print_net(const union olsr_ip_addr *, const union olsr_ip_addr *, uint8_t);
109
110 static void ipc_send(const char *, int);
111
112 static void ipc_send_fmt(const char *format, ...) __attribute__ ((format(printf, 1, 2)));
113
114 #define ipc_send_str(data) ipc_send((data), strlen(data))
115
116 /**
117  *Do initialization here
118  *
119  *This function is called by the my_init
120  *function in uolsrd_plugin.c
121  */
122 #ifdef _WRS_KERNEL
123 int
124 olsrd_dotdraw_init(void)
125 #else
126 int
127 olsrd_plugin_init(void)
128 #endif
129 {
130   /* Initial IPC value */
131   ipc_socket = -1;
132   ipc_connection = -1;
133
134   /* Register the "ProcessChanges" function */
135   register_pcf(&pcf_event);
136
137   plugin_ipc_init();
138
139   return 1;
140 }
141
142 /**
143  * destructor - called at unload
144  */
145 #ifdef _WRS_KERNEL
146 void
147 olsrd_dotdraw_exit(void)
148 #else
149 void
150 olsr_plugin_exit(void)
151 #endif
152 {
153   if (ipc_connection != -1) {
154     CLOSE(ipc_connection);
155   }
156   if (ipc_socket != -1) {
157     CLOSE(ipc_socket);
158   }
159 }
160
161 static void
162 ipc_print_neigh_link(const struct neighbor_entry *neighbor)
163 {
164   struct ipaddr_str mainaddrstrbuf, strbuf;
165   olsr_linkcost etx = 0.0;
166   const char *style;
167   const char *adr = olsr_ip_to_string(&mainaddrstrbuf, &olsr_cnf->main_addr);
168   struct link_entry *link;
169   struct lqtextbuffer lqbuffer;
170
171   if (neighbor->status == 0) {  /* non SYM */
172     style = "dashed";
173   } else {
174     link = get_best_link_to_neighbor(&neighbor->neighbor_main_addr);
175     if (link) {
176       etx = link->linkcost;
177     }
178     style = "solid";
179   }
180
181   ipc_send_fmt("\"%s\" -> \"%s\"[label=\"%s\", style=%s];\n", adr, olsr_ip_to_string(&strbuf, &neighbor->neighbor_main_addr),
182                get_linkcost_text(etx, false, &lqbuffer), style);
183
184   if (neighbor->is_mpr) {
185     ipc_send_fmt("\"%s\"[shape=box];\n", adr);
186   }
187 }
188
189 static int
190 plugin_ipc_init(void)
191 {
192   struct sockaddr_in sin;
193   uint32_t yes = 1;
194
195   if (ipc_socket != -1) {
196     close(ipc_socket);
197   }
198
199   /* Init ipc socket */
200   ipc_socket = socket(AF_INET, SOCK_STREAM, 0);
201   if (ipc_socket == -1) {
202     olsr_printf(1, "(DOT DRAW)IPC socket %s\n", strerror(errno));
203     return 0;
204   }
205
206   if (setsockopt(ipc_socket, SOL_SOCKET, SO_REUSEADDR, (char *)&yes, sizeof(yes)) < 0) {
207     perror("SO_REUSEADDR failed");
208     CLOSE(ipc_socket);
209     return 0;
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 = ipc_listen_ip.v4.s_addr;
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 #if 0
243   printf("Adding socket with olsrd\n");
244 #endif
245   add_olsr_socket(ipc_socket, &ipc_action);
246
247   return 1;
248 }
249
250 static void
251 ipc_action(int fd __attribute__ ((unused)))
252 {
253   struct sockaddr_in pin;
254   socklen_t addrlen = sizeof(struct sockaddr_in);
255
256   if (ipc_connection != -1) {
257     close(ipc_connection);
258   }
259
260   ipc_connection = accept(ipc_socket, (struct sockaddr *)&pin, &addrlen);
261   if (ipc_connection == -1) {
262     olsr_printf(1, "(DOT DRAW)IPC accept: %s\n", strerror(errno));
263     return;
264   }
265 #ifndef _WRS_KERNEL
266   if (!ip4equal(&pin.sin_addr, &ipc_accept_ip.v4)) {
267     olsr_printf(0, "Front end-connection from foreign host (%s) not allowed!\n", inet_ntoa(pin.sin_addr));
268     CLOSE(ipc_connection);
269     return;
270   }
271 #endif
272   olsr_printf(1, "(DOT DRAW)IPC: Connection from %s\n", inet_ntoa(pin.sin_addr));
273   pcf_event(1, 1, 1);
274   close(ipc_connection);        /* close connection after one output */
275 }
276
277 /**
278  *Scheduled event
279  */
280 static int
281 pcf_event(int changes_neighborhood, int changes_topology, int changes_hna)
282 {
283   struct neighbor_entry *neighbor_table_tmp;
284   struct tc_entry *tc;
285   struct tc_edge_entry *tc_edge;
286   struct hna_entry *tmp_hna;
287   struct hna_net *tmp_net;
288   struct ip_prefix_list *hna;
289   int res = 0;
290
291   if (changes_neighborhood || changes_topology || changes_hna) {
292
293     /* Print tables to IPC socket */
294     ipc_send_str("digraph topology\n{\n");
295
296     /* Neighbors */
297     OLSR_FOR_ALL_NBR_ENTRIES(neighbor_table_tmp) {
298       ipc_print_neigh_link(neighbor_table_tmp);
299     }
300     OLSR_FOR_ALL_NBR_ENTRIES_END(neighbor_table_tmp);
301
302     /* Topology */
303     OLSR_FOR_ALL_TC_ENTRIES(tc) {
304       OLSR_FOR_ALL_TC_EDGE_ENTRIES(tc, tc_edge) {
305         if (tc_edge->edge_inv) {
306           ipc_print_tc_link(tc, tc_edge);
307         }
308       }
309       OLSR_FOR_ALL_TC_EDGE_ENTRIES_END(tc, tc_edge);
310     }
311     OLSR_FOR_ALL_TC_ENTRIES_END(tc);
312
313     /* HNA entries */
314     OLSR_FOR_ALL_HNA_ENTRIES(tmp_hna) {
315
316       /* Check all networks */
317       for (tmp_net = tmp_hna->networks.next; tmp_net != &tmp_hna->networks; tmp_net = tmp_net->next) {
318         ipc_print_net(&tmp_hna->A_gateway_addr, &tmp_net->A_network_addr, tmp_net->prefixlen);
319       }
320     }
321     OLSR_FOR_ALL_HNA_ENTRIES_END(tmp_hna);
322
323     /* Local HNA entries */
324     for (hna = olsr_cnf->hna_entries; hna != NULL; hna = hna->next) {
325       ipc_print_net(&olsr_cnf->main_addr, &hna->net.prefix, hna->net.prefix_len);
326     }
327     ipc_send_str("}\n\n");
328
329     res = 1;
330   }
331
332   if (ipc_socket == -1) {
333     plugin_ipc_init();
334   }
335   return res;
336 }
337
338 static void
339 ipc_print_tc_link(const struct tc_entry *entry, const struct tc_edge_entry *dst_entry)
340 {
341   struct ipaddr_str strbuf1, strbuf2;
342   struct lqtextbuffer lqbuffer;
343
344   ipc_send_fmt("\"%s\" -> \"%s\"[label=\"%s\"];\n", olsr_ip_to_string(&strbuf1, &entry->addr),
345                olsr_ip_to_string(&strbuf2, &dst_entry->T_dest_addr), get_linkcost_text(dst_entry->cost, false, &lqbuffer));
346 }
347
348 static void
349 ipc_print_net(const union olsr_ip_addr *gw, const union olsr_ip_addr *net, uint8_t prefixlen)
350 {
351   struct ipaddr_str gwbuf, netbuf;
352
353   ipc_send_fmt("\"%s\" -> \"%s/%d\"[label=\"HNA\"];\n", olsr_ip_to_string(&gwbuf, gw), olsr_ip_to_string(&netbuf, net), prefixlen);
354
355   ipc_send_fmt("\"%s/%d\"[shape=diamond];\n", olsr_ip_to_string(&netbuf, net), prefixlen);
356 }
357
358 static void
359 ipc_send(const char *data, int size)
360 {
361   if (ipc_connection != -1) {
362 #if defined __FreeBSD__ || defined __NetBSD__ || defined __OpenBSD__ || defined __MacOSX__ || \
363 defined _WRS_KERNEL
364 #define FLAGS 0
365 #else
366 #define FLAGS MSG_NOSIGNAL
367 #endif
368     if (send(ipc_connection, data, size, FLAGS) == -1) {
369       olsr_printf(1, "(DOT DRAW)IPC connection lost!\n");
370       CLOSE(ipc_connection);
371     }
372   }
373 }
374
375 static void
376 ipc_send_fmt(const char *format, ...)
377 {
378   if (ipc_connection != -1) {
379     char buf[4096];
380     int len;
381     va_list arg;
382     va_start(arg, format);
383     len = vsnprintf(buf, sizeof(buf), format, arg);
384     va_end(arg);
385     ipc_send(buf, len);
386   }
387 }
388
389 /*
390  * Local Variables:
391  * c-basic-offset: 2
392  * indent-tabs-mode: nil
393  * End:
394  */