Automated merge with http://gredler.at/hg/olsrd
[olsrd.git] / src / olsr_switch / ohs_cmd.c
1
2 /*
3  * The olsr.org Optimized Link-State Routing daemon(olsrd)
4  * Copyright (c) 2005, Andreas T√łnnesen(andreto@olsr.org)
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 #include "olsr_host_switch.h"
43 #include "olsr_types.h"
44 #include "commands.h"
45 #include "link_rules.h"
46 #include "ipcalc.h"
47 #include "../common/string.h"
48
49 #include <string.h>
50 #include <stdlib.h>
51 #include <sys/socket.h>
52 #include <netinet/in.h>
53 #include <arpa/inet.h>
54 #include <sys/types.h>
55 #include <sys/stat.h>
56 #include <unistd.h>
57 #include <errno.h>
58
59
60 #define TOK_BUF_SIZE 500
61 static char tok_buf[TOK_BUF_SIZE];
62
63 #define MAX_OLSRD_ARGS 10
64 static char olsrd_path[FILENAME_MAX];
65
66 static int
67 get_next_token(const char *src, char *dst, size_t buflen)
68 {
69   int i = 0, j = 0;
70
71   dst[0] = 0;
72   /* Skip leading spaces */
73   while(src[j] == ' ' && src[j] != 0)
74     {
75       j++;
76     }
77
78   src += j;
79   i = 0;
80   while((src[i] != ' ') && (src[i] != 0) && (i < ((int)buflen - 1)))
81     {
82       dst[i] = src[i];
83       i++;
84     }
85   dst[i] = 0;
86
87   //if(strlen(dst))
88   //printf("Extracted token: %s\n", dst);
89   return i + j;
90 }
91
92 int
93 ohs_set_olsrd_path(const char *path)
94 {
95   strscpy(olsrd_path, path, sizeof(olsrd_path));
96   return 0;
97 }
98
99 #ifdef WIN32
100 int
101 ohs_cmd_olsrd(char *args __attribute__((unused)))
102 {
103   printf("olsrd command not available in windows version\nStart instances manually\n");
104   return 0;
105 }
106 #else
107 int
108 ohs_cmd_olsrd(const char *args)
109 {
110   const char *olsrd_args[MAX_OLSRD_ARGS];
111   struct in_addr iaddr;
112
113   args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
114
115   if(!strlen(tok_buf))
116     goto print_usage;
117
118   /* Start olsrd instance */
119   if(!strncmp(tok_buf, "start", strlen("start")))
120     {
121       int argc = 0, i = 0;
122
123       args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
124       
125       if(!strlen(tok_buf))
126         goto print_usage;
127
128       if(!inet_aton(tok_buf, &iaddr))
129         {
130           printf("Invalid IP %s\n", tok_buf);
131           goto print_usage;
132         }
133
134       olsrd_args[argc++] = olsrd_path;
135
136       if(1) /* config file is set */
137         {
138           olsrd_args[argc++] = "-f";
139           olsrd_args[argc++] = "/etc/olsrd-emu.conf";
140         }
141       olsrd_args[argc++] = "-hemu";
142       olsrd_args[argc++] = tok_buf;
143
144       olsrd_args[argc++] = "-d";
145       olsrd_args[argc++] = "0";
146       olsrd_args[argc++] = "-nofork";
147       olsrd_args[argc] = NULL;
148
149       printf("Executing: %s", olsrd_path);
150       for(i = 0; i < argc; i++)
151         printf(" %s", olsrd_args[i]);
152       printf("\n");
153
154       if(fork())
155         return 1;
156
157       if(execve(olsrd_path, (char * const *)olsrd_args, NULL) < 0)
158         {
159           printf("Error executing olsrd: %s\n", strerror(errno));
160           exit(1);
161         }
162     }
163   /* Stop olsrd instance */
164   else if(!strncmp(tok_buf, "stop", strlen("stop")))
165     {
166       struct ohs_connection *oc;
167
168       args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
169       
170       if(!strlen(tok_buf))
171         goto print_usage;
172
173       if(!inet_aton(tok_buf, &iaddr))
174         {
175           printf("Invalid IP %s\n", tok_buf);
176           goto print_usage;
177         }
178
179       oc = get_client_by_addr((union olsr_ip_addr *)&iaddr.s_addr);
180
181       if(!oc)
182         {
183           printf("No such client: %s\n", tok_buf);
184           return -1;
185         }
186       ohs_delete_connection(oc);
187       
188       return 1;
189     }
190   /* Set olsrd binary path */
191   else if(!strncmp(tok_buf, "setb", strlen("setb")))
192     {
193       struct stat sbuf;
194
195       args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
196       
197       if(!strlen(tok_buf))
198         goto print_usage;
199
200       if(stat(tok_buf, &sbuf) < 0)
201         {
202           printf("Error setting binary \"%s\": %s\n",
203                  tok_buf, strerror(errno));
204           return -1;
205         }
206
207       if((sbuf.st_mode & S_IFDIR) || !(sbuf.st_mode & S_IXUSR))
208         {
209           printf("Error setting binary \"%s\": Not a regular execuatble file!\n",
210                  tok_buf);
211           return -1;
212         }
213
214       printf("New olsrd binary path:\"%s\"\n", tok_buf);
215       ohs_set_olsrd_path(tok_buf);
216
217       return 1;
218
219     }
220   /* Set arguments */
221   else if(!strncmp(tok_buf, "seta", strlen("seta")))
222     {
223         printf("Error - NOT IMPLEMENTED YET\n");
224         return 1;
225     }
226   /* Show settings */
227   else if(!strncmp(tok_buf, "show", strlen("show")))
228     {
229       printf("olsrd command settings:\n\tBinary path: %s\n\tArguments  : \n",
230              olsrd_path);
231       return 1;
232     }
233
234  print_usage:
235   printf("Usage: olsrd [start|stop|show|setb|seta] [IP|path|args]\n");
236   return 0;
237 }
238 #endif
239
240 int
241 ohs_cmd_link(const char *args)
242 {
243   olsr_u8_t bi = 0, wildc_src = 0, wildc_dst = 0;
244   struct ohs_connection *src, *dst;
245   struct in_addr iaddr;
246   int qual;
247   struct ohs_ip_link *link, *inv_link;
248
249   args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
250
251   if (!strlen(tok_buf)) {
252     goto print_usage;
253   }
254   if(!strncmp(tok_buf, "bi", strlen("bi"))) {
255     bi = 1;
256     args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
257
258     if (!strlen(tok_buf)) {
259       goto print_usage;
260     }
261   }
262
263   if(tok_buf[0] == '*') {
264     wildc_src = 1;
265     src = ohs_conns;
266   } else {
267     if (!inet_aton(tok_buf, &iaddr)) {
268       printf("Invalid src IP %s\n", tok_buf);
269       return -1;
270     }
271
272     src = get_client_by_addr((union olsr_ip_addr *)&iaddr.s_addr);
273
274     if (!src) {
275         printf("No such client: %s!\n", tok_buf);
276         return -1;
277     }
278   }
279
280   args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
281   
282   if (!strlen(tok_buf)) {
283     goto print_usage;
284   }
285
286   if(tok_buf[0] == '*') {
287     wildc_dst = 1;
288     dst = ohs_conns;
289   } else {
290     if(!inet_aton(tok_buf, &iaddr)) {
291       printf("Invalid src IP %s\n", tok_buf);
292       return -1;
293     }
294       
295     dst = get_client_by_addr((union olsr_ip_addr *)&iaddr.s_addr);
296     if (!dst) {
297       printf("No such client: %s!\n", tok_buf);
298       return -1;
299     }
300   }
301
302   args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
303   
304   if (!strlen(tok_buf)) {
305     goto print_usage;
306   }
307
308   /* No use for bi if both src and dst are widcards */
309   if (wildc_src && wildc_dst) {
310     bi = 0;
311   }
312
313   qual = atoi(tok_buf);
314
315   if(qual < 0 || qual > 100) {
316     printf("Link quality out of range(0-100)\n");
317     return -1;
318   }
319
320   while (src) {
321     while (dst) {
322       struct ipaddr_str srcaddrstr, dstaddrstr;
323
324       if(src != dst) {
325         link = get_link(src, &dst->ip_addr);
326         inv_link = bi ? get_link(dst, &src->ip_addr) : NULL;
327         if(qual == 100)  {
328           /* Remove link entry */
329           if (link) {
330             remove_link(src, link);
331           }
332           if (inv_link) {
333             remove_link(dst, inv_link);
334           }
335         } else  {
336           if (!link) {
337             /* Create new link */
338             link = add_link(src, dst);
339           }
340               
341           link->quality = qual;
342               
343           if (bi) {
344             if(!inv_link) {
345               /* Create new link */
346               inv_link = add_link(dst, src);
347             }
348             inv_link->quality = qual;
349           }
350         }
351         printf("%s %sdirectional link(s) %s %c=> %s quality %d\n", 
352                (qual == 100) ? "Removing" : "Setting",
353                bi ? "bi" : "uni",
354                olsr_ip_to_string(&srcaddrstr, &src->ip_addr),
355                bi ? '<' : '=', 
356                olsr_ip_to_string(&dstaddrstr, &dst->ip_addr),
357                qual);
358       }
359       if (wildc_dst) {
360             dst = dst->next;
361       } else {
362             break;
363       }
364     }
365     dst = wildc_dst ? ohs_conns : dst;
366     src = wildc_src ? src->next : NULL;
367   }
368
369   return 1;
370  print_usage:
371   printf("link <bi> srcIP dstIP [0-100]");
372   return -1;
373 }
374
375 int
376 ohs_cmd_list(const char *args)
377 {
378   struct ohs_connection *oc = ohs_conns;
379
380   args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
381   
382   if(!strlen(tok_buf) || 
383      !strncmp(tok_buf, "clients", strlen("clients"))) {
384     printf("All connected clients:\n");
385       
386     while(oc) {
387       struct ipaddr_str addrstr;
388       printf("\t%s - Rx: %d Tx: %d LinkCnt: %d\n",
389              olsr_ip_to_string(&addrstr, &oc->ip_addr), 
390              oc->rx,
391              oc->tx,
392              oc->linkcnt);
393       oc = oc->next;
394     }
395   }
396   else if(!strncmp(tok_buf, "links", strlen("links"))) {
397     printf("All configured links:\n");
398     while (oc) {
399       struct ohs_ip_link *links = oc->links;
400       while (links) {
401           struct ipaddr_str addrstr, dststr;
402         printf("\t%s => %s Quality: %d\n", 
403                olsr_ip_to_string(&addrstr, &oc->ip_addr),
404                olsr_ip_to_string(&dststr, &links->dst),
405                links->quality);
406
407         links = links->next;
408       }
409       oc = oc->next;
410     }
411   } else {
412     printf("list [clients|links]");
413     return -1;
414   }
415   return 1;
416 }
417
418 int
419 ohs_cmd_help(const char *args)
420 {
421   int i;
422
423   args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
424   
425   if(!strlen(tok_buf))
426     {
427       printf("Olsrd host switch version %s\n", OHS_VERSION);
428       printf("Available commands:\n");
429       
430       for(i = 0; ohs_commands[i].cmd; i++)
431         {
432           if(ohs_commands[i].helptext_brief)
433             printf("\t%s - %s\n", 
434                    ohs_commands[i].cmd,
435                    ohs_commands[i].helptext_brief);
436         }
437       printf("\nType 'help cmd' for help on a specific command\n");
438     }
439   else
440     {
441       for(i = 0; ohs_commands[i].cmd; i++)
442         {
443           if(!strncmp(tok_buf, ohs_commands[i].cmd, strlen(ohs_commands[i].cmd)))
444             {
445               printf("Usage: %s\nDescription:\n%s\n", 
446                      ohs_commands[i].syntax,
447                      ohs_commands[i].helptext_long);
448               return 1;
449             }
450         }
451
452       printf("Usage: help <command>\n");
453     }
454
455   return i;
456 }
457
458 int
459 ohs_cmd_log(const char *args)
460 {
461   olsr_u8_t set = 0;
462
463   args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
464   
465   if(strlen(tok_buf) &&
466      ((set = !strncmp(tok_buf, "set", strlen("set"))) || 
467       !strncmp(tok_buf, "unset", strlen("unset"))))
468     {
469         olsr_u32_t new_bit = 0;
470         
471         args += get_next_token(args, tok_buf, TOK_BUF_SIZE);
472   
473         if(!strlen(tok_buf))
474             goto print_usage;
475         
476         
477         if(!strncmp(tok_buf, "CON", strlen("CON")))
478             new_bit = LOG_CONNECT;
479         else if(!strncmp(tok_buf, "FOR", strlen("FOR")))
480             new_bit = LOG_FORWARD;
481         else if(!strncmp(tok_buf, "LIN", strlen("LIN")))
482             new_bit = LOG_LINK;
483           
484         if(!new_bit)
485             goto print_usage;
486
487         if(set)
488             logbits |= new_bit;
489         else
490             logbits &= ~new_bit;
491
492         printf("%s log bit: 0x%08x, new log: 0x%08x\n", set ? "Setting" : "Removing",
493                new_bit, logbits);
494
495     }
496   else
497     {
498       if(strlen(tok_buf))
499         goto print_usage;
500
501       printf("Log: (0x%08x) ", logbits);
502       if(logbits & LOG_CONNECT)
503         printf("CONNECT ");
504       if(logbits & LOG_FORWARD)
505         printf("FORWARD ");
506       if(logbits & LOG_LINK)
507         printf("LINK ");
508
509       printf("\n");
510     }
511   return 1;
512
513  print_usage:
514   printf("Usage: log <[set|unset] [CONNECT|FORWARD|LINK]>\n");
515   return 0;
516
517 }
518
519 int
520 ohs_cmd_exit(const char *args __attribute__((unused)))
521 {
522
523   printf("Exitting... bye-bye!\n");
524
525   ohs_close(0);
526 }
527
528 void
529 ohs_parse_command(void)
530 {
531   static char cmd_line[500];
532   static int cmd_len = 0;
533   char *args;
534   char cmd_token[20];
535   int i;
536 #if defined WIN32
537   char c;
538   unsigned long Read;
539   INPUT_RECORD InRec;
540   KEY_EVENT_RECORD *KeyEventRec;
541 #endif
542
543 #if defined WIN32
544   if (!ReadConsoleInput(GetStdHandle(STD_INPUT_HANDLE), &InRec, sizeof (InRec), &Read))
545   {
546     fprintf(stderr, "ReadConsoleInput failed: %s\n", strerror(GetLastError()));
547     return;
548   }
549
550   if (InRec.EventType != KEY_EVENT)
551     return;
552
553   KeyEventRec = &InRec.Event.KeyEvent;
554
555   if (!KeyEventRec->bKeyDown)
556     return;
557
558   c = KeyEventRec->uChar.AsciiChar;
559
560   if (c == 8)
561   {
562     if (cmd_len == 0)
563       return;
564
565     cmd_len--;
566
567     fputc(8, stdout);
568     fputc(32, stdout);
569     fputc(8, stdout);
570
571     fflush(stdout);
572
573     return;
574   }
575
576   fputc(c, stdout);
577   fflush(stdout);
578
579   if (c != '\n' && c != '\r' && cmd_len < (int)sizeof (cmd_line) - 1)
580     cmd_line[cmd_len++] = (char)c;
581
582   else
583 #else
584   if(fgets(cmd_line, sizeof (cmd_line), stdin) == NULL) {
585     ohs_cmd_exit(NULL);
586   }
587
588   for (cmd_len = 0; cmd_line[cmd_len] != 0 && cmd_line[cmd_len] != '\n';
589        cmd_len++);
590 #endif
591
592   {
593     cmd_line[cmd_len] = 0;
594     cmd_len = 0;
595
596     args = cmd_line + get_next_token(cmd_line, cmd_token, sizeof (cmd_token));
597
598     for (i = 0; ohs_commands[i].cmd != NULL; i++)
599     {
600       if (strcmp(cmd_token, ohs_commands[i].cmd) == 0)
601       {
602         if(ohs_commands[i].cmd_cb != NULL)
603           ohs_commands[i].cmd_cb(args);
604
605         else
606           printf("No action registered on cmd %s!\n", cmd_token);
607
608         break;
609       }
610     }
611   
612     if(ohs_commands[i].cmd == NULL)
613       printf("%s: no such cmd!\n", cmd_token);
614
615     printf("\n> ");
616     fflush(stdout);
617   }
618 }