b25ae0e38eb5cc224f059de2f1bcaec96c76f1ac
[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-2009, the olsr.org team - see HISTORY file
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 #include "olsrd_dot_draw.h"
47 #include "olsr.h"
48 #include "ipcalc.h"
49 #include "neighbor_table.h"
50 #include "tc_set.h"
51 #include "hna_set.h"
52 #include "link_set.h"
53 #include "olsr_ip_prefix_list.h"
54 #include "olsr_logging.h"
55 #include "os_net.h"
56
57 #ifdef _WRS_KERNEL
58 #include <vxWorks.h>
59 #include <sockLib.h>
60 #include <wrn/coreip/netinet/in.h>
61 #else
62 #include <unistd.h>
63 #include <errno.h>
64 #include <stdarg.h>
65 #endif
66
67 #ifdef _WRS_KERNEL
68 static int ipc_open;
69 static int ipc_socket_up;
70 #define DOT_DRAW_PORT 2004
71 #endif
72
73 static int ipc_socket;
74
75 /* IPC initialization function */
76 static int
77   plugin_ipc_init(void);
78
79 /* Event function to register with the sceduler */
80 static int
81   pcf_event(int, int, int, int);
82
83 static void
84   ipc_action(int, void *, unsigned int);
85
86 static void
87   ipc_print_neigh_link(int, const struct nbr_entry *neighbor);
88
89 static void
90   ipc_print_tc_link(int, const struct tc_entry *, const struct tc_edge_entry *);
91
92 static void
93   ipc_print_net(int, const union olsr_ip_addr *, const struct olsr_ip_prefix *);
94
95 static void
96   ipc_send(int, const char *, int);
97
98 static void
99   ipc_send_fmt(int, const char *format, ...) __attribute__ ((format(printf, 2, 3)));
100
101 #define ipc_send_str(fd, data) ipc_send((fd), (data), strlen(data))
102
103
104 /**
105  *Do initialization here
106  *
107  *This function is called by the my_init
108  *function in uolsrd_plugin.c
109  */
110 #ifdef _WRS_KERNEL
111 int
112 olsrd_dotdraw_init(void)
113 #else
114 int
115 olsrd_plugin_init(void)
116 #endif
117 {
118   /* Initial IPC value */
119   ipc_socket = -1;
120
121   plugin_ipc_init();
122
123   return 1;
124 }
125
126
127 /**
128  * destructor - called at unload
129  */
130 #ifdef _WRS_KERNEL
131 void
132 olsrd_dotdraw_exit(void)
133 #else
134 void
135 olsr_plugin_exit(void)
136 #endif
137 {
138   if (ipc_socket != -1) {
139     os_close(ipc_socket);
140   }
141 }
142
143
144 static void
145 ipc_print_neigh_link(int ipc_connection, const struct nbr_entry *neighbor)
146 {
147   struct ipaddr_str mainaddrstrbuf, strbuf;
148   olsr_linkcost etx = 0.0;
149   const char *style;
150   const char *adr = olsr_ip_to_string(&mainaddrstrbuf, &olsr_cnf->router_id);
151   char lqbuffer[LQTEXT_MAXLENGTH];
152
153   if (neighbor->is_sym == 0) {  /* non SYM */
154     style = "dashed";
155   } else {
156     const struct link_entry *lnk = get_best_link_to_neighbor_ip(&neighbor->nbr_addr);
157     if (lnk) {
158       etx = lnk->linkcost;
159     }
160     style = "solid";
161   }
162
163   ipc_send_fmt(ipc_connection,
164                "\"%s\" -> \"%s\"[label=\"%s\", style=%s];\n",
165                adr, olsr_ip_to_string(&strbuf, &neighbor->nbr_addr),
166                olsr_get_linkcost_text(etx, false, lqbuffer, sizeof(lqbuffer)), style);
167
168   if (neighbor->is_mpr) {
169     ipc_send_fmt(ipc_connection, "\"%s\"[shape=box];\n", adr);
170   }
171 }
172
173
174 static int
175 plugin_ipc_init(void)
176 {
177   struct sockaddr_in addr;
178   uint32_t yes = 1;
179
180   if (ipc_socket != -1) {
181     os_close(ipc_socket);
182   }
183
184   /* Init ipc socket */
185   ipc_socket = socket(AF_INET, SOCK_STREAM, 0);
186   if (ipc_socket == -1) {
187     OLSR_WARN(LOG_PLUGINS, "(DOT DRAW)IPC socket %s\n", strerror(errno));
188     return 0;
189   }
190
191   if (setsockopt(ipc_socket, SOL_SOCKET, SO_REUSEADDR, (char *)&yes, sizeof(yes)) < 0) {
192     OLSR_WARN(LOG_PLUGINS, "SO_REUSEADDR failed %s\n", strerror(errno));
193     os_close(ipc_socket);
194     return 0;
195   }
196 #if defined __FreeBSD__ && defined SO_NOSIGPIPE
197   if (setsockopt(ipc_socket, SOL_SOCKET, SO_NOSIGPIPE, (char *)&yes, sizeof(yes)) < 0) {
198     OLSR_WARN(LOG_PLUGINS, "SO_REUSEADDR failed %s\n", strerror(errno));
199     CLOSESOCKET(ipc_socket);
200     return 0;
201   }
202 #endif
203
204   /* Bind the socket */
205
206   /* complete the socket structure */
207   memset(&addr, 0, sizeof(addr));
208   addr.sin_family = AF_INET;
209   addr.sin_addr.s_addr = INADDR_ANY;
210   addr.sin_port = htons(ipc_port);
211
212   /* bind the socket to the port number */
213   if (bind(ipc_socket, (struct sockaddr *)&addr, sizeof(addr)) == -1) {
214     OLSR_WARN(LOG_PLUGINS, "(DOT DRAW)IPC bind %s\n", strerror(errno));
215     os_close(ipc_socket);
216     return 0;
217   }
218
219   /* show that we are willing to listen */
220   if (listen(ipc_socket, 1) == -1) {
221     OLSR_WARN(LOG_PLUGINS, "(DOT DRAW)IPC listen %s\n", strerror(errno));
222     os_close(ipc_socket);
223     return 0;
224   }
225
226   /* Register with olsrd */
227   add_olsr_socket(ipc_socket, &ipc_action, NULL, NULL, SP_PR_READ);
228
229   return 1;
230 }
231
232
233 static void
234 ipc_action(int fd __attribute__ ((unused)), void *data __attribute__ ((unused)), unsigned int flags __attribute__ ((unused)))
235 {
236   struct sockaddr_in pin;
237   socklen_t addrlen = sizeof(struct sockaddr_in);
238   int ipc_connection = accept(ipc_socket, (struct sockaddr *)&pin, &addrlen);
239   if (ipc_connection == -1) {
240     OLSR_WARN(LOG_PLUGINS, "(DOT DRAW)IPC accept: %s\n", strerror(errno));
241     return;
242   }
243 #ifndef _WRS_KERNEL
244   if (ip4cmp(&pin.sin_addr, &ipc_accept_ip.v4) != 0) {
245     OLSR_WARN(LOG_PLUGINS, "Front end-connection from foreign host (%s) not allowed!\n", inet_ntoa(pin.sin_addr));
246     os_close(ipc_connection);
247     return;
248   }
249 #endif
250   OLSR_DEBUG(LOG_PLUGINS, "(DOT DRAW)IPC: Connection from %s\n", inet_ntoa(pin.sin_addr));
251   pcf_event(ipc_connection, 1, 1, 1);
252   os_close(ipc_connection);  /* close connection after one output */
253 }
254
255
256 /**
257  *Scheduled event
258  */
259 static int
260 pcf_event(int ipc_connection, int chgs_neighborhood, int chgs_topology, int chgs_hna)
261 {
262   int res = 0;
263
264   if (chgs_neighborhood || chgs_topology || chgs_hna) {
265     struct nbr_entry *neighbor_table_tmp;
266     struct tc_entry *tc;
267     struct ip_prefix_entry *hna;
268     struct list_iterator iterator, iterator2;
269
270     /* Print tables to IPC socket */
271     ipc_send_str(ipc_connection, "digraph topology\n{\n");
272
273     /* Neighbors */
274     OLSR_FOR_ALL_NBR_ENTRIES(neighbor_table_tmp, iterator) {
275       ipc_print_neigh_link(ipc_connection, neighbor_table_tmp);
276     }
277
278     /* Topology */
279     OLSR_FOR_ALL_TC_ENTRIES(tc, iterator) {
280       struct tc_edge_entry *tc_edge;
281       OLSR_FOR_ALL_TC_EDGE_ENTRIES(tc, tc_edge, iterator2) {
282         if (tc_edge->edge_inv) {
283           ipc_print_tc_link(ipc_connection, tc, tc_edge);
284         }
285       }
286     }
287
288     /* HNA entries */
289     OLSR_FOR_ALL_TC_ENTRIES(tc, iterator) {
290       /* Check all networks */
291       struct hna_net *tmp_net;
292       OLSR_FOR_ALL_TC_HNA_ENTRIES(tc, tmp_net, iterator2) {
293         ipc_print_net(ipc_connection, &tc->addr, &tmp_net->hna_prefix);
294       }
295     }
296
297     /* Local HNA entries */
298     OLSR_FOR_ALL_IPPREFIX_ENTRIES(&olsr_cnf->hna_entries, hna, iterator) {
299       ipc_print_net(ipc_connection, &olsr_cnf->router_id, &hna->net);
300     }
301       ipc_send_str(ipc_connection, "}\n\n");
302
303     res = 1;
304   }
305
306   if (ipc_socket == -1) {
307     plugin_ipc_init();
308   }
309   return res;
310 }
311
312 static void
313 ipc_print_tc_link(int ipc_connection, const struct tc_entry *entry, const struct tc_edge_entry *dst_entry)
314 {
315   struct ipaddr_str strbuf1, strbuf2;
316   char lqbuffer[LQTEXT_MAXLENGTH];
317
318   ipc_send_fmt(ipc_connection,
319                "\"%s\" -> \"%s\"[label=\"%s\"];\n",
320                olsr_ip_to_string(&strbuf1, &entry->addr),
321                olsr_ip_to_string(&strbuf2, &dst_entry->T_dest_addr),
322                olsr_get_linkcost_text(dst_entry->cost, false, lqbuffer, sizeof(lqbuffer)));
323 }
324
325
326 static void
327 ipc_print_net(int ipc_connection, const union olsr_ip_addr *gw, const struct olsr_ip_prefix *net)
328 {
329   struct ipaddr_str gwbuf;
330   struct ipprefix_str netbuf;
331
332   ipc_send_fmt(ipc_connection,
333                "\"%s\" -> \"%s\"[label=\"HNA\"];\n", olsr_ip_to_string(&gwbuf, gw), olsr_ip_prefix_to_string(&netbuf, net));
334   ipc_send_fmt(ipc_connection, "\"%s\"[shape=diamond];\n", netbuf.buf);
335 }
336
337 static void
338 ipc_send(int ipc_connection, const char *data, int size)
339 {
340   if (ipc_connection != -1) {
341 #if defined __FreeBSD__ || defined __NetBSD__ || defined __OpenBSD__ || defined __MacOSX__ || \
342 defined _WRS_KERNEL
343 #define FLAGS 0
344 #else
345 #define FLAGS MSG_NOSIGNAL
346 #endif
347     if (send(ipc_connection, data, size, FLAGS) == -1) {
348       OLSR_WARN(LOG_PLUGINS, "(DOT DRAW)IPC connection lost!\n");
349       os_close(ipc_connection);
350     }
351   }
352 }
353
354 static void
355 ipc_send_fmt(int ipc_connection, const char *format, ...)
356 {
357   if (ipc_connection != -1) {
358     char buf[4096];
359     int len;
360     va_list arg;
361     va_start(arg, format);
362     len = vsnprintf(buf, sizeof(buf), format, arg);
363     va_end(arg);
364     ipc_send(ipc_connection, buf, len);
365   }
366 }
367
368 /*
369  * Local Variables:
370  * c-basic-offset: 2
371  * indent-tabs-mode: nil
372  * End:
373  */