dev.c

   1 #include <string.h>
   2 #include <errno.h>
   3 #include <sys/ioctl.h>
   4 #include <sys/types.h>
   5 #include <ifaddrs.h>
   6
   7 #include "dev.h"
   8 #include "str.h"
   9 #include "sock.h"
  10 #include "die.h"
  11 #include "link.h"
  12
  13 int device_ifindex(const char *ifname)
  14 {
  15         int ret, sock, index;
  16         struct ifreq ifr;
  17
  18         if (!strncmp("any", ifname, strlen("any")))
  19                 return 0;
  20
  21         sock = af_socket(AF_INET);
  22
  23         memset(&ifr, 0, sizeof(ifr));
  24         strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
  25
  26         ret = ioctl(sock, SIOCGIFINDEX, &ifr);
  27         if (!ret)
  28                 index = ifr.ifr_ifindex;
  29         else
  30                 index = -1;
  31
  32         close(sock);
  33
  34         return index;
  35 }
  36
  37 static int __device_address6(const char *ifname, struct sockaddr_storage *ss)
  38 {
  39         int ret, family, found = -EINVAL;
  40         struct ifaddrs *ifaddr, *ifa;
  41
  42         ret = getifaddrs(&ifaddr);
  43         if (ret < 0)
  44                 panic("Cannot get device addresses for IPv6!\n");
  45
  46         for (ifa = ifaddr; ifa != NULL; ifa = ifa->ifa_next) {
  47                 family = ifa->ifa_addr->sa_family;
  48                 if (family != AF_INET6)
  49                         continue;
  50                 if (strcmp(ifa->ifa_name, ifname))
  51                         continue;
  52
  53                 memcpy(ss, ifa->ifa_addr, sizeof(*ss));
  54                 found = 0;
  55                 break;
  56         }
  57
  58         freeifaddrs(ifaddr);
  59         return found;
  60 }
  61
  62 int device_address(const char *ifname, int af, struct sockaddr_storage *ss)
  63 {
  64         int ret, sock;
  65         struct ifreq ifr;
  66
  67         if (!ss)
  68                 return -EINVAL;
  69         if (!strncmp("any", ifname, strlen("any")))
  70                 return -EINVAL;
  71         if (af == AF_INET6)
  72                 return __device_address6(ifname, ss);
  73
  74         sock = af_socket(af);
  75
  76         memset(&ifr, 0, sizeof(ifr));
  77         strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
  78
  79         ifr.ifr_addr.sa_family = af;
  80
  81         ret = ioctl(sock, SIOCGIFADDR, &ifr);
  82         if (!ret)
  83                 memcpy(ss, &ifr.ifr_addr, sizeof(ifr.ifr_addr));
  84
  85         close(sock);
  86
  87         return ret;
  88 }
  89
  90 int device_mtu(const char *ifname)
  91 {
  92         int ret, sock, mtu;
  93         struct ifreq ifr;
  94
  95         sock = af_socket(AF_INET);
  96
  97         memset(&ifr, 0, sizeof(ifr));
  98         strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
  99
 100         ret = ioctl(sock, SIOCGIFMTU, &ifr);
 101         if (!ret)
 102                 mtu = ifr.ifr_mtu;
 103         else
 104                 mtu = 0;
 105
 106         close(sock);
 107
 108         return mtu;
 109 }
 110
 111 short device_get_flags(const char *ifname)
 112 {
 113         short flags;
 114         int ret, sock;
 115         struct ifreq ifr;
 116
 117         sock = af_socket(AF_INET);
 118
 119         memset(&ifr, 0, sizeof(ifr));
 120         strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
 121
 122         ret = ioctl(sock, SIOCGIFFLAGS, &ifr);
 123         if (!ret)
 124                 flags = ifr.ifr_flags;
 125         else
 126                 flags = 0;
 127
 128         close(sock);
 129
 130         return flags;
 131 }
 132
 133 void device_set_flags(const char *ifname, const short flags)
 134 {
 135         int ret, sock;
 136         struct ifreq ifr;
 137
 138         sock = af_socket(AF_INET);
 139
 140         memset(&ifr, 0, sizeof(ifr));
 141         strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
 142
 143         ifr.ifr_flags = flags;
 144
 145         ret = ioctl(sock, SIOCSIFFLAGS, &ifr);
 146         if (ret < 0)
 147                 panic("Cannot set NIC flags!\n");
 148
 149         close(sock);
 150 }
 151
 152 int device_up_and_running(char *ifname)
 153 {
 154         if (!ifname)
 155                 return -EINVAL;
 156         if (!strncmp("any", ifname, strlen("any")))
 157                 return 1;
 158
 159         return (device_get_flags(ifname) & (IFF_UP | IFF_RUNNING)) == (IFF_UP | IFF_RUNNING);
 160 }
 161
 162 u32 device_bitrate(const char *ifname)
 163 {
 164         u32 speed_c, speed_w;
 165
 166         speed_c = ethtool_bitrate(ifname);
 167         speed_w = wireless_bitrate(ifname);
 168
 169         return (speed_c == 0 ? speed_w : speed_c);
 170 }