Update to new avl/list iteration macros
[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, *nbr_iterator;
266     struct tc_entry *tc, *tc_iterator;
267     struct hna_net *hna, *hna_iterator;
268     struct ip_prefix_entry *prefix, *prefix_iterator;
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, nbr_iterator) {
275       ipc_print_neigh_link(ipc_connection, neighbor_table_tmp);
276     }
277
278     /* Topology */
279     OLSR_FOR_ALL_TC_ENTRIES(tc, tc_iterator) {
280       struct tc_edge_entry *tc_edge, *edge_iterator;
281       OLSR_FOR_ALL_TC_EDGE_ENTRIES(tc, tc_edge, edge_iterator) {
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, tc_iterator) {
290       /* Check all networks */
291       OLSR_FOR_ALL_TC_HNA_ENTRIES(tc, hna, hna_iterator) {
292         ipc_print_net(ipc_connection, &tc->addr, &hna->hna_prefix);
293       }
294     }
295
296     /* Local HNA entries */
297     OLSR_FOR_ALL_IPPREFIX_ENTRIES(&olsr_cnf->hna_entries, prefix, prefix_iterator) {
298       ipc_print_net(ipc_connection, &olsr_cnf->router_id, &prefix->net);
299     }
300       ipc_send_str(ipc_connection, "}\n\n");
301
302     res = 1;
303   }
304
305   if (ipc_socket == -1) {
306     plugin_ipc_init();
307   }
308   return res;
309 }
310
311 static void
312 ipc_print_tc_link(int ipc_connection, const struct tc_entry *entry, const struct tc_edge_entry *dst_entry)
313 {
314   struct ipaddr_str strbuf1, strbuf2;
315   char lqbuffer[LQTEXT_MAXLENGTH];
316
317   ipc_send_fmt(ipc_connection,
318                "\"%s\" -> \"%s\"[label=\"%s\"];\n",
319                olsr_ip_to_string(&strbuf1, &entry->addr),
320                olsr_ip_to_string(&strbuf2, &dst_entry->T_dest_addr),
321                olsr_get_linkcost_text(dst_entry->cost, false, lqbuffer, sizeof(lqbuffer)));
322 }
323
324
325 static void
326 ipc_print_net(int ipc_connection, const union olsr_ip_addr *gw, const struct olsr_ip_prefix *net)
327 {
328   struct ipaddr_str gwbuf;
329   struct ipprefix_str netbuf;
330
331   ipc_send_fmt(ipc_connection,
332                "\"%s\" -> \"%s\"[label=\"HNA\"];\n", olsr_ip_to_string(&gwbuf, gw), olsr_ip_prefix_to_string(&netbuf, net));
333   ipc_send_fmt(ipc_connection, "\"%s\"[shape=diamond];\n", netbuf.buf);
334 }
335
336 static void
337 ipc_send(int ipc_connection, const char *data, int size)
338 {
339   if (ipc_connection != -1) {
340 #if defined __FreeBSD__ || defined __NetBSD__ || defined __OpenBSD__ || defined __MacOSX__ || \
341 defined _WRS_KERNEL
342 #define FLAGS 0
343 #else
344 #define FLAGS MSG_NOSIGNAL
345 #endif
346     if (send(ipc_connection, data, size, FLAGS) == -1) {
347       OLSR_WARN(LOG_PLUGINS, "(DOT DRAW)IPC connection lost!\n");
348       os_close(ipc_connection);
349     }
350   }
351 }
352
353 static void
354 ipc_send_fmt(int ipc_connection, const char *format, ...)
355 {
356   if (ipc_connection != -1) {
357     char buf[4096];
358     int len;
359     va_list arg;
360     va_start(arg, format);
361     len = vsnprintf(buf, sizeof(buf), format, arg);
362     va_end(arg);
363     ipc_send(ipc_connection, buf, len);
364   }
365 }
366
367 /*
368  * Local Variables:
369  * c-basic-offset: 2
370  * indent-tabs-mode: nil
371  * End:
372  */