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