nsz Git - musl/blob - src/misc/ioctl.c

   1 #include <sys/ioctl.h>
   2 #include <stdarg.h>
   3 #include <errno.h>
   4 #include <time.h>
   5 #include <sys/time.h>
   6 #include <stddef.h>
   7 #include <string.h>
   8 #include "syscall.h"
   9
  10 #define alignof(t) offsetof(struct { char c; t x; }, x)
  11
  12 #define W 1
  13 #define R 2
  14 #define WR 3
  15
  16 struct ioctl_compat_map {
  17         int new_req, old_req, old_size;
  18         char dir, force_align;
  19         int offsets[4];
  20 };
  21
  22 static const struct ioctl_compat_map compat_map[] = {
  23         { SIOCGSTAMP, SIOCGSTAMP_OLD, 8, R, 0, { 0, -1, -1, -1 } },
  24         { SIOCGSTAMPNS, SIOCGSTAMPNS_OLD, 8, R, 0, { 0, -1, -1, -1 } },
  25 };
  26
  27 static void convert_ioctl_struct(const struct ioctl_compat_map *map, char *old, char *new, int dir)
  28 {
  29         int new_offset = 0;
  30         int old_offset = 0;
  31         int old_size = map->old_size;
  32         if (!(dir & map->dir)) return;
  33         for (int i=0; i < sizeof map->offsets / sizeof *map->offsets; i++) {
  34                 int ts_offset = map->offsets[i];
  35                 if (ts_offset < 0) break;
  36                 int len = ts_offset-old_offset;
  37                 if (dir==W) memcpy(old+old_offset, new+new_offset, len);
  38                 else memcpy(new+new_offset, old+old_offset, len);
  39                 new_offset += len;
  40                 old_offset += len;
  41                 long long new_ts[2];
  42                 long old_ts[2];
  43                 int align = map->force_align ? sizeof(time_t) : alignof(time_t);
  44                 new_offset += (align-1) & -new_offset;
  45                 if (dir==W) {
  46                         memcpy(new_ts, new+new_offset, sizeof new_ts);
  47                         old_ts[0] = new_ts[0];
  48                         old_ts[1] = new_ts[1];
  49                         memcpy(old+old_offset, old_ts, sizeof old_ts);
  50                 } else {
  51                         memcpy(old_ts, old+old_offset, sizeof old_ts);
  52                         new_ts[0] = old_ts[0];
  53                         new_ts[1] = old_ts[1];
  54                         memcpy(new+new_offset, new_ts, sizeof new_ts);
  55                 }
  56                 new_offset += sizeof new_ts;
  57                 old_offset += sizeof old_ts;
  58         }
  59         if (dir==W) memcpy(old+old_offset, new+new_offset, old_size-old_offset);
  60         else memcpy(new+new_offset, old+old_offset, old_size-old_offset);
  61 }
  62
  63 int ioctl(int fd, int req, ...)
  64 {
  65         void *arg;
  66         va_list ap;
  67         va_start(ap, req);
  68         arg = va_arg(ap, void *);
  69         va_end(ap);
  70         int r = __syscall(SYS_ioctl, fd, req, arg);
  71         if (r==-ENOTTY) {
  72                 for (int i=0; i<sizeof compat_map/sizeof *compat_map; i++) {
  73                         if (compat_map[i].new_req != req) continue;
  74                         union {
  75                                 long long align;
  76                                 char buf[256];
  77                         } u;
  78                         convert_ioctl_struct(&compat_map[i], u.buf, arg, W);
  79                         r = __syscall(SYS_ioctl, fd, compat_map[i].old_req, u.buf);
  80                         if (r<0) break;
  81                         convert_ioctl_struct(&compat_map[i], u.buf, arg, R);
  82                 }
  83         }
  84         return __syscall_ret(r);
  85 }