xutils.c

   1 /*
   2  * netsniff-ng - the packet sniffing beast
   3  * Copyright 2009, 2010 Daniel Borkmann.
   4  * Copyright 2009, 2010 Emmanuel Roullit.
   5  * Subject to the GPL, version 2.
   6  */
   7
   8 #define _GNU_SOURCE
   9 #include <stdio.h>
  10 #include <stdlib.h>
  11 #include <stdint.h>
  12 #include <fcntl.h>
  13 #include <string.h>
  14 #include <unistd.h>
  15 #include <errno.h>
  16 #include <stdarg.h>
  17 #include <ctype.h>
  18 #include <signal.h>
  19 #include <arpa/inet.h>
  20 #include <time.h>
  21 #include <sched.h>
  22 #include <limits.h>
  23 #include <stdbool.h>
  24 #include <netdb.h>
  25 #include <ifaddrs.h>
  26 #include <sys/time.h>
  27 #include <sys/socket.h>
  28 #include <sys/ioctl.h>
  29 #include <sys/mman.h>
  30 #include <sys/resource.h>
  31 #include <sys/epoll.h>
  32 #include <sys/syscall.h>
  33 #include <asm/unistd.h>
  34 #include <linux/if.h>
  35 #include <linux/socket.h>
  36 #include <linux/types.h>
  37 #include <linux/if_ether.h>
  38 #include <linux/if_packet.h>
  39 #include <linux/sockios.h>
  40 #include <netinet/tcp.h>
  41 #include <netinet/udp.h>
  42
  43 #include "die.h"
  44 #include "str.h"
  45 #include "xutils.h"
  46 #include "ring.h"
  47 #include "sock.h"
  48 #include "built_in.h"
  49
  50 void set_epoll_descriptor(int fd_epoll, int action, int fd_toadd, int events)
  51 {
  52         int ret;
  53         struct epoll_event ev;
  54
  55         memset(&ev, 0, sizeof(ev));
  56         ev.events = events;
  57         ev.data.fd = fd_toadd;
  58
  59         ret = epoll_ctl(fd_epoll, action, fd_toadd, &ev);
  60         if (ret < 0)
  61                 panic("Cannot add socket for epoll!\n");
  62 }
  63
  64 int set_epoll_descriptor2(int fd_epoll, int action, int fd_toadd, int events)
  65 {
  66         struct epoll_event ev;
  67
  68         memset(&ev, 0, sizeof(ev));
  69         ev.events = events;
  70         ev.data.fd = fd_toadd;
  71
  72         return epoll_ctl(fd_epoll, action, fd_toadd, &ev);
  73 }
  74
  75 u32 wireless_bitrate(const char *ifname)
  76 {
  77         int sock, ret, rate_in_mbit;
  78         struct iwreq iwr;
  79
  80         sock = af_socket(AF_INET);
  81
  82         memset(&iwr, 0, sizeof(iwr));
  83         strlcpy(iwr.ifr_name, ifname, IFNAMSIZ);
  84
  85         ret = ioctl(sock, SIOCGIWRATE, &iwr);
  86         if (!ret)
  87                 rate_in_mbit = iwr.u.bitrate.value / 1000000;
  88         else
  89                 rate_in_mbit = 0;
  90
  91         close(sock);
  92
  93         return rate_in_mbit;
  94 }
  95
  96 int wireless_sigqual(const char *ifname, struct iw_statistics *stats)
  97 {
  98         int ret, sock;
  99         struct iwreq iwr;
 100
 101         sock = af_socket(AF_INET);
 102
 103         memset(&iwr, 0, sizeof(iwr));
 104         strlcpy(iwr.ifr_name, ifname, IFNAMSIZ);
 105
 106         iwr.u.data.pointer = (caddr_t) stats;
 107         iwr.u.data.length = sizeof(*stats);
 108         iwr.u.data.flags = 1;
 109
 110         ret = ioctl(sock, SIOCGIWSTATS, &iwr);
 111
 112         close(sock);
 113
 114         return ret;
 115 }
 116
 117 int wireless_rangemax_sigqual(const char *ifname)
 118 {
 119         int ret, sock, sigqual;
 120         struct iwreq iwr;
 121         struct iw_range iwrange;
 122
 123         sock = af_socket(AF_INET);
 124
 125         memset(&iwrange, 0, sizeof(iwrange));
 126
 127         memset(&iwr, 0, sizeof(iwr));
 128         strlcpy(iwr.ifr_name, ifname, IFNAMSIZ);
 129
 130         iwr.u.data.pointer = (caddr_t) &iwrange;
 131         iwr.u.data.length = sizeof(iwrange);
 132         iwr.u.data.flags = 0;
 133
 134         ret = ioctl(sock, SIOCGIWRANGE, &iwr);
 135         if (!ret)
 136                 sigqual = iwrange.max_qual.qual;
 137         else
 138                 sigqual = 0;
 139
 140         close(sock);
 141
 142         return sigqual;
 143 }
 144
 145 u32 ethtool_bitrate(const char *ifname)
 146 {
 147         int ret, sock, bitrate;
 148         struct ifreq ifr;
 149         struct ethtool_cmd ecmd;
 150
 151         sock = af_socket(AF_INET);
 152
 153         memset(&ecmd, 0, sizeof(ecmd));
 154
 155         memset(&ifr, 0, sizeof(ifr));
 156         strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
 157
 158         ecmd.cmd = ETHTOOL_GSET;
 159         ifr.ifr_data = (char *) &ecmd;
 160
 161         ret = ioctl(sock, SIOCETHTOOL, &ifr);
 162         if (ret) {
 163                 bitrate = 0;
 164                 goto out;
 165         }
 166
 167         switch (ecmd.speed) {
 168         case SPEED_10:
 169         case SPEED_100:
 170         case SPEED_1000:
 171         case SPEED_2500:
 172         case SPEED_10000:
 173                 bitrate = ecmd.speed;
 174                 break;
 175         default:
 176                 bitrate = 0;
 177                 break;
 178         };
 179 out:
 180         close(sock);
 181
 182         return bitrate;
 183 }
 184
 185 int ethtool_link(const char *ifname)
 186 {
 187         int ret, sock;
 188         struct ifreq ifr;
 189         struct ethtool_value ecmd;
 190
 191         sock = af_socket(AF_INET);
 192
 193         memset(&ecmd, 0, sizeof(ecmd));
 194
 195         memset(&ifr, 0, sizeof(ifr));
 196         strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
 197
 198         ecmd.cmd = ETHTOOL_GLINK;
 199         ifr.ifr_data = (char *) &ecmd;
 200
 201         ret = ioctl(sock, SIOCETHTOOL, &ifr);
 202         if (ret)
 203                 ret = -EINVAL;
 204         else
 205                 ret = !!ecmd.data;
 206
 207         close(sock);
 208         return ret;
 209 }
 210
 211 int ethtool_drvinf(const char *ifname, struct ethtool_drvinfo *drvinf)
 212 {
 213         int ret, sock;
 214         struct ifreq ifr;
 215
 216         sock = af_socket(AF_INET);
 217
 218         memset(drvinf, 0, sizeof(*drvinf));
 219
 220         memset(&ifr, 0, sizeof(ifr));
 221         strlcpy(ifr.ifr_name, ifname, IFNAMSIZ);
 222
 223         drvinf->cmd = ETHTOOL_GDRVINFO;
 224         ifr.ifr_data = (char *) drvinf;
 225
 226         ret = ioctl(sock, SIOCETHTOOL, &ifr);
 227
 228         close(sock);
 229
 230         return ret;
 231 }
 232
 233 void register_signal(int signal, void (*handler)(int))
 234 {
 235         sigset_t block_mask;
 236         struct sigaction saction;
 237
 238         sigfillset(&block_mask);
 239
 240         saction.sa_handler = handler;
 241         saction.sa_mask = block_mask;
 242         saction.sa_flags = SA_RESTART;
 243
 244         sigaction(signal, &saction, NULL);
 245 }
 246
 247 void register_signal_f(int signal, void (*handler)(int), int flags)
 248 {
 249         sigset_t block_mask;
 250         struct sigaction saction;
 251
 252         sigfillset(&block_mask);
 253
 254         saction.sa_handler = handler;
 255         saction.sa_mask = block_mask;
 256         saction.sa_flags = flags;
 257
 258         sigaction(signal, &saction, NULL);
 259 }
 260
 261 void set_itimer_interval_value(struct itimerval *itimer, unsigned long sec,
 262                                unsigned long usec)
 263 {
 264         itimer->it_interval.tv_sec = sec;
 265         itimer->it_interval.tv_usec = usec;
 266
 267         itimer->it_value.tv_sec = sec;
 268         itimer->it_value.tv_usec = usec;
 269 }