drivers/media/v4l2-core/v4l2-compat-ioctl32.c

   1 /*
   2  * ioctl32.c: Conversion between 32bit and 64bit native ioctls.
   3  *      Separated from fs stuff by Arnd Bergmann <arnd@arndb.de>
   4  *
   5  * Copyright (C) 1997-2000  Jakub Jelinek  (jakub@redhat.com)
   6  * Copyright (C) 1998  Eddie C. Dost  (ecd@skynet.be)
   7  * Copyright (C) 2001,2002  Andi Kleen, SuSE Labs
   8  * Copyright (C) 2003       Pavel Machek (pavel@ucw.cz)
   9  * Copyright (C) 2005       Philippe De Muyter (phdm@macqel.be)
  10  * Copyright (C) 2008       Hans Verkuil <hverkuil@xs4all.nl>
  11  *
  12  * These routines maintain argument size conversion between 32bit and 64bit
  13  * ioctls.
  14  */
  15
  16 #include <linux/compat.h>
  17 #include <linux/module.h>
  18 #include <linux/videodev2.h>
  19 #include <linux/v4l2-subdev.h>
  20 #include <media/v4l2-dev.h>
  21 #include <media/v4l2-ioctl.h>
  22
  23 static long native_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
  24 {
  25         long ret = -ENOIOCTLCMD;
  26
  27         if (file->f_op->unlocked_ioctl)
  28                 ret = file->f_op->unlocked_ioctl(file, cmd, arg);
  29
  30         return ret;
  31 }
  32
  33
  34 struct v4l2_clip32 {
  35         struct v4l2_rect        c;
  36         compat_caddr_t          next;
  37 };
  38
  39 struct v4l2_window32 {
  40         struct v4l2_rect        w;
  41         __u32                   field;  /* enum v4l2_field */
  42         __u32                   chromakey;
  43         compat_caddr_t          clips; /* actually struct v4l2_clip32 * */
  44         __u32                   clipcount;
  45         compat_caddr_t          bitmap;
  46 };
  47
  48 static int get_v4l2_window32(struct v4l2_window *kp, struct v4l2_window32 __user *up)
  49 {
  50         if (!access_ok(VERIFY_READ, up, sizeof(struct v4l2_window32)) ||
  51                 copy_from_user(&kp->w, &up->w, sizeof(up->w)) ||
  52                 get_user(kp->field, &up->field) ||
  53                 get_user(kp->chromakey, &up->chromakey) ||
  54                 get_user(kp->clipcount, &up->clipcount))
  55                         return -EFAULT;
  56         if (kp->clipcount > 2048)
  57                 return -EINVAL;
  58         if (kp->clipcount) {
  59                 struct v4l2_clip32 __user *uclips;
  60                 struct v4l2_clip __user *kclips;
  61                 int n = kp->clipcount;
  62                 compat_caddr_t p;
  63
  64                 if (get_user(p, &up->clips))
  65                         return -EFAULT;
  66                 uclips = compat_ptr(p);
  67                 kclips = compat_alloc_user_space(n * sizeof(struct v4l2_clip));
  68                 kp->clips = kclips;
  69                 while (--n >= 0) {
  70                         if (copy_in_user(&kclips->c, &uclips->c, sizeof(uclips->c)))
  71                                 return -EFAULT;
  72                         if (put_user(n ? kclips + 1 : NULL, &kclips->next))
  73                                 return -EFAULT;
  74                         uclips += 1;
  75                         kclips += 1;
  76                 }
  77         } else
  78                 kp->clips = NULL;
  79         return 0;
  80 }
  81
  82 static int put_v4l2_window32(struct v4l2_window *kp, struct v4l2_window32 __user *up)
  83 {
  84         if (copy_to_user(&up->w, &kp->w, sizeof(kp->w)) ||
  85                 put_user(kp->field, &up->field) ||
  86                 put_user(kp->chromakey, &up->chromakey) ||
  87                 put_user(kp->clipcount, &up->clipcount))
  88                         return -EFAULT;
  89         return 0;
  90 }
  91
  92 static inline int get_v4l2_pix_format(struct v4l2_pix_format *kp, struct v4l2_pix_format __user *up)
  93 {
  94         if (copy_from_user(kp, up, sizeof(struct v4l2_pix_format)))
  95                 return -EFAULT;
  96         return 0;
  97 }
  98
  99 static inline int get_v4l2_pix_format_mplane(struct v4l2_pix_format_mplane *kp,
 100                                 struct v4l2_pix_format_mplane __user *up)
 101 {
 102         if (copy_from_user(kp, up, sizeof(struct v4l2_pix_format_mplane)))
 103                 return -EFAULT;
 104         return 0;
 105 }
 106
 107 static inline int put_v4l2_pix_format(struct v4l2_pix_format *kp, struct v4l2_pix_format __user *up)
 108 {
 109         if (copy_to_user(up, kp, sizeof(struct v4l2_pix_format)))
 110                 return -EFAULT;
 111         return 0;
 112 }
 113
 114 static inline int put_v4l2_pix_format_mplane(struct v4l2_pix_format_mplane *kp,
 115                                 struct v4l2_pix_format_mplane __user *up)
 116 {
 117         if (copy_to_user(up, kp, sizeof(struct v4l2_pix_format_mplane)))
 118                 return -EFAULT;
 119         return 0;
 120 }
 121
 122 static inline int get_v4l2_vbi_format(struct v4l2_vbi_format *kp, struct v4l2_vbi_format __user *up)
 123 {
 124         if (copy_from_user(kp, up, sizeof(struct v4l2_vbi_format)))
 125                 return -EFAULT;
 126         return 0;
 127 }
 128
 129 static inline int put_v4l2_vbi_format(struct v4l2_vbi_format *kp, struct v4l2_vbi_format __user *up)
 130 {
 131         if (copy_to_user(up, kp, sizeof(struct v4l2_vbi_format)))
 132                 return -EFAULT;
 133         return 0;
 134 }
 135
 136 static inline int get_v4l2_sliced_vbi_format(struct v4l2_sliced_vbi_format *kp, struct v4l2_sliced_vbi_format __user *up)
 137 {
 138         if (copy_from_user(kp, up, sizeof(struct v4l2_sliced_vbi_format)))
 139                 return -EFAULT;
 140         return 0;
 141 }
 142
 143 static inline int put_v4l2_sliced_vbi_format(struct v4l2_sliced_vbi_format *kp, struct v4l2_sliced_vbi_format __user *up)
 144 {
 145         if (copy_to_user(up, kp, sizeof(struct v4l2_sliced_vbi_format)))
 146                 return -EFAULT;
 147         return 0;
 148 }
 149
 150 static inline int get_v4l2_sdr_format(struct v4l2_sdr_format *kp, struct v4l2_sdr_format __user *up)
 151 {
 152         if (copy_from_user(kp, up, sizeof(struct v4l2_sdr_format)))
 153                 return -EFAULT;
 154         return 0;
 155 }
 156
 157 static inline int put_v4l2_sdr_format(struct v4l2_sdr_format *kp, struct v4l2_sdr_format __user *up)
 158 {
 159         if (copy_to_user(up, kp, sizeof(struct v4l2_sdr_format)))
 160                 return -EFAULT;
 161         return 0;
 162 }
 163
 164 struct v4l2_format32 {
 165         __u32   type;   /* enum v4l2_buf_type */
 166         union {
 167                 struct v4l2_pix_format  pix;
 168                 struct v4l2_pix_format_mplane   pix_mp;
 169                 struct v4l2_window32    win;
 170                 struct v4l2_vbi_format  vbi;
 171                 struct v4l2_sliced_vbi_format   sliced;
 172                 struct v4l2_sdr_format  sdr;
 173                 __u8    raw_data[200];        /* user-defined */
 174         } fmt;
 175 };
 176
 177 /**
 178  * struct v4l2_create_buffers32 - VIDIOC_CREATE_BUFS32 argument
 179  * @index:      on return, index of the first created buffer
 180  * @count:      entry: number of requested buffers,
 181  *              return: number of created buffers
 182  * @memory:     buffer memory type
 183  * @format:     frame format, for which buffers are requested
 184  * @reserved:   future extensions
 185  */
 186 struct v4l2_create_buffers32 {
 187         __u32                   index;
 188         __u32                   count;
 189         __u32                   memory; /* enum v4l2_memory */
 190         struct v4l2_format32    format;
 191         __u32                   reserved[8];
 192 };
 193
 194 static int __get_v4l2_format32(struct v4l2_format *kp, struct v4l2_format32 __user *up)
 195 {
 196         if (get_user(kp->type, &up->type))
 197                 return -EFAULT;
 198
 199         switch (kp->type) {
 200         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 201         case V4L2_BUF_TYPE_VIDEO_OUTPUT:
 202                 return get_v4l2_pix_format(&kp->fmt.pix, &up->fmt.pix);
 203         case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE:
 204         case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE:
 205                 return get_v4l2_pix_format_mplane(&kp->fmt.pix_mp,
 206                                                   &up->fmt.pix_mp);
 207         case V4L2_BUF_TYPE_VIDEO_OVERLAY:
 208         case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
 209                 return get_v4l2_window32(&kp->fmt.win, &up->fmt.win);
 210         case V4L2_BUF_TYPE_VBI_CAPTURE:
 211         case V4L2_BUF_TYPE_VBI_OUTPUT:
 212                 return get_v4l2_vbi_format(&kp->fmt.vbi, &up->fmt.vbi);
 213         case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
 214         case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
 215                 return get_v4l2_sliced_vbi_format(&kp->fmt.sliced, &up->fmt.sliced);
 216         case V4L2_BUF_TYPE_SDR_CAPTURE:
 217         case V4L2_BUF_TYPE_SDR_OUTPUT:
 218                 return get_v4l2_sdr_format(&kp->fmt.sdr, &up->fmt.sdr);
 219         default:
 220                 pr_info("compat_ioctl32: unexpected VIDIOC_FMT type %d\n",
 221                                                                 kp->type);
 222                 return -EINVAL;
 223         }
 224 }
 225
 226 static int get_v4l2_format32(struct v4l2_format *kp, struct v4l2_format32 __user *up)
 227 {
 228         if (!access_ok(VERIFY_READ, up, sizeof(struct v4l2_format32)))
 229                 return -EFAULT;
 230         return __get_v4l2_format32(kp, up);
 231 }
 232
 233 static int get_v4l2_create32(struct v4l2_create_buffers *kp, struct v4l2_create_buffers32 __user *up)
 234 {
 235         if (!access_ok(VERIFY_READ, up, sizeof(struct v4l2_create_buffers32)) ||
 236             copy_from_user(kp, up, offsetof(struct v4l2_create_buffers32, format)))
 237                 return -EFAULT;
 238         return __get_v4l2_format32(&kp->format, &up->format);
 239 }
 240
 241 static int __put_v4l2_format32(struct v4l2_format *kp, struct v4l2_format32 __user *up)
 242 {
 243         if (put_user(kp->type, &up->type))
 244                 return -EFAULT;
 245
 246         switch (kp->type) {
 247         case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 248         case V4L2_BUF_TYPE_VIDEO_OUTPUT:
 249                 return put_v4l2_pix_format(&kp->fmt.pix, &up->fmt.pix);
 250         case V4L2_BUF_TYPE_VIDEO_CAPTURE_MPLANE:
 251         case V4L2_BUF_TYPE_VIDEO_OUTPUT_MPLANE:
 252                 return put_v4l2_pix_format_mplane(&kp->fmt.pix_mp,
 253                                                   &up->fmt.pix_mp);
 254         case V4L2_BUF_TYPE_VIDEO_OVERLAY:
 255         case V4L2_BUF_TYPE_VIDEO_OUTPUT_OVERLAY:
 256                 return put_v4l2_window32(&kp->fmt.win, &up->fmt.win);
 257         case V4L2_BUF_TYPE_VBI_CAPTURE:
 258         case V4L2_BUF_TYPE_VBI_OUTPUT:
 259                 return put_v4l2_vbi_format(&kp->fmt.vbi, &up->fmt.vbi);
 260         case V4L2_BUF_TYPE_SLICED_VBI_CAPTURE:
 261         case V4L2_BUF_TYPE_SLICED_VBI_OUTPUT:
 262                 return put_v4l2_sliced_vbi_format(&kp->fmt.sliced, &up->fmt.sliced);
 263         case V4L2_BUF_TYPE_SDR_CAPTURE:
 264         case V4L2_BUF_TYPE_SDR_OUTPUT:
 265                 return put_v4l2_sdr_format(&kp->fmt.sdr, &up->fmt.sdr);
 266         default:
 267                 pr_info("compat_ioctl32: unexpected VIDIOC_FMT type %d\n",
 268                                                                 kp->type);
 269                 return -EINVAL;
 270         }
 271 }
 272
 273 static int put_v4l2_format32(struct v4l2_format *kp, struct v4l2_format32 __user *up)
 274 {
 275         if (!access_ok(VERIFY_WRITE, up, sizeof(struct v4l2_format32)))
 276                 return -EFAULT;
 277         return __put_v4l2_format32(kp, up);
 278 }
 279
 280 static int put_v4l2_create32(struct v4l2_create_buffers *kp, struct v4l2_create_buffers32 __user *up)
 281 {
 282         if (!access_ok(VERIFY_WRITE, up, sizeof(struct v4l2_create_buffers32)) ||
 283             copy_to_user(up, kp, offsetof(struct v4l2_create_buffers32, format)))
 284                 return -EFAULT;
 285         return __put_v4l2_format32(&kp->format, &up->format);
 286 }
 287
 288 struct v4l2_standard32 {
 289         __u32                index;
 290         compat_u64           id;
 291         __u8                 name[24];
 292         struct v4l2_fract    frameperiod; /* Frames, not fields */
 293         __u32                framelines;
 294         __u32                reserved[4];
 295 };
 296
 297 static int get_v4l2_standard32(struct v4l2_standard *kp, struct v4l2_standard32 __user *up)
 298 {
 299         /* other fields are not set by the user, nor used by the driver */
 300         if (!access_ok(VERIFY_READ, up, sizeof(struct v4l2_standard32)) ||
 301                 get_user(kp->index, &up->index))
 302                 return -EFAULT;
 303         return 0;
 304 }
 305
 306 static int put_v4l2_standard32(struct v4l2_standard *kp, struct v4l2_standard32 __user *up)
 307 {
 308         if (!access_ok(VERIFY_WRITE, up, sizeof(struct v4l2_standard32)) ||
 309                 put_user(kp->index, &up->index) ||
 310                 put_user(kp->id, &up->id) ||
 311                 copy_to_user(up->name, kp->name, 24) ||
 312                 copy_to_user(&up->frameperiod, &kp->frameperiod, sizeof(kp->frameperiod)) ||
 313                 put_user(kp->framelines, &up->framelines) ||
 314                 copy_to_user(up->reserved, kp->reserved, 4 * sizeof(__u32)))
 315                         return -EFAULT;
 316         return 0;
 317 }
 318
 319 struct v4l2_plane32 {
 320         __u32                   bytesused;
 321         __u32                   length;
 322         union {
 323                 __u32           mem_offset;
 324                 compat_long_t   userptr;
 325                 __s32           fd;
 326         } m;
 327         __u32                   data_offset;
 328         __u32                   reserved[11];
 329 };
 330
 331 struct v4l2_buffer32 {
 332         __u32                   index;
 333         __u32                   type;   /* enum v4l2_buf_type */
 334         __u32                   bytesused;
 335         __u32                   flags;
 336         __u32                   field;  /* enum v4l2_field */
 337         struct compat_timeval   timestamp;
 338         struct v4l2_timecode    timecode;
 339         __u32                   sequence;
 340
 341         /* memory location */
 342         __u32                   memory; /* enum v4l2_memory */
 343         union {
 344                 __u32           offset;
 345                 compat_long_t   userptr;
 346                 compat_caddr_t  planes;
 347                 __s32           fd;
 348         } m;
 349         __u32                   length;
 350         __u32                   config_store;
 351         __u32                   reserved;
 352 };
 353
 354 static int get_v4l2_plane32(struct v4l2_plane __user *up, struct v4l2_plane32 __user *up32,
 355                                 enum v4l2_memory memory)
 356 {
 357         void __user *up_pln;
 358         compat_long_t p;
 359
 360         if (copy_in_user(up, up32, 2 * sizeof(__u32)) ||
 361                 copy_in_user(&up->data_offset, &up32->data_offset,
 362                                 sizeof(__u32)))
 363                 return -EFAULT;
 364
 365         if (memory == V4L2_MEMORY_USERPTR) {
 366                 if (get_user(p, &up32->m.userptr))
 367                         return -EFAULT;
 368                 up_pln = compat_ptr(p);
 369                 if (put_user((unsigned long)up_pln, &up->m.userptr))
 370                         return -EFAULT;
 371         } else if (memory == V4L2_MEMORY_DMABUF) {
 372                 if (copy_in_user(&up->m.fd, &up32->m.fd, sizeof(int)))
 373                         return -EFAULT;
 374         } else {
 375                 if (copy_in_user(&up->m.mem_offset, &up32->m.mem_offset,
 376                                         sizeof(__u32)))
 377                         return -EFAULT;
 378         }
 379
 380         return 0;
 381 }
 382
 383 static int put_v4l2_plane32(struct v4l2_plane __user *up, struct v4l2_plane32 __user *up32,
 384                                 enum v4l2_memory memory)
 385 {
 386         if (copy_in_user(up32, up, 2 * sizeof(__u32)) ||
 387                 copy_in_user(&up32->data_offset, &up->data_offset,
 388                                 sizeof(__u32)))
 389                 return -EFAULT;
 390
 391         /* For MMAP, driver might've set up the offset, so copy it back.
 392          * USERPTR stays the same (was userspace-provided), so no copying. */
 393         if (memory == V4L2_MEMORY_MMAP)
 394                 if (copy_in_user(&up32->m.mem_offset, &up->m.mem_offset,
 395                                         sizeof(__u32)))
 396                         return -EFAULT;
 397         /* For DMABUF, driver might've set up the fd, so copy it back. */
 398         if (memory == V4L2_MEMORY_DMABUF)
 399                 if (copy_in_user(&up32->m.fd, &up->m.fd,
 400                                         sizeof(int)))
 401                         return -EFAULT;
 402
 403         return 0;
 404 }
 405
 406 static int get_v4l2_buffer32(struct v4l2_buffer *kp, struct v4l2_buffer32 __user *up)
 407 {
 408         struct v4l2_plane32 __user *uplane32;
 409         struct v4l2_plane __user *uplane;
 410         compat_caddr_t p;
 411         int num_planes;
 412         int ret;
 413
 414         if (!access_ok(VERIFY_READ, up, sizeof(struct v4l2_buffer32)) ||
 415                 get_user(kp->index, &up->index) ||
 416                 get_user(kp->type, &up->type) ||
 417                 get_user(kp->flags, &up->flags) ||
 418                 get_user(kp->memory, &up->memory) ||
 419                 get_user(kp->length, &up->length))
 420                         return -EFAULT;
 421
 422         if (V4L2_TYPE_IS_OUTPUT(kp->type))
 423                 if (get_user(kp->bytesused, &up->bytesused) ||
 424                         get_user(kp->field, &up->field) ||
 425                         get_user(kp->timestamp.tv_sec, &up->timestamp.tv_sec) ||
 426                         get_user(kp->timestamp.tv_usec,
 427                                         &up->timestamp.tv_usec))
 428                         return -EFAULT;
 429
 430         if (V4L2_TYPE_IS_MULTIPLANAR(kp->type)) {
 431                 num_planes = kp->length;
 432                 if (num_planes == 0) {
 433                         kp->m.planes = NULL;
 434                         /* num_planes == 0 is legal, e.g. when userspace doesn't
 435                          * need planes array on DQBUF*/
 436                         return 0;
 437                 }
 438
 439                 if (get_user(p, &up->m.planes))
 440                         return -EFAULT;
 441
 442                 uplane32 = compat_ptr(p);
 443                 if (!access_ok(VERIFY_READ, uplane32,
 444                                 num_planes * sizeof(struct v4l2_plane32)))
 445                         return -EFAULT;
 446
 447                 /* We don't really care if userspace decides to kill itself
 448                  * by passing a very big num_planes value */
 449                 uplane = compat_alloc_user_space(num_planes *
 450                                                 sizeof(struct v4l2_plane));
 451                 kp->m.planes = (__force struct v4l2_plane *)uplane;
 452
 453                 while (--num_planes >= 0) {
 454                         ret = get_v4l2_plane32(uplane, uplane32, kp->memory);
 455                         if (ret)
 456                                 return ret;
 457                         ++uplane;
 458                         ++uplane32;
 459                 }
 460         } else {
 461                 switch (kp->memory) {
 462                 case V4L2_MEMORY_MMAP:
 463                         if (get_user(kp->m.offset, &up->m.offset))
 464                                 return -EFAULT;
 465                         break;
 466                 case V4L2_MEMORY_USERPTR:
 467                         {
 468                         compat_long_t tmp;
 469
 470                         if (get_user(tmp, &up->m.userptr))
 471                                 return -EFAULT;
 472
 473                         kp->m.userptr = (unsigned long)compat_ptr(tmp);
 474                         }
 475                         break;
 476                 case V4L2_MEMORY_OVERLAY:
 477                         if (get_user(kp->m.offset, &up->m.offset))
 478                                 return -EFAULT;
 479                         break;
 480                 case V4L2_MEMORY_DMABUF:
 481                         if (get_user(kp->m.fd, &up->m.fd))
 482                                 return -EFAULT;
 483                         break;
 484                 }
 485         }
 486
 487         return 0;
 488 }
 489
 490 static int put_v4l2_buffer32(struct v4l2_buffer *kp, struct v4l2_buffer32 __user *up)
 491 {
 492         struct v4l2_plane32 __user *uplane32;
 493         struct v4l2_plane __user *uplane;
 494         compat_caddr_t p;
 495         int num_planes;
 496         int ret;
 497
 498         if (!access_ok(VERIFY_WRITE, up, sizeof(struct v4l2_buffer32)) ||
 499                 put_user(kp->index, &up->index) ||
 500                 put_user(kp->type, &up->type) ||
 501                 put_user(kp->flags, &up->flags) ||
 502                 put_user(kp->memory, &up->memory))
 503                         return -EFAULT;
 504
 505         if (put_user(kp->bytesused, &up->bytesused) ||
 506                 put_user(kp->field, &up->field) ||
 507                 put_user(kp->timestamp.tv_sec, &up->timestamp.tv_sec) ||
 508                 put_user(kp->timestamp.tv_usec, &up->timestamp.tv_usec) ||
 509                 copy_to_user(&up->timecode, &kp->timecode, sizeof(struct v4l2_timecode)) ||
 510                 put_user(kp->sequence, &up->sequence) ||
 511                 put_user(kp->config_store, &up->config_store) ||
 512                 put_user(kp->reserved, &up->reserved) ||
 513                 put_user(kp->length, &up->length))
 514                         return -EFAULT;
 515
 516         if (V4L2_TYPE_IS_MULTIPLANAR(kp->type)) {
 517                 num_planes = kp->length;
 518                 if (num_planes == 0)
 519                         return 0;
 520
 521                 uplane = (__force struct v4l2_plane __user *)kp->m.planes;
 522                 if (get_user(p, &up->m.planes))
 523                         return -EFAULT;
 524                 uplane32 = compat_ptr(p);
 525
 526                 while (--num_planes >= 0) {
 527                         ret = put_v4l2_plane32(uplane, uplane32, kp->memory);
 528                         if (ret)
 529                                 return ret;
 530                         ++uplane;
 531                         ++uplane32;
 532                 }
 533         } else {
 534                 switch (kp->memory) {
 535                 case V4L2_MEMORY_MMAP:
 536                         if (put_user(kp->m.offset, &up->m.offset))
 537                                 return -EFAULT;
 538                         break;
 539                 case V4L2_MEMORY_USERPTR:
 540                         if (put_user(kp->m.userptr, &up->m.userptr))
 541                                 return -EFAULT;
 542                         break;
 543                 case V4L2_MEMORY_OVERLAY:
 544                         if (put_user(kp->m.offset, &up->m.offset))
 545                                 return -EFAULT;
 546                         break;
 547                 case V4L2_MEMORY_DMABUF:
 548                         if (put_user(kp->m.fd, &up->m.fd))
 549                                 return -EFAULT;
 550                         break;
 551                 }
 552         }
 553
 554         return 0;
 555 }
 556
 557 struct v4l2_framebuffer32 {
 558         __u32                   capability;
 559         __u32                   flags;
 560         compat_caddr_t          base;
 561         struct {
 562                 __u32           width;
 563                 __u32           height;
 564                 __u32           pixelformat;
 565                 __u32           field;
 566                 __u32           bytesperline;
 567                 __u32           sizeimage;
 568                 __u32           colorspace;
 569                 __u32           priv;
 570         } fmt;
 571 };
 572
 573 static int get_v4l2_framebuffer32(struct v4l2_framebuffer *kp, struct v4l2_framebuffer32 __user *up)
 574 {
 575         u32 tmp;
 576
 577         if (!access_ok(VERIFY_READ, up, sizeof(struct v4l2_framebuffer32)) ||
 578                 get_user(tmp, &up->base) ||
 579                 get_user(kp->capability, &up->capability) ||
 580                 get_user(kp->flags, &up->flags) ||
 581                 copy_from_user(&kp->fmt, &up->fmt, sizeof(up->fmt)))
 582                         return -EFAULT;
 583         kp->base = (__force void *)compat_ptr(tmp);
 584         return 0;
 585 }
 586
 587 static int put_v4l2_framebuffer32(struct v4l2_framebuffer *kp, struct v4l2_framebuffer32 __user *up)
 588 {
 589         u32 tmp = (u32)((unsigned long)kp->base);
 590
 591         if (!access_ok(VERIFY_WRITE, up, sizeof(struct v4l2_framebuffer32)) ||
 592                 put_user(tmp, &up->base) ||
 593                 put_user(kp->capability, &up->capability) ||
 594                 put_user(kp->flags, &up->flags) ||
 595                 copy_to_user(&up->fmt, &kp->fmt, sizeof(up->fmt)))
 596                         return -EFAULT;
 597         return 0;
 598 }
 599
 600 struct v4l2_input32 {
 601         __u32        index;             /*  Which input */
 602         __u8         name[32];          /*  Label */
 603         __u32        type;              /*  Type of input */
 604         __u32        audioset;          /*  Associated audios (bitfield) */
 605         __u32        tuner;             /*  Associated tuner */
 606         compat_u64   std;
 607         __u32        status;
 608         __u32        reserved[4];
 609 };
 610
 611 /* The 64-bit v4l2_input struct has extra padding at the end of the struct.
 612    Otherwise it is identical to the 32-bit version. */
 613 static inline int get_v4l2_input32(struct v4l2_input *kp, struct v4l2_input32 __user *up)
 614 {
 615         if (copy_from_user(kp, up, sizeof(struct v4l2_input32)))
 616                 return -EFAULT;
 617         return 0;
 618 }
 619
 620 static inline int put_v4l2_input32(struct v4l2_input *kp, struct v4l2_input32 __user *up)
 621 {
 622         if (copy_to_user(up, kp, sizeof(struct v4l2_input32)))
 623                 return -EFAULT;
 624         return 0;
 625 }
 626
 627 struct v4l2_ext_controls32 {
 628         __u32 which;
 629         __u32 count;
 630         __u32 error_idx;
 631         __u32 reserved[2];
 632         compat_caddr_t controls; /* actually struct v4l2_ext_control32 * */
 633 };
 634
 635 struct v4l2_ext_control32 {
 636         __u32 id;
 637         __u32 size;
 638         __u32 reserved2[1];
 639         union {
 640                 __s32 value;
 641                 __s64 value64;
 642                 compat_caddr_t string; /* actually char * */
 643         };
 644 } __attribute__ ((packed));
 645
 646 /* The following function really belong in v4l2-common, but that causes
 647    a circular dependency between modules. We need to think about this, but
 648    for now this will do. */
 649
 650 /* Return non-zero if this control is a pointer type. Currently only
 651    type STRING is a pointer type. */
 652 static inline int ctrl_is_pointer(u32 id)
 653 {
 654         switch (id) {
 655         case V4L2_CID_RDS_TX_PS_NAME:
 656         case V4L2_CID_RDS_TX_RADIO_TEXT:
 657                 return 1;
 658         default:
 659                 return 0;
 660         }
 661 }
 662
 663 static int get_v4l2_ext_controls32(struct v4l2_ext_controls *kp, struct v4l2_ext_controls32 __user *up)
 664 {
 665         struct v4l2_ext_control32 __user *ucontrols;
 666         struct v4l2_ext_control __user *kcontrols;
 667         int n;
 668         compat_caddr_t p;
 669
 670         if (!access_ok(VERIFY_READ, up, sizeof(struct v4l2_ext_controls32)) ||
 671                 get_user(kp->which, &up->which) ||
 672                 get_user(kp->count, &up->count) ||
 673                 get_user(kp->error_idx, &up->error_idx) ||
 674                 copy_from_user(kp->reserved, up->reserved,
 675                                sizeof(kp->reserved)))
 676                         return -EFAULT;
 677         n = kp->count;
 678         if (n == 0) {
 679                 kp->controls = NULL;
 680                 return 0;
 681         }
 682         if (get_user(p, &up->controls))
 683                 return -EFAULT;
 684         ucontrols = compat_ptr(p);
 685         if (!access_ok(VERIFY_READ, ucontrols,
 686                         n * sizeof(struct v4l2_ext_control32)))
 687                 return -EFAULT;
 688         kcontrols = compat_alloc_user_space(n * sizeof(struct v4l2_ext_control));
 689         kp->controls = (__force struct v4l2_ext_control *)kcontrols;
 690         while (--n >= 0) {
 691                 u32 id;
 692
 693                 if (copy_in_user(kcontrols, ucontrols, sizeof(*ucontrols)))
 694                         return -EFAULT;
 695                 if (get_user(id, &kcontrols->id))
 696                         return -EFAULT;
 697                 if (ctrl_is_pointer(id)) {
 698                         void __user *s;
 699
 700                         if (get_user(p, &ucontrols->string))
 701                                 return -EFAULT;
 702                         s = compat_ptr(p);
 703                         if (put_user(s, &kcontrols->string))
 704                                 return -EFAULT;
 705                 }
 706                 ucontrols++;
 707                 kcontrols++;
 708         }
 709         return 0;
 710 }
 711
 712 static int put_v4l2_ext_controls32(struct v4l2_ext_controls *kp, struct v4l2_ext_controls32 __user *up)
 713 {
 714         struct v4l2_ext_control32 __user *ucontrols;
 715         struct v4l2_ext_control __user *kcontrols =
 716                 (__force struct v4l2_ext_control __user *)kp->controls;
 717         int n = kp->count;
 718         compat_caddr_t p;
 719
 720         if (!access_ok(VERIFY_WRITE, up, sizeof(struct v4l2_ext_controls32)) ||
 721                 put_user(kp->which, &up->which) ||
 722                 put_user(kp->count, &up->count) ||
 723                 put_user(kp->error_idx, &up->error_idx) ||
 724                 copy_to_user(up->reserved, kp->reserved, sizeof(up->reserved)))
 725                         return -EFAULT;
 726         if (!kp->count)
 727                 return 0;
 728
 729         if (get_user(p, &up->controls))
 730                 return -EFAULT;
 731         ucontrols = compat_ptr(p);
 732         if (!access_ok(VERIFY_WRITE, ucontrols,
 733                         n * sizeof(struct v4l2_ext_control32)))
 734                 return -EFAULT;
 735
 736         while (--n >= 0) {
 737                 unsigned size = sizeof(*ucontrols);
 738                 u32 id;
 739
 740                 if (get_user(id, &kcontrols->id))
 741                         return -EFAULT;
 742                 /* Do not modify the pointer when copying a pointer control.
 743                    The contents of the pointer was changed, not the pointer
 744                    itself. */
 745                 if (ctrl_is_pointer(id))
 746                         size -= sizeof(ucontrols->value64);
 747                 if (copy_in_user(ucontrols, kcontrols, size))
 748                         return -EFAULT;
 749                 ucontrols++;
 750                 kcontrols++;
 751         }
 752         return 0;
 753 }
 754
 755 struct v4l2_event32 {
 756         __u32                           type;
 757         union {
 758                 compat_s64              value64;
 759                 __u8                    data[64];
 760         } u;
 761         __u32                           pending;
 762         __u32                           sequence;
 763         struct compat_timespec          timestamp;
 764         __u32                           id;
 765         __u32                           reserved[8];
 766 };
 767
 768 static int put_v4l2_event32(struct v4l2_event *kp, struct v4l2_event32 __user *up)
 769 {
 770         if (!access_ok(VERIFY_WRITE, up, sizeof(struct v4l2_event32)) ||
 771                 put_user(kp->type, &up->type) ||
 772                 copy_to_user(&up->u, &kp->u, sizeof(kp->u)) ||
 773                 put_user(kp->pending, &up->pending) ||
 774                 put_user(kp->sequence, &up->sequence) ||
 775                 compat_put_timespec(&kp->timestamp, &up->timestamp) ||
 776                 put_user(kp->id, &up->id) ||
 777                 copy_to_user(up->reserved, kp->reserved, 8 * sizeof(__u32)))
 778                         return -EFAULT;
 779         return 0;
 780 }
 781
 782 struct v4l2_edid32 {
 783         __u32 pad;
 784         __u32 start_block;
 785         __u32 blocks;
 786         __u32 reserved[5];
 787         compat_caddr_t edid;
 788 };
 789
 790 static int get_v4l2_edid32(struct v4l2_edid *kp, struct v4l2_edid32 __user *up)
 791 {
 792         u32 tmp;
 793
 794         if (!access_ok(VERIFY_READ, up, sizeof(struct v4l2_edid32)) ||
 795                 get_user(kp->pad, &up->pad) ||
 796                 get_user(kp->start_block, &up->start_block) ||
 797                 get_user(kp->blocks, &up->blocks) ||
 798                 get_user(tmp, &up->edid) ||
 799                 copy_from_user(kp->reserved, up->reserved, sizeof(kp->reserved)))
 800                         return -EFAULT;
 801         kp->edid = (__force u8 *)compat_ptr(tmp);
 802         return 0;
 803 }
 804
 805 static int put_v4l2_edid32(struct v4l2_edid *kp, struct v4l2_edid32 __user *up)
 806 {
 807         u32 tmp = (u32)((unsigned long)kp->edid);
 808
 809         if (!access_ok(VERIFY_WRITE, up, sizeof(struct v4l2_edid32)) ||
 810                 put_user(kp->pad, &up->pad) ||
 811                 put_user(kp->start_block, &up->start_block) ||
 812                 put_user(kp->blocks, &up->blocks) ||
 813                 put_user(tmp, &up->edid) ||
 814                 copy_to_user(up->reserved, kp->reserved, sizeof(up->reserved)))
 815                         return -EFAULT;
 816         return 0;
 817 }
 818
 819
 820 #define VIDIOC_G_FMT32          _IOWR('V',  4, struct v4l2_format32)
 821 #define VIDIOC_S_FMT32          _IOWR('V',  5, struct v4l2_format32)
 822 #define VIDIOC_QUERYBUF32       _IOWR('V',  9, struct v4l2_buffer32)
 823 #define VIDIOC_G_FBUF32         _IOR ('V', 10, struct v4l2_framebuffer32)
 824 #define VIDIOC_S_FBUF32         _IOW ('V', 11, struct v4l2_framebuffer32)
 825 #define VIDIOC_QBUF32           _IOWR('V', 15, struct v4l2_buffer32)
 826 #define VIDIOC_DQBUF32          _IOWR('V', 17, struct v4l2_buffer32)
 827 #define VIDIOC_ENUMSTD32        _IOWR('V', 25, struct v4l2_standard32)
 828 #define VIDIOC_ENUMINPUT32      _IOWR('V', 26, struct v4l2_input32)
 829 #define VIDIOC_G_EDID32         _IOWR('V', 40, struct v4l2_edid32)
 830 #define VIDIOC_S_EDID32         _IOWR('V', 41, struct v4l2_edid32)
 831 #define VIDIOC_TRY_FMT32        _IOWR('V', 64, struct v4l2_format32)
 832 #define VIDIOC_G_EXT_CTRLS32    _IOWR('V', 71, struct v4l2_ext_controls32)
 833 #define VIDIOC_S_EXT_CTRLS32    _IOWR('V', 72, struct v4l2_ext_controls32)
 834 #define VIDIOC_TRY_EXT_CTRLS32  _IOWR('V', 73, struct v4l2_ext_controls32)
 835 #define VIDIOC_DQEVENT32        _IOR ('V', 89, struct v4l2_event32)
 836 #define VIDIOC_CREATE_BUFS32    _IOWR('V', 92, struct v4l2_create_buffers32)
 837 #define VIDIOC_PREPARE_BUF32    _IOWR('V', 93, struct v4l2_buffer32)
 838
 839 #define VIDIOC_OVERLAY32        _IOW ('V', 14, s32)
 840 #define VIDIOC_STREAMON32       _IOW ('V', 18, s32)
 841 #define VIDIOC_STREAMOFF32      _IOW ('V', 19, s32)
 842 #define VIDIOC_G_INPUT32        _IOR ('V', 38, s32)
 843 #define VIDIOC_S_INPUT32        _IOWR('V', 39, s32)
 844 #define VIDIOC_G_OUTPUT32       _IOR ('V', 46, s32)
 845 #define VIDIOC_S_OUTPUT32       _IOWR('V', 47, s32)
 846
 847 static long do_video_ioctl(struct file *file, unsigned int cmd, unsigned long arg)
 848 {
 849         union {
 850                 struct v4l2_format v2f;
 851                 struct v4l2_buffer v2b;
 852                 struct v4l2_framebuffer v2fb;
 853                 struct v4l2_input v2i;
 854                 struct v4l2_standard v2s;
 855                 struct v4l2_ext_controls v2ecs;
 856                 struct v4l2_event v2ev;
 857                 struct v4l2_create_buffers v2crt;
 858                 struct v4l2_edid v2edid;
 859                 unsigned long vx;
 860                 int vi;
 861         } karg;
 862         void __user *up = compat_ptr(arg);
 863         int compatible_arg = 1;
 864         long err = 0;
 865
 866         /* First, convert the command. */
 867         switch (cmd) {
 868         case VIDIOC_G_FMT32: cmd = VIDIOC_G_FMT; break;
 869         case VIDIOC_S_FMT32: cmd = VIDIOC_S_FMT; break;
 870         case VIDIOC_QUERYBUF32: cmd = VIDIOC_QUERYBUF; break;
 871         case VIDIOC_G_FBUF32: cmd = VIDIOC_G_FBUF; break;
 872         case VIDIOC_S_FBUF32: cmd = VIDIOC_S_FBUF; break;
 873         case VIDIOC_QBUF32: cmd = VIDIOC_QBUF; break;
 874         case VIDIOC_DQBUF32: cmd = VIDIOC_DQBUF; break;
 875         case VIDIOC_ENUMSTD32: cmd = VIDIOC_ENUMSTD; break;
 876         case VIDIOC_ENUMINPUT32: cmd = VIDIOC_ENUMINPUT; break;
 877         case VIDIOC_TRY_FMT32: cmd = VIDIOC_TRY_FMT; break;
 878         case VIDIOC_G_EXT_CTRLS32: cmd = VIDIOC_G_EXT_CTRLS; break;
 879         case VIDIOC_S_EXT_CTRLS32: cmd = VIDIOC_S_EXT_CTRLS; break;
 880         case VIDIOC_TRY_EXT_CTRLS32: cmd = VIDIOC_TRY_EXT_CTRLS; break;
 881         case VIDIOC_DQEVENT32: cmd = VIDIOC_DQEVENT; break;
 882         case VIDIOC_OVERLAY32: cmd = VIDIOC_OVERLAY; break;
 883         case VIDIOC_STREAMON32: cmd = VIDIOC_STREAMON; break;
 884         case VIDIOC_STREAMOFF32: cmd = VIDIOC_STREAMOFF; break;
 885         case VIDIOC_G_INPUT32: cmd = VIDIOC_G_INPUT; break;
 886         case VIDIOC_S_INPUT32: cmd = VIDIOC_S_INPUT; break;
 887         case VIDIOC_G_OUTPUT32: cmd = VIDIOC_G_OUTPUT; break;
 888         case VIDIOC_S_OUTPUT32: cmd = VIDIOC_S_OUTPUT; break;
 889         case VIDIOC_CREATE_BUFS32: cmd = VIDIOC_CREATE_BUFS; break;
 890         case VIDIOC_PREPARE_BUF32: cmd = VIDIOC_PREPARE_BUF; break;
 891         case VIDIOC_G_EDID32: cmd = VIDIOC_G_EDID; break;
 892         case VIDIOC_S_EDID32: cmd = VIDIOC_S_EDID; break;
 893         }
 894
 895         switch (cmd) {
 896         case VIDIOC_OVERLAY:
 897         case VIDIOC_STREAMON:
 898         case VIDIOC_STREAMOFF:
 899         case VIDIOC_S_INPUT:
 900         case VIDIOC_S_OUTPUT:
 901                 err = get_user(karg.vi, (s32 __user *)up);
 902                 compatible_arg = 0;
 903                 break;
 904
 905         case VIDIOC_G_INPUT:
 906         case VIDIOC_G_OUTPUT:
 907                 compatible_arg = 0;
 908                 break;
 909
 910         case VIDIOC_G_EDID:
 911         case VIDIOC_S_EDID:
 912                 err = get_v4l2_edid32(&karg.v2edid, up);
 913                 compatible_arg = 0;
 914                 break;
 915
 916         case VIDIOC_G_FMT:
 917         case VIDIOC_S_FMT:
 918         case VIDIOC_TRY_FMT:
 919                 err = get_v4l2_format32(&karg.v2f, up);
 920                 compatible_arg = 0;
 921                 break;
 922
 923         case VIDIOC_CREATE_BUFS:
 924                 err = get_v4l2_create32(&karg.v2crt, up);
 925                 compatible_arg = 0;
 926                 break;
 927
 928         case VIDIOC_PREPARE_BUF:
 929         case VIDIOC_QUERYBUF:
 930         case VIDIOC_QBUF:
 931         case VIDIOC_DQBUF:
 932                 err = get_v4l2_buffer32(&karg.v2b, up);
 933                 compatible_arg = 0;
 934                 break;
 935
 936         case VIDIOC_S_FBUF:
 937                 err = get_v4l2_framebuffer32(&karg.v2fb, up);
 938                 compatible_arg = 0;
 939                 break;
 940
 941         case VIDIOC_G_FBUF:
 942                 compatible_arg = 0;
 943                 break;
 944
 945         case VIDIOC_ENUMSTD:
 946                 err = get_v4l2_standard32(&karg.v2s, up);
 947                 compatible_arg = 0;
 948                 break;
 949
 950         case VIDIOC_ENUMINPUT:
 951                 err = get_v4l2_input32(&karg.v2i, up);
 952                 compatible_arg = 0;
 953                 break;
 954
 955         case VIDIOC_G_EXT_CTRLS:
 956         case VIDIOC_S_EXT_CTRLS:
 957         case VIDIOC_TRY_EXT_CTRLS:
 958                 err = get_v4l2_ext_controls32(&karg.v2ecs, up);
 959                 compatible_arg = 0;
 960                 break;
 961         case VIDIOC_DQEVENT:
 962                 compatible_arg = 0;
 963                 break;
 964         }
 965         if (err)
 966                 return err;
 967
 968         if (compatible_arg)
 969                 err = native_ioctl(file, cmd, (unsigned long)up);
 970         else {
 971                 mm_segment_t old_fs = get_fs();
 972
 973                 set_fs(KERNEL_DS);
 974                 err = native_ioctl(file, cmd, (unsigned long)&karg);
 975                 set_fs(old_fs);
 976         }
 977
 978         /* Special case: even after an error we need to put the
 979            results back for these ioctls since the error_idx will
 980            contain information on which control failed. */
 981         switch (cmd) {
 982         case VIDIOC_G_EXT_CTRLS:
 983         case VIDIOC_S_EXT_CTRLS:
 984         case VIDIOC_TRY_EXT_CTRLS:
 985                 if (put_v4l2_ext_controls32(&karg.v2ecs, up))
 986                         err = -EFAULT;
 987                 break;
 988         }
 989         if (err)
 990                 return err;
 991
 992         switch (cmd) {
 993         case VIDIOC_S_INPUT:
 994         case VIDIOC_S_OUTPUT:
 995         case VIDIOC_G_INPUT:
 996         case VIDIOC_G_OUTPUT:
 997                 err = put_user(((s32)karg.vi), (s32 __user *)up);
 998                 break;
 999
1000         case VIDIOC_G_FBUF:
1001                 err = put_v4l2_framebuffer32(&karg.v2fb, up);
1002                 break;
1003
1004         case VIDIOC_DQEVENT:
1005                 err = put_v4l2_event32(&karg.v2ev, up);
1006                 break;
1007
1008         case VIDIOC_G_EDID:
1009         case VIDIOC_S_EDID:
1010                 err = put_v4l2_edid32(&karg.v2edid, up);
1011                 break;
1012
1013         case VIDIOC_G_FMT:
1014         case VIDIOC_S_FMT:
1015         case VIDIOC_TRY_FMT:
1016                 err = put_v4l2_format32(&karg.v2f, up);
1017                 break;
1018
1019         case VIDIOC_CREATE_BUFS:
1020                 err = put_v4l2_create32(&karg.v2crt, up);
1021                 break;
1022
1023         case VIDIOC_QUERYBUF:
1024         case VIDIOC_QBUF:
1025         case VIDIOC_DQBUF:
1026                 err = put_v4l2_buffer32(&karg.v2b, up);
1027                 break;
1028
1029         case VIDIOC_ENUMSTD:
1030                 err = put_v4l2_standard32(&karg.v2s, up);
1031                 break;
1032
1033         case VIDIOC_ENUMINPUT:
1034                 err = put_v4l2_input32(&karg.v2i, up);
1035                 break;
1036         }
1037         return err;
1038 }
1039
1040 long v4l2_compat_ioctl32(struct file *file, unsigned int cmd, unsigned long arg)
1041 {
1042         struct video_device *vdev = video_devdata(file);
1043         long ret = -ENOIOCTLCMD;
1044
1045         if (!file->f_op->unlocked_ioctl)
1046                 return ret;
1047
1048         if (_IOC_TYPE(cmd) == 'V' && _IOC_NR(cmd) < BASE_VIDIOC_PRIVATE)
1049                 ret = do_video_ioctl(file, cmd, arg);
1050         else if (vdev->fops->compat_ioctl32)
1051                 ret = vdev->fops->compat_ioctl32(file, cmd, arg);
1052
1053         if (ret == -ENOIOCTLCMD)
1054                 pr_debug("compat_ioctl32: unknown ioctl '%c', dir=%d, #%d (0x%08x)\n",
1055                          _IOC_TYPE(cmd), _IOC_DIR(cmd), _IOC_NR(cmd), cmd);
1056         return ret;
1057 }
1058 EXPORT_SYMBOL_GPL(v4l2_compat_ioctl32);