lib/ll_addr.c

   1 /*
   2  * ll_addr.c
   3  *
   4  *              This program is free software; you can redistribute it and/or
   5  *              modify it under the terms of the GNU General Public License
   6  *              as published by the Free Software Foundation; either version
   7  *              2 of the License, or (at your option) any later version.
   8  *
   9  * Authors:     Alexey Kuznetsov, <kuznet@ms2.inr.ac.ru>
  10  */
  11
  12 #include <stdio.h>
  13 #include <stdlib.h>
  14 #include <unistd.h>
  15 #include <syslog.h>
  16 #include <fcntl.h>
  17 #include <sys/ioctl.h>
  18 #include <sys/socket.h>
  19 #include <sys/ioctl.h>
  20 #include <netinet/in.h>
  21 #include <arpa/inet.h>
  22 #include <string.h>
  23
  24 #include <linux/netdevice.h>
  25 #include <linux/if_arp.h>
  26 #include <linux/sockios.h>
  27
  28 #include "rt_names.h"
  29 #include "utils.h"
  30
  31
  32 const char *ll_addr_n2a(unsigned char *addr, int alen, int type, char *buf, int blen)
  33 {
  34         int i;
  35         int l;
  36
  37         if (alen == 4 &&
  38             (type == ARPHRD_TUNNEL || type == ARPHRD_SIT || type == ARPHRD_IPGRE)) {
  39                 return inet_ntop(AF_INET, addr, buf, blen);
  40         }
  41         l = 0;
  42         for (i=0; i<alen; i++) {
  43                 if (i==0) {
  44                         snprintf(buf+l, blen, "%02x", addr[i]);
  45                         blen -= 2;
  46                         l += 2;
  47                 } else {
  48                         snprintf(buf+l, blen, ":%02x", addr[i]);
  49                         blen -= 3;
  50                         l += 3;
  51                 }
  52         }
  53         return buf;
  54 }
  55
  56 int ll_addr_a2n(unsigned char *lladdr, int len, char *arg)
  57 {
  58         if (strchr(arg, '.')) {
  59                 inet_prefix pfx;
  60                 if (get_addr_1(&pfx, arg, AF_INET)) {
  61                         fprintf(stderr, "\"%s\" is invalid lladdr.\n", arg);
  62                         return -1;
  63                 }
  64                 if (len < 4)
  65                         return -1;
  66                 memcpy(lladdr, pfx.data, 4);
  67                 return 4;
  68         } else {
  69                 int i;
  70
  71                 for (i=0; i<len; i++) {
  72                         int temp;
  73                         char *cp = strchr(arg, ':');
  74                         if (cp) {
  75                                 *cp = 0;
  76                                 cp++;
  77                         }
  78                         if (sscanf(arg, "%x", &temp) != 1) {
  79                                 fprintf(stderr, "\"%s\" is invalid lladdr.\n", arg);
  80                                 return -1;
  81                         }
  82                         if (temp < 0 || temp > 255) {
  83                                 fprintf(stderr, "\"%s\" is invalid lladdr.\n", arg);
  84                                 return -1;
  85                         }
  86                         lladdr[i] = temp;
  87                         if (!cp)
  88                                 break;
  89                         arg = cp;
  90                 }
  91                 return i+1;
  92         }
  93 }