git.oblomov.eu Git - linux-2.6/blob - drivers/media/video/pvrusb2/pvrusb2-v4l2.c

   1 /*
   2  *
   3  *
   4  *  Copyright (C) 2005 Mike Isely <isely@pobox.com>
   5  *  Copyright (C) 2004 Aurelien Alleaume <slts@free.fr>
   6  *
   7  *  This program is free software; you can redistribute it and/or modify
   8  *  it under the terms of the GNU General Public License as published by
   9  *  the Free Software Foundation; either version 2 of the License
  10  *
  11  *  This program is distributed in the hope that it will be useful,
  12  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14  *  GNU General Public License for more details.
  15  *
  16  *  You should have received a copy of the GNU General Public License
  17  *  along with this program; if not, write to the Free Software
  18  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  19  *
  20  */
  21
  22 #include <linux/kernel.h>
  23 #include <linux/version.h>
  24 #include "pvrusb2-context.h"
  25 #include "pvrusb2-hdw.h"
  26 #include "pvrusb2.h"
  27 #include "pvrusb2-debug.h"
  28 #include "pvrusb2-v4l2.h"
  29 #include "pvrusb2-ioread.h"
  30 #include <linux/videodev2.h>
  31 #include <media/v4l2-dev.h>
  32 #include <media/v4l2-common.h>
  33 #include <media/v4l2-ioctl.h>
  34
  35 struct pvr2_v4l2_dev;
  36 struct pvr2_v4l2_fh;
  37 struct pvr2_v4l2;
  38
  39 struct pvr2_v4l2_dev {
  40         struct video_device devbase; /* MUST be first! */
  41         struct pvr2_v4l2 *v4lp;
  42         struct pvr2_context_stream *stream;
  43         /* Information about this device: */
  44         enum pvr2_config config; /* Expected stream format */
  45         int v4l_type; /* V4L defined type for this device node */
  46         enum pvr2_v4l_type minor_type; /* pvr2-understood minor device type */
  47 };
  48
  49 struct pvr2_v4l2_fh {
  50         struct pvr2_channel channel;
  51         struct pvr2_v4l2_dev *dev_info;
  52         enum v4l2_priority prio;
  53         struct pvr2_ioread *rhp;
  54         struct file *file;
  55         struct pvr2_v4l2 *vhead;
  56         struct pvr2_v4l2_fh *vnext;
  57         struct pvr2_v4l2_fh *vprev;
  58         wait_queue_head_t wait_data;
  59         int fw_mode_flag;
  60         /* Map contiguous ordinal value to input id */
  61         unsigned char *input_map;
  62         unsigned int input_cnt;
  63 };
  64
  65 struct pvr2_v4l2 {
  66         struct pvr2_channel channel;
  67         struct pvr2_v4l2_fh *vfirst;
  68         struct pvr2_v4l2_fh *vlast;
  69
  70         struct v4l2_prio_state prio;
  71
  72         /* streams - Note that these must be separately, individually,
  73          * allocated pointers.  This is because the v4l core is going to
  74          * manage their deletion - separately, individually...  */
  75         struct pvr2_v4l2_dev *dev_video;
  76         struct pvr2_v4l2_dev *dev_radio;
  77 };
  78
  79 static int video_nr[PVR_NUM] = {[0 ... PVR_NUM-1] = -1};
  80 module_param_array(video_nr, int, NULL, 0444);
  81 MODULE_PARM_DESC(video_nr, "Offset for device's video dev minor");
  82 static int radio_nr[PVR_NUM] = {[0 ... PVR_NUM-1] = -1};
  83 module_param_array(radio_nr, int, NULL, 0444);
  84 MODULE_PARM_DESC(radio_nr, "Offset for device's radio dev minor");
  85 static int vbi_nr[PVR_NUM] = {[0 ... PVR_NUM-1] = -1};
  86 module_param_array(vbi_nr, int, NULL, 0444);
  87 MODULE_PARM_DESC(vbi_nr, "Offset for device's vbi dev minor");
  88
  89 static struct v4l2_capability pvr_capability ={
  90         .driver         = "pvrusb2",
  91         .card           = "Hauppauge WinTV pvr-usb2",
  92         .bus_info       = "usb",
  93         .version        = KERNEL_VERSION(0,8,0),
  94         .capabilities   = (V4L2_CAP_VIDEO_CAPTURE | V4L2_CAP_VBI_CAPTURE |
  95                            V4L2_CAP_TUNER | V4L2_CAP_AUDIO | V4L2_CAP_RADIO |
  96                            V4L2_CAP_READWRITE),
  97         .reserved       = {0,0,0,0}
  98 };
  99
 100 static struct v4l2_fmtdesc pvr_fmtdesc [] = {
 101         {
 102                 .index          = 0,
 103                 .type           = V4L2_BUF_TYPE_VIDEO_CAPTURE,
 104                 .flags          = V4L2_FMT_FLAG_COMPRESSED,
 105                 .description    = "MPEG1/2",
 106                 // This should really be V4L2_PIX_FMT_MPEG, but xawtv
 107                 // breaks when I do that.
 108                 .pixelformat    = 0, // V4L2_PIX_FMT_MPEG,
 109                 .reserved       = { 0, 0, 0, 0 }
 110         }
 111 };
 112
 113 #define PVR_FORMAT_PIX  0
 114 #define PVR_FORMAT_VBI  1
 115
 116 static struct v4l2_format pvr_format [] = {
 117         [PVR_FORMAT_PIX] = {
 118                 .type   = V4L2_BUF_TYPE_VIDEO_CAPTURE,
 119                 .fmt    = {
 120                         .pix        = {
 121                                 .width          = 720,
 122                                 .height             = 576,
 123                                 // This should really be V4L2_PIX_FMT_MPEG,
 124                                 // but xawtv breaks when I do that.
 125                                 .pixelformat    = 0, // V4L2_PIX_FMT_MPEG,
 126                                 .field          = V4L2_FIELD_INTERLACED,
 127                                 .bytesperline   = 0,  // doesn't make sense
 128                                                       // here
 129                                 //FIXME : Don't know what to put here...
 130                                 .sizeimage          = (32*1024),
 131                                 .colorspace     = 0, // doesn't make sense here
 132                                 .priv           = 0
 133                         }
 134                 }
 135         },
 136         [PVR_FORMAT_VBI] = {
 137                 .type   = V4L2_BUF_TYPE_VBI_CAPTURE,
 138                 .fmt    = {
 139                         .vbi        = {
 140                                 .sampling_rate = 27000000,
 141                                 .offset = 248,
 142                                 .samples_per_line = 1443,
 143                                 .sample_format = V4L2_PIX_FMT_GREY,
 144                                 .start = { 0, 0 },
 145                                 .count = { 0, 0 },
 146                                 .flags = 0,
 147                                 .reserved = { 0, 0 }
 148                         }
 149                 }
 150         }
 151 };
 152
 153
 154 static const char *get_v4l_name(int v4l_type)
 155 {
 156         switch (v4l_type) {
 157         case VFL_TYPE_GRABBER: return "video";
 158         case VFL_TYPE_RADIO: return "radio";
 159         case VFL_TYPE_VBI: return "vbi";
 160         default: return "?";
 161         }
 162 }
 163
 164
 165 /*
 166  * pvr_ioctl()
 167  *
 168  * This is part of Video 4 Linux API. The procedure handles ioctl() calls.
 169  *
 170  */
 171 static int pvr2_v4l2_do_ioctl(struct file *file, unsigned int cmd, void *arg)
 172 {
 173         struct pvr2_v4l2_fh *fh = file->private_data;
 174         struct pvr2_v4l2 *vp = fh->vhead;
 175         struct pvr2_v4l2_dev *dev_info = fh->dev_info;
 176         struct pvr2_hdw *hdw = fh->channel.mc_head->hdw;
 177         int ret = -EINVAL;
 178
 179         if (pvrusb2_debug & PVR2_TRACE_V4LIOCTL) {
 180                 v4l_print_ioctl(pvr2_hdw_get_driver_name(hdw),cmd);
 181         }
 182
 183         if (!pvr2_hdw_dev_ok(hdw)) {
 184                 pvr2_trace(PVR2_TRACE_ERROR_LEGS,
 185                            "ioctl failed - bad or no context");
 186                 return -EFAULT;
 187         }
 188
 189         /* check priority */
 190         switch (cmd) {
 191         case VIDIOC_S_CTRL:
 192         case VIDIOC_S_STD:
 193         case VIDIOC_S_INPUT:
 194         case VIDIOC_S_TUNER:
 195         case VIDIOC_S_FREQUENCY:
 196                 ret = v4l2_prio_check(&vp->prio, &fh->prio);
 197                 if (ret)
 198                         return ret;
 199         }
 200
 201         switch (cmd) {
 202         case VIDIOC_QUERYCAP:
 203         {
 204                 struct v4l2_capability *cap = arg;
 205
 206                 memcpy(cap, &pvr_capability, sizeof(struct v4l2_capability));
 207                 strlcpy(cap->bus_info,pvr2_hdw_get_bus_info(hdw),
 208                         sizeof(cap->bus_info));
 209                 strlcpy(cap->card,pvr2_hdw_get_desc(hdw),sizeof(cap->card));
 210
 211                 ret = 0;
 212                 break;
 213         }
 214
 215         case VIDIOC_G_PRIORITY:
 216         {
 217                 enum v4l2_priority *p = arg;
 218
 219                 *p = v4l2_prio_max(&vp->prio);
 220                 ret = 0;
 221                 break;
 222         }
 223
 224         case VIDIOC_S_PRIORITY:
 225         {
 226                 enum v4l2_priority *prio = arg;
 227
 228                 ret = v4l2_prio_change(&vp->prio, &fh->prio, *prio);
 229                 break;
 230         }
 231
 232         case VIDIOC_ENUMSTD:
 233         {
 234                 struct v4l2_standard *vs = (struct v4l2_standard *)arg;
 235                 int idx = vs->index;
 236                 ret = pvr2_hdw_get_stdenum_value(hdw,vs,idx+1);
 237                 break;
 238         }
 239
 240         case VIDIOC_G_STD:
 241         {
 242                 int val = 0;
 243                 ret = pvr2_ctrl_get_value(
 244                         pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDCUR),&val);
 245                 *(v4l2_std_id *)arg = val;
 246                 break;
 247         }
 248
 249         case VIDIOC_S_STD:
 250         {
 251                 ret = pvr2_ctrl_set_value(
 252                         pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_STDCUR),
 253                         *(v4l2_std_id *)arg);
 254                 break;
 255         }
 256
 257         case VIDIOC_ENUMINPUT:
 258         {
 259                 struct pvr2_ctrl *cptr;
 260                 struct v4l2_input *vi = (struct v4l2_input *)arg;
 261                 struct v4l2_input tmp;
 262                 unsigned int cnt;
 263                 int val;
 264
 265                 cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_INPUT);
 266
 267                 memset(&tmp,0,sizeof(tmp));
 268                 tmp.index = vi->index;
 269                 ret = 0;
 270                 if ((vi->index < 0) || (vi->index >= fh->input_cnt)) {
 271                         ret = -EINVAL;
 272                         break;
 273                 }
 274                 val = fh->input_map[vi->index];
 275                 switch (val) {
 276                 case PVR2_CVAL_INPUT_TV:
 277                 case PVR2_CVAL_INPUT_DTV:
 278                 case PVR2_CVAL_INPUT_RADIO:
 279                         tmp.type = V4L2_INPUT_TYPE_TUNER;
 280                         break;
 281                 case PVR2_CVAL_INPUT_SVIDEO:
 282                 case PVR2_CVAL_INPUT_COMPOSITE:
 283                         tmp.type = V4L2_INPUT_TYPE_CAMERA;
 284                         break;
 285                 default:
 286                         ret = -EINVAL;
 287                         break;
 288                 }
 289                 if (ret < 0) break;
 290
 291                 cnt = 0;
 292                 pvr2_ctrl_get_valname(cptr,val,
 293                                       tmp.name,sizeof(tmp.name)-1,&cnt);
 294                 tmp.name[cnt] = 0;
 295
 296                 /* Don't bother with audioset, since this driver currently
 297                    always switches the audio whenever the video is
 298                    switched. */
 299
 300                 /* Handling std is a tougher problem.  It doesn't make
 301                    sense in cases where a device might be multi-standard.
 302                    We could just copy out the current value for the
 303                    standard, but it can change over time.  For now just
 304                    leave it zero. */
 305
 306                 memcpy(vi, &tmp, sizeof(tmp));
 307
 308                 ret = 0;
 309                 break;
 310         }
 311
 312         case VIDIOC_G_INPUT:
 313         {
 314                 unsigned int idx;
 315                 struct pvr2_ctrl *cptr;
 316                 struct v4l2_input *vi = (struct v4l2_input *)arg;
 317                 int val;
 318                 cptr = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_INPUT);
 319                 val = 0;
 320                 ret = pvr2_ctrl_get_value(cptr,&val);
 321                 vi->index = 0;
 322                 for (idx = 0; idx < fh->input_cnt; idx++) {
 323                         if (fh->input_map[idx] == val) {
 324                                 vi->index = idx;
 325                                 break;
 326                         }
 327                 }
 328                 break;
 329         }
 330
 331         case VIDIOC_S_INPUT:
 332         {
 333                 struct v4l2_input *vi = (struct v4l2_input *)arg;
 334                 if ((vi->index < 0) || (vi->index >= fh->input_cnt)) {
 335                         ret = -ERANGE;
 336                         break;
 337                 }
 338                 ret = pvr2_ctrl_set_value(
 339                         pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_INPUT),
 340                         fh->input_map[vi->index]);
 341                 break;
 342         }
 343
 344         case VIDIOC_ENUMAUDIO:
 345         {
 346                 /* pkt: FIXME: We are returning one "fake" input here
 347                    which could very well be called "whatever_we_like".
 348                    This is for apps that want to see an audio input
 349                    just to feel comfortable, as well as to test if
 350                    it can do stereo or sth. There is actually no guarantee
 351                    that the actual audio input cannot change behind the app's
 352                    back, but most applications should not mind that either.
 353
 354                    Hopefully, mplayer people will work with us on this (this
 355                    whole mess is to support mplayer pvr://), or Hans will come
 356                    up with a more standard way to say "we have inputs but we
 357                    don 't want you to change them independent of video" which
 358                    will sort this mess.
 359                  */
 360                 struct v4l2_audio *vin = arg;
 361                 ret = -EINVAL;
 362                 if (vin->index > 0) break;
 363                 strncpy(vin->name, "PVRUSB2 Audio",14);
 364                 vin->capability = V4L2_AUDCAP_STEREO;
 365                 ret = 0;
 366                 break;
 367                 break;
 368         }
 369
 370         case VIDIOC_G_AUDIO:
 371         {
 372                 /* pkt: FIXME: see above comment (VIDIOC_ENUMAUDIO) */
 373                 struct v4l2_audio *vin = arg;
 374                 memset(vin,0,sizeof(*vin));
 375                 vin->index = 0;
 376                 strncpy(vin->name, "PVRUSB2 Audio",14);
 377                 vin->capability = V4L2_AUDCAP_STEREO;
 378                 ret = 0;
 379                 break;
 380         }
 381
 382         case VIDIOC_S_AUDIO:
 383         {
 384                 ret = -EINVAL;
 385                 break;
 386         }
 387         case VIDIOC_G_TUNER:
 388         {
 389                 struct v4l2_tuner *vt = (struct v4l2_tuner *)arg;
 390
 391                 if (vt->index != 0) break; /* Only answer for the 1st tuner */
 392
 393                 pvr2_hdw_execute_tuner_poll(hdw);
 394                 ret = pvr2_hdw_get_tuner_status(hdw,vt);
 395                 break;
 396         }
 397
 398         case VIDIOC_S_TUNER:
 399         {
 400                 struct v4l2_tuner *vt=(struct v4l2_tuner *)arg;
 401
 402                 if (vt->index != 0)
 403                         break;
 404
 405                 ret = pvr2_ctrl_set_value(
 406                         pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_AUDIOMODE),
 407                         vt->audmode);
 408                 break;
 409         }
 410
 411         case VIDIOC_S_FREQUENCY:
 412         {
 413                 const struct v4l2_frequency *vf = (struct v4l2_frequency *)arg;
 414                 unsigned long fv;
 415                 struct v4l2_tuner vt;
 416                 int cur_input;
 417                 struct pvr2_ctrl *ctrlp;
 418                 ret = pvr2_hdw_get_tuner_status(hdw,&vt);
 419                 if (ret != 0) break;
 420                 ctrlp = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_INPUT);
 421                 ret = pvr2_ctrl_get_value(ctrlp,&cur_input);
 422                 if (ret != 0) break;
 423                 if (vf->type == V4L2_TUNER_RADIO) {
 424                         if (cur_input != PVR2_CVAL_INPUT_RADIO) {
 425                                 pvr2_ctrl_set_value(ctrlp,
 426                                                     PVR2_CVAL_INPUT_RADIO);
 427                         }
 428                 } else {
 429                         if (cur_input == PVR2_CVAL_INPUT_RADIO) {
 430                                 pvr2_ctrl_set_value(ctrlp,
 431                                                     PVR2_CVAL_INPUT_TV);
 432                         }
 433                 }
 434                 fv = vf->frequency;
 435                 if (vt.capability & V4L2_TUNER_CAP_LOW) {
 436                         fv = (fv * 125) / 2;
 437                 } else {
 438                         fv = fv * 62500;
 439                 }
 440                 ret = pvr2_ctrl_set_value(
 441                         pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_FREQUENCY),fv);
 442                 break;
 443         }
 444
 445         case VIDIOC_G_FREQUENCY:
 446         {
 447                 struct v4l2_frequency *vf = (struct v4l2_frequency *)arg;
 448                 int val = 0;
 449                 int cur_input;
 450                 struct v4l2_tuner vt;
 451                 ret = pvr2_hdw_get_tuner_status(hdw,&vt);
 452                 if (ret != 0) break;
 453                 ret = pvr2_ctrl_get_value(
 454                         pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_FREQUENCY),
 455                         &val);
 456                 if (ret != 0) break;
 457                 pvr2_ctrl_get_value(
 458                         pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_INPUT),
 459                         &cur_input);
 460                 if (cur_input == PVR2_CVAL_INPUT_RADIO) {
 461                         vf->type = V4L2_TUNER_RADIO;
 462                 } else {
 463                         vf->type = V4L2_TUNER_ANALOG_TV;
 464                 }
 465                 if (vt.capability & V4L2_TUNER_CAP_LOW) {
 466                         val = (val * 2) / 125;
 467                 } else {
 468                         val /= 62500;
 469                 }
 470                 vf->frequency = val;
 471                 break;
 472         }
 473
 474         case VIDIOC_ENUM_FMT:
 475         {
 476                 struct v4l2_fmtdesc *fd = (struct v4l2_fmtdesc *)arg;
 477
 478                 /* Only one format is supported : mpeg.*/
 479                 if (fd->index != 0)
 480                         break;
 481
 482                 memcpy(fd, pvr_fmtdesc, sizeof(struct v4l2_fmtdesc));
 483                 ret = 0;
 484                 break;
 485         }
 486
 487         case VIDIOC_G_FMT:
 488         {
 489                 struct v4l2_format *vf = (struct v4l2_format *)arg;
 490                 int val;
 491                 switch(vf->type) {
 492                 case V4L2_BUF_TYPE_VIDEO_CAPTURE:
 493                         memcpy(vf, &pvr_format[PVR_FORMAT_PIX],
 494                                sizeof(struct v4l2_format));
 495                         val = 0;
 496                         pvr2_ctrl_get_value(
 497                                 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_HRES),
 498                                 &val);
 499                         vf->fmt.pix.width = val;
 500                         val = 0;
 501                         pvr2_ctrl_get_value(
 502                                 pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_VRES),
 503                                 &val);
 504                         vf->fmt.pix.height = val;
 505                         ret = 0;
 506                         break;
 507                 case V4L2_BUF_TYPE_VBI_CAPTURE:
 508                         // ????? Still need to figure out to do VBI correctly
 509                         ret = -EINVAL;
 510                         break;
 511                 default:
 512                         ret = -EINVAL;
 513                         break;
 514                 }
 515                 break;
 516         }
 517
 518         case VIDIOC_TRY_FMT:
 519         case VIDIOC_S_FMT:
 520         {
 521                 struct v4l2_format *vf = (struct v4l2_format *)arg;
 522
 523                 ret = 0;
 524                 switch(vf->type) {
 525                 case V4L2_BUF_TYPE_VIDEO_CAPTURE: {
 526                         int lmin,lmax,ldef;
 527                         struct pvr2_ctrl *hcp,*vcp;
 528                         int h = vf->fmt.pix.height;
 529                         int w = vf->fmt.pix.width;
 530                         hcp = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_HRES);
 531                         vcp = pvr2_hdw_get_ctrl_by_id(hdw,PVR2_CID_VRES);
 532
 533                         lmin = pvr2_ctrl_get_min(hcp);
 534                         lmax = pvr2_ctrl_get_max(hcp);
 535                         pvr2_ctrl_get_def(hcp, &ldef);
 536                         if (w == -1) {
 537                                 w = ldef;
 538                         } else if (w < lmin) {
 539                                 w = lmin;
 540                         } else if (w > lmax) {
 541                                 w = lmax;
 542                         }
 543                         lmin = pvr2_ctrl_get_min(vcp);
 544                         lmax = pvr2_ctrl_get_max(vcp);
 545                         pvr2_ctrl_get_def(vcp, &ldef);
 546                         if (h == -1) {
 547                                 h = ldef;
 548                         } else if (h < lmin) {
 549                                 h = lmin;
 550                         } else if (h > lmax) {
 551                                 h = lmax;
 552                         }
 553
 554                         memcpy(vf, &pvr_format[PVR_FORMAT_PIX],
 555                                sizeof(struct v4l2_format));
 556                         vf->fmt.pix.width = w;
 557                         vf->fmt.pix.height = h;
 558
 559                         if (cmd == VIDIOC_S_FMT) {
 560                                 pvr2_ctrl_set_value(hcp,vf->fmt.pix.width);
 561                                 pvr2_ctrl_set_value(vcp,vf->fmt.pix.height);
 562                         }
 563                 } break;
 564                 case V4L2_BUF_TYPE_VBI_CAPTURE:
 565                         // ????? Still need to figure out to do VBI correctly
 566                         ret = -EINVAL;
 567                         break;
 568                 default:
 569                         ret = -EINVAL;
 570                         break;
 571                 }
 572                 break;
 573         }
 574
 575         case VIDIOC_STREAMON:
 576         {
 577                 if (!fh->dev_info->stream) {
 578                         /* No stream defined for this node.  This means
 579                            that we're not currently allowed to stream from
 580                            this node. */
 581                         ret = -EPERM;
 582                         break;
 583                 }
 584                 ret = pvr2_hdw_set_stream_type(hdw,dev_info->config);
 585                 if (ret < 0) return ret;
 586                 ret = pvr2_hdw_set_streaming(hdw,!0);
 587                 break;
 588         }
 589
 590         case VIDIOC_STREAMOFF:
 591         {
 592                 if (!fh->dev_info->stream) {
 593                         /* No stream defined for this node.  This means
 594                            that we're not currently allowed to stream from
 595                            this node. */
 596                         ret = -EPERM;
 597                         break;
 598                 }
 599                 ret = pvr2_hdw_set_streaming(hdw,0);
 600                 break;
 601         }
 602
 603         case VIDIOC_QUERYCTRL:
 604         {
 605                 struct pvr2_ctrl *cptr;
 606                 int val;
 607                 struct v4l2_queryctrl *vc = (struct v4l2_queryctrl *)arg;
 608                 ret = 0;
 609                 if (vc->id & V4L2_CTRL_FLAG_NEXT_CTRL) {
 610                         cptr = pvr2_hdw_get_ctrl_nextv4l(
 611                                 hdw,(vc->id & ~V4L2_CTRL_FLAG_NEXT_CTRL));
 612                         if (cptr) vc->id = pvr2_ctrl_get_v4lid(cptr);
 613                 } else {
 614                         cptr = pvr2_hdw_get_ctrl_v4l(hdw,vc->id);
 615                 }
 616                 if (!cptr) {
 617                         pvr2_trace(PVR2_TRACE_V4LIOCTL,
 618                                    "QUERYCTRL id=0x%x not implemented here",
 619                                    vc->id);
 620                         ret = -EINVAL;
 621                         break;
 622                 }
 623
 624                 pvr2_trace(PVR2_TRACE_V4LIOCTL,
 625                            "QUERYCTRL id=0x%x mapping name=%s (%s)",
 626                            vc->id,pvr2_ctrl_get_name(cptr),
 627                            pvr2_ctrl_get_desc(cptr));
 628                 strlcpy(vc->name,pvr2_ctrl_get_desc(cptr),sizeof(vc->name));
 629                 vc->flags = pvr2_ctrl_get_v4lflags(cptr);
 630                 pvr2_ctrl_get_def(cptr, &val);
 631                 vc->default_value = val;
 632                 switch (pvr2_ctrl_get_type(cptr)) {
 633                 case pvr2_ctl_enum:
 634                         vc->type = V4L2_CTRL_TYPE_MENU;
 635                         vc->minimum = 0;
 636                         vc->maximum = pvr2_ctrl_get_cnt(cptr) - 1;
 637                         vc->step = 1;
 638                         break;
 639                 case pvr2_ctl_bool:
 640                         vc->type = V4L2_CTRL_TYPE_BOOLEAN;
 641                         vc->minimum = 0;
 642                         vc->maximum = 1;
 643                         vc->step = 1;
 644                         break;
 645                 case pvr2_ctl_int:
 646                         vc->type = V4L2_CTRL_TYPE_INTEGER;
 647                         vc->minimum = pvr2_ctrl_get_min(cptr);
 648                         vc->maximum = pvr2_ctrl_get_max(cptr);
 649                         vc->step = 1;
 650                         break;
 651                 default:
 652                         pvr2_trace(PVR2_TRACE_V4LIOCTL,
 653                                    "QUERYCTRL id=0x%x name=%s not mappable",
 654                                    vc->id,pvr2_ctrl_get_name(cptr));
 655                         ret = -EINVAL;
 656                         break;
 657                 }
 658                 break;
 659         }
 660
 661         case VIDIOC_QUERYMENU:
 662         {
 663                 struct v4l2_querymenu *vm = (struct v4l2_querymenu *)arg;
 664                 unsigned int cnt = 0;
 665                 ret = pvr2_ctrl_get_valname(pvr2_hdw_get_ctrl_v4l(hdw,vm->id),
 666                                             vm->index,
 667                                             vm->name,sizeof(vm->name)-1,
 668                                             &cnt);
 669                 vm->name[cnt] = 0;
 670                 break;
 671         }
 672
 673         case VIDIOC_G_CTRL:
 674         {
 675                 struct v4l2_control *vc = (struct v4l2_control *)arg;
 676                 int val = 0;
 677                 ret = pvr2_ctrl_get_value(pvr2_hdw_get_ctrl_v4l(hdw,vc->id),
 678                                           &val);
 679                 vc->value = val;
 680                 break;
 681         }
 682
 683         case VIDIOC_S_CTRL:
 684         {
 685                 struct v4l2_control *vc = (struct v4l2_control *)arg;
 686                 ret = pvr2_ctrl_set_value(pvr2_hdw_get_ctrl_v4l(hdw,vc->id),
 687                                           vc->value);
 688                 break;
 689         }
 690
 691         case VIDIOC_G_EXT_CTRLS:
 692         {
 693                 struct v4l2_ext_controls *ctls =
 694                         (struct v4l2_ext_controls *)arg;
 695                 struct v4l2_ext_control *ctrl;
 696                 unsigned int idx;
 697                 int val;
 698                 ret = 0;
 699                 for (idx = 0; idx < ctls->count; idx++) {
 700                         ctrl = ctls->controls + idx;
 701                         ret = pvr2_ctrl_get_value(
 702                                 pvr2_hdw_get_ctrl_v4l(hdw,ctrl->id),&val);
 703                         if (ret) {
 704                                 ctls->error_idx = idx;
 705                                 break;
 706                         }
 707                         /* Ensure that if read as a 64 bit value, the user
 708                            will still get a hopefully sane value */
 709                         ctrl->value64 = 0;
 710                         ctrl->value = val;
 711                 }
 712                 break;
 713         }
 714
 715         case VIDIOC_S_EXT_CTRLS:
 716         {
 717                 struct v4l2_ext_controls *ctls =
 718                         (struct v4l2_ext_controls *)arg;
 719                 struct v4l2_ext_control *ctrl;
 720                 unsigned int idx;
 721                 ret = 0;
 722                 for (idx = 0; idx < ctls->count; idx++) {
 723                         ctrl = ctls->controls + idx;
 724                         ret = pvr2_ctrl_set_value(
 725                                 pvr2_hdw_get_ctrl_v4l(hdw,ctrl->id),
 726                                 ctrl->value);
 727                         if (ret) {
 728                                 ctls->error_idx = idx;
 729                                 break;
 730                         }
 731                 }
 732                 break;
 733         }
 734
 735         case VIDIOC_TRY_EXT_CTRLS:
 736         {
 737                 struct v4l2_ext_controls *ctls =
 738                         (struct v4l2_ext_controls *)arg;
 739                 struct v4l2_ext_control *ctrl;
 740                 struct pvr2_ctrl *pctl;
 741                 unsigned int idx;
 742                 /* For the moment just validate that the requested control
 743                    actually exists. */
 744                 ret = 0;
 745                 for (idx = 0; idx < ctls->count; idx++) {
 746                         ctrl = ctls->controls + idx;
 747                         pctl = pvr2_hdw_get_ctrl_v4l(hdw,ctrl->id);
 748                         if (!pctl) {
 749                                 ret = -EINVAL;
 750                                 ctls->error_idx = idx;
 751                                 break;
 752                         }
 753                 }
 754                 break;
 755         }
 756
 757         case VIDIOC_CROPCAP:
 758         {
 759                 struct v4l2_cropcap *cap = (struct v4l2_cropcap *)arg;
 760                 if (cap->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
 761                         ret = -EINVAL;
 762                         break;
 763                 }
 764                 ret = pvr2_hdw_get_cropcap(hdw, cap);
 765                 cap->type = V4L2_BUF_TYPE_VIDEO_CAPTURE; /* paranoia */
 766                 break;
 767         }
 768         case VIDIOC_G_CROP:
 769         {
 770                 struct v4l2_crop *crop = (struct v4l2_crop *)arg;
 771                 int val = 0;
 772                 if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
 773                         ret = -EINVAL;
 774                         break;
 775                 }
 776                 ret = pvr2_ctrl_get_value(
 777                         pvr2_hdw_get_ctrl_by_id(hdw, PVR2_CID_CROPL), &val);
 778                 if (ret != 0) {
 779                         ret = -EINVAL;
 780                         break;
 781                 }
 782                 crop->c.left = val;
 783                 ret = pvr2_ctrl_get_value(
 784                         pvr2_hdw_get_ctrl_by_id(hdw, PVR2_CID_CROPT), &val);
 785                 if (ret != 0) {
 786                         ret = -EINVAL;
 787                         break;
 788                 }
 789                 crop->c.top = val;
 790                 ret = pvr2_ctrl_get_value(
 791                         pvr2_hdw_get_ctrl_by_id(hdw, PVR2_CID_CROPW), &val);
 792                 if (ret != 0) {
 793                         ret = -EINVAL;
 794                         break;
 795                 }
 796                 crop->c.width = val;
 797                 ret = pvr2_ctrl_get_value(
 798                         pvr2_hdw_get_ctrl_by_id(hdw, PVR2_CID_CROPH), &val);
 799                 if (ret != 0) {
 800                         ret = -EINVAL;
 801                         break;
 802                 }
 803                 crop->c.height = val;
 804         }
 805         case VIDIOC_S_CROP:
 806         {
 807                 struct v4l2_crop *crop = (struct v4l2_crop *)arg;
 808                 struct v4l2_cropcap cap;
 809                 if (crop->type != V4L2_BUF_TYPE_VIDEO_CAPTURE) {
 810                         ret = -EINVAL;
 811                         break;
 812                 }
 813                 cap.type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 814                 ret = pvr2_ctrl_set_value(
 815                         pvr2_hdw_get_ctrl_by_id(hdw, PVR2_CID_CROPL),
 816                         crop->c.left);
 817                 if (ret != 0) {
 818                         ret = -EINVAL;
 819                         break;
 820                 }
 821                 ret = pvr2_ctrl_set_value(
 822                         pvr2_hdw_get_ctrl_by_id(hdw, PVR2_CID_CROPT),
 823                         crop->c.top);
 824                 if (ret != 0) {
 825                         ret = -EINVAL;
 826                         break;
 827                 }
 828                 ret = pvr2_ctrl_set_value(
 829                         pvr2_hdw_get_ctrl_by_id(hdw, PVR2_CID_CROPW),
 830                         crop->c.width);
 831                 if (ret != 0) {
 832                         ret = -EINVAL;
 833                         break;
 834                 }
 835                 ret = pvr2_ctrl_set_value(
 836                         pvr2_hdw_get_ctrl_by_id(hdw, PVR2_CID_CROPH),
 837                         crop->c.height);
 838                 if (ret != 0) {
 839                         ret = -EINVAL;
 840                         break;
 841                 }
 842         }
 843         case VIDIOC_LOG_STATUS:
 844         {
 845                 pvr2_hdw_trigger_module_log(hdw);
 846                 ret = 0;
 847                 break;
 848         }
 849 #ifdef CONFIG_VIDEO_ADV_DEBUG
 850         case VIDIOC_DBG_S_REGISTER:
 851         case VIDIOC_DBG_G_REGISTER:
 852         {
 853                 u64 val;
 854                 struct v4l2_register *req = (struct v4l2_register *)arg;
 855                 if (cmd == VIDIOC_DBG_S_REGISTER) val = req->val;
 856                 ret = pvr2_hdw_register_access(
 857                         hdw,req->match_type,req->match_chip,req->reg,
 858                         cmd == VIDIOC_DBG_S_REGISTER,&val);
 859                 if (cmd == VIDIOC_DBG_G_REGISTER) req->val = val;
 860                 break;
 861         }
 862 #endif
 863
 864         default :
 865                 ret = v4l_compat_translate_ioctl(file, cmd,
 866                                                  arg, pvr2_v4l2_do_ioctl);
 867         }
 868
 869         pvr2_hdw_commit_ctl(hdw);
 870
 871         if (ret < 0) {
 872                 if (pvrusb2_debug & PVR2_TRACE_V4LIOCTL) {
 873                         pvr2_trace(PVR2_TRACE_V4LIOCTL,
 874                                    "pvr2_v4l2_do_ioctl failure, ret=%d",ret);
 875                 } else {
 876                         if (pvrusb2_debug & PVR2_TRACE_V4LIOCTL) {
 877                                 pvr2_trace(PVR2_TRACE_V4LIOCTL,
 878                                            "pvr2_v4l2_do_ioctl failure, ret=%d"
 879                                            " command was:",ret);
 880                                 v4l_print_ioctl(pvr2_hdw_get_driver_name(hdw),
 881                                                 cmd);
 882                         }
 883                 }
 884         } else {
 885                 pvr2_trace(PVR2_TRACE_V4LIOCTL,
 886                            "pvr2_v4l2_do_ioctl complete, ret=%d (0x%x)",
 887                            ret,ret);
 888         }
 889         return ret;
 890 }
 891
 892 static void pvr2_v4l2_dev_destroy(struct pvr2_v4l2_dev *dip)
 893 {
 894         int num = dip->devbase.num;
 895         struct pvr2_hdw *hdw = dip->v4lp->channel.mc_head->hdw;
 896         enum pvr2_config cfg = dip->config;
 897         int v4l_type = dip->v4l_type;
 898
 899         pvr2_hdw_v4l_store_minor_number(hdw,dip->minor_type,-1);
 900
 901         /* Paranoia */
 902         dip->v4lp = NULL;
 903         dip->stream = NULL;
 904
 905         /* Actual deallocation happens later when all internal references
 906            are gone. */
 907         video_unregister_device(&dip->devbase);
 908
 909         printk(KERN_INFO "pvrusb2: unregistered device %s%u [%s]\n",
 910                get_v4l_name(v4l_type), num,
 911                pvr2_config_get_name(cfg));
 912
 913 }
 914
 915
 916 static void pvr2_v4l2_destroy_no_lock(struct pvr2_v4l2 *vp)
 917 {
 918         if (vp->dev_video) {
 919                 pvr2_v4l2_dev_destroy(vp->dev_video);
 920                 vp->dev_video = NULL;
 921         }
 922         if (vp->dev_radio) {
 923                 pvr2_v4l2_dev_destroy(vp->dev_radio);
 924                 vp->dev_radio = NULL;
 925         }
 926
 927         pvr2_trace(PVR2_TRACE_STRUCT,"Destroying pvr2_v4l2 id=%p",vp);
 928         pvr2_channel_done(&vp->channel);
 929         kfree(vp);
 930 }
 931
 932
 933 static void pvr2_video_device_release(struct video_device *vdev)
 934 {
 935         struct pvr2_v4l2_dev *dev;
 936         dev = container_of(vdev,struct pvr2_v4l2_dev,devbase);
 937         kfree(dev);
 938 }
 939
 940
 941 static void pvr2_v4l2_internal_check(struct pvr2_channel *chp)
 942 {
 943         struct pvr2_v4l2 *vp;
 944         vp = container_of(chp,struct pvr2_v4l2,channel);
 945         if (!vp->channel.mc_head->disconnect_flag) return;
 946         if (vp->vfirst) return;
 947         pvr2_v4l2_destroy_no_lock(vp);
 948 }
 949
 950
 951 static int pvr2_v4l2_ioctl(struct inode *inode, struct file *file,
 952                            unsigned int cmd, unsigned long arg)
 953 {
 954
 955 /* Temporary hack : use ivtv api until a v4l2 one is available. */
 956 #define IVTV_IOC_G_CODEC        0xFFEE7703
 957 #define IVTV_IOC_S_CODEC        0xFFEE7704
 958         if (cmd == IVTV_IOC_G_CODEC || cmd == IVTV_IOC_S_CODEC) return 0;
 959         return video_usercopy(file, cmd, arg, pvr2_v4l2_do_ioctl);
 960 }
 961
 962
 963 static int pvr2_v4l2_release(struct inode *inode, struct file *file)
 964 {
 965         struct pvr2_v4l2_fh *fhp = file->private_data;
 966         struct pvr2_v4l2 *vp = fhp->vhead;
 967         struct pvr2_hdw *hdw = fhp->channel.mc_head->hdw;
 968
 969         pvr2_trace(PVR2_TRACE_OPEN_CLOSE,"pvr2_v4l2_release");
 970
 971         if (fhp->rhp) {
 972                 struct pvr2_stream *sp;
 973                 pvr2_hdw_set_streaming(hdw,0);
 974                 sp = pvr2_ioread_get_stream(fhp->rhp);
 975                 if (sp) pvr2_stream_set_callback(sp,NULL,NULL);
 976                 pvr2_ioread_destroy(fhp->rhp);
 977                 fhp->rhp = NULL;
 978         }
 979
 980         v4l2_prio_close(&vp->prio, &fhp->prio);
 981         file->private_data = NULL;
 982
 983         if (fhp->vnext) {
 984                 fhp->vnext->vprev = fhp->vprev;
 985         } else {
 986                 vp->vlast = fhp->vprev;
 987         }
 988         if (fhp->vprev) {
 989                 fhp->vprev->vnext = fhp->vnext;
 990         } else {
 991                 vp->vfirst = fhp->vnext;
 992         }
 993         fhp->vnext = NULL;
 994         fhp->vprev = NULL;
 995         fhp->vhead = NULL;
 996         pvr2_channel_done(&fhp->channel);
 997         pvr2_trace(PVR2_TRACE_STRUCT,
 998                    "Destroying pvr_v4l2_fh id=%p",fhp);
 999         if (fhp->input_map) {
1000                 kfree(fhp->input_map);
1001                 fhp->input_map = NULL;
1002         }
1003         kfree(fhp);
1004         if (vp->channel.mc_head->disconnect_flag && !vp->vfirst) {
1005                 pvr2_v4l2_destroy_no_lock(vp);
1006         }
1007         return 0;
1008 }
1009
1010
1011 static int pvr2_v4l2_open(struct inode *inode, struct file *file)
1012 {
1013         struct pvr2_v4l2_dev *dip; /* Our own context pointer */
1014         struct pvr2_v4l2_fh *fhp;
1015         struct pvr2_v4l2 *vp;
1016         struct pvr2_hdw *hdw;
1017         unsigned int input_mask = 0;
1018         unsigned int input_cnt,idx;
1019         int ret = 0;
1020
1021         dip = container_of(video_devdata(file),struct pvr2_v4l2_dev,devbase);
1022
1023         vp = dip->v4lp;
1024         hdw = vp->channel.hdw;
1025
1026         pvr2_trace(PVR2_TRACE_OPEN_CLOSE,"pvr2_v4l2_open");
1027
1028         if (!pvr2_hdw_dev_ok(hdw)) {
1029                 pvr2_trace(PVR2_TRACE_OPEN_CLOSE,
1030                            "pvr2_v4l2_open: hardware not ready");
1031                 return -EIO;
1032         }
1033
1034         fhp = kzalloc(sizeof(*fhp),GFP_KERNEL);
1035         if (!fhp) {
1036                 return -ENOMEM;
1037         }
1038
1039         init_waitqueue_head(&fhp->wait_data);
1040         fhp->dev_info = dip;
1041
1042         pvr2_trace(PVR2_TRACE_STRUCT,"Creating pvr_v4l2_fh id=%p",fhp);
1043         pvr2_channel_init(&fhp->channel,vp->channel.mc_head);
1044
1045         if (dip->v4l_type == VFL_TYPE_RADIO) {
1046                 /* Opening device as a radio, legal input selection subset
1047                    is just the radio. */
1048                 input_mask = (1 << PVR2_CVAL_INPUT_RADIO);
1049         } else {
1050                 /* Opening the main V4L device, legal input selection
1051                    subset includes all analog inputs. */
1052                 input_mask = ((1 << PVR2_CVAL_INPUT_RADIO) |
1053                               (1 << PVR2_CVAL_INPUT_TV) |
1054                               (1 << PVR2_CVAL_INPUT_COMPOSITE) |
1055                               (1 << PVR2_CVAL_INPUT_SVIDEO));
1056         }
1057         ret = pvr2_channel_limit_inputs(&fhp->channel,input_mask);
1058         if (ret) {
1059                 pvr2_channel_done(&fhp->channel);
1060                 pvr2_trace(PVR2_TRACE_STRUCT,
1061                            "Destroying pvr_v4l2_fh id=%p (input mask error)",
1062                            fhp);
1063
1064                 kfree(fhp);
1065                 return ret;
1066         }
1067
1068         input_mask &= pvr2_hdw_get_input_available(hdw);
1069         input_cnt = 0;
1070         for (idx = 0; idx < (sizeof(input_mask) << 3); idx++) {
1071                 if (input_mask & (1 << idx)) input_cnt++;
1072         }
1073         fhp->input_cnt = input_cnt;
1074         fhp->input_map = kzalloc(input_cnt,GFP_KERNEL);
1075         if (!fhp->input_map) {
1076                 pvr2_channel_done(&fhp->channel);
1077                 pvr2_trace(PVR2_TRACE_STRUCT,
1078                            "Destroying pvr_v4l2_fh id=%p (input map failure)",
1079                            fhp);
1080                 kfree(fhp);
1081                 return -ENOMEM;
1082         }
1083         input_cnt = 0;
1084         for (idx = 0; idx < (sizeof(input_mask) << 3); idx++) {
1085                 if (!(input_mask & (1 << idx))) continue;
1086                 fhp->input_map[input_cnt++] = idx;
1087         }
1088
1089         fhp->vnext = NULL;
1090         fhp->vprev = vp->vlast;
1091         if (vp->vlast) {
1092                 vp->vlast->vnext = fhp;
1093         } else {
1094                 vp->vfirst = fhp;
1095         }
1096         vp->vlast = fhp;
1097         fhp->vhead = vp;
1098
1099         fhp->file = file;
1100         file->private_data = fhp;
1101         v4l2_prio_open(&vp->prio,&fhp->prio);
1102
1103         fhp->fw_mode_flag = pvr2_hdw_cpufw_get_enabled(hdw);
1104
1105         return 0;
1106 }
1107
1108
1109 static void pvr2_v4l2_notify(struct pvr2_v4l2_fh *fhp)
1110 {
1111         wake_up(&fhp->wait_data);
1112 }
1113
1114 static int pvr2_v4l2_iosetup(struct pvr2_v4l2_fh *fh)
1115 {
1116         int ret;
1117         struct pvr2_stream *sp;
1118         struct pvr2_hdw *hdw;
1119         if (fh->rhp) return 0;
1120
1121         if (!fh->dev_info->stream) {
1122                 /* No stream defined for this node.  This means that we're
1123                    not currently allowed to stream from this node. */
1124                 return -EPERM;
1125         }
1126
1127         /* First read() attempt.  Try to claim the stream and start
1128            it... */
1129         if ((ret = pvr2_channel_claim_stream(&fh->channel,
1130                                              fh->dev_info->stream)) != 0) {
1131                 /* Someone else must already have it */
1132                 return ret;
1133         }
1134
1135         fh->rhp = pvr2_channel_create_mpeg_stream(fh->dev_info->stream);
1136         if (!fh->rhp) {
1137                 pvr2_channel_claim_stream(&fh->channel,NULL);
1138                 return -ENOMEM;
1139         }
1140
1141         hdw = fh->channel.mc_head->hdw;
1142         sp = fh->dev_info->stream->stream;
1143         pvr2_stream_set_callback(sp,(pvr2_stream_callback)pvr2_v4l2_notify,fh);
1144         pvr2_hdw_set_stream_type(hdw,fh->dev_info->config);
1145         if ((ret = pvr2_hdw_set_streaming(hdw,!0)) < 0) return ret;
1146         return pvr2_ioread_set_enabled(fh->rhp,!0);
1147 }
1148
1149
1150 static ssize_t pvr2_v4l2_read(struct file *file,
1151                               char __user *buff, size_t count, loff_t *ppos)
1152 {
1153         struct pvr2_v4l2_fh *fh = file->private_data;
1154         int ret;
1155
1156         if (fh->fw_mode_flag) {
1157                 struct pvr2_hdw *hdw = fh->channel.mc_head->hdw;
1158                 char *tbuf;
1159                 int c1,c2;
1160                 int tcnt = 0;
1161                 unsigned int offs = *ppos;
1162
1163                 tbuf = kmalloc(PAGE_SIZE,GFP_KERNEL);
1164                 if (!tbuf) return -ENOMEM;
1165
1166                 while (count) {
1167                         c1 = count;
1168                         if (c1 > PAGE_SIZE) c1 = PAGE_SIZE;
1169                         c2 = pvr2_hdw_cpufw_get(hdw,offs,tbuf,c1);
1170                         if (c2 < 0) {
1171                                 tcnt = c2;
1172                                 break;
1173                         }
1174                         if (!c2) break;
1175                         if (copy_to_user(buff,tbuf,c2)) {
1176                                 tcnt = -EFAULT;
1177                                 break;
1178                         }
1179                         offs += c2;
1180                         tcnt += c2;
1181                         buff += c2;
1182                         count -= c2;
1183                         *ppos += c2;
1184                 }
1185                 kfree(tbuf);
1186                 return tcnt;
1187         }
1188
1189         if (!fh->rhp) {
1190                 ret = pvr2_v4l2_iosetup(fh);
1191                 if (ret) {
1192                         return ret;
1193                 }
1194         }
1195
1196         for (;;) {
1197                 ret = pvr2_ioread_read(fh->rhp,buff,count);
1198                 if (ret >= 0) break;
1199                 if (ret != -EAGAIN) break;
1200                 if (file->f_flags & O_NONBLOCK) break;
1201                 /* Doing blocking I/O.  Wait here. */
1202                 ret = wait_event_interruptible(
1203                         fh->wait_data,
1204                         pvr2_ioread_avail(fh->rhp) >= 0);
1205                 if (ret < 0) break;
1206         }
1207
1208         return ret;
1209 }
1210
1211
1212 static unsigned int pvr2_v4l2_poll(struct file *file, poll_table *wait)
1213 {
1214         unsigned int mask = 0;
1215         struct pvr2_v4l2_fh *fh = file->private_data;
1216         int ret;
1217
1218         if (fh->fw_mode_flag) {
1219                 mask |= POLLIN | POLLRDNORM;
1220                 return mask;
1221         }
1222
1223         if (!fh->rhp) {
1224                 ret = pvr2_v4l2_iosetup(fh);
1225                 if (ret) return POLLERR;
1226         }
1227
1228         poll_wait(file,&fh->wait_data,wait);
1229
1230         if (pvr2_ioread_avail(fh->rhp) >= 0) {
1231                 mask |= POLLIN | POLLRDNORM;
1232         }
1233
1234         return mask;
1235 }
1236
1237
1238 static const struct file_operations vdev_fops = {
1239         .owner      = THIS_MODULE,
1240         .open       = pvr2_v4l2_open,
1241         .release    = pvr2_v4l2_release,
1242         .read       = pvr2_v4l2_read,
1243         .ioctl      = pvr2_v4l2_ioctl,
1244         .llseek     = no_llseek,
1245         .poll       = pvr2_v4l2_poll,
1246 };
1247
1248
1249 static struct video_device vdev_template = {
1250         .fops       = &vdev_fops,
1251 };
1252
1253
1254 static void pvr2_v4l2_dev_init(struct pvr2_v4l2_dev *dip,
1255                                struct pvr2_v4l2 *vp,
1256                                int v4l_type)
1257 {
1258         int mindevnum;
1259         int unit_number;
1260         int *nr_ptr = NULL;
1261         dip->v4lp = vp;
1262
1263
1264         dip->v4l_type = v4l_type;
1265         switch (v4l_type) {
1266         case VFL_TYPE_GRABBER:
1267                 dip->stream = &vp->channel.mc_head->video_stream;
1268                 dip->config = pvr2_config_mpeg;
1269                 dip->minor_type = pvr2_v4l_type_video;
1270                 nr_ptr = video_nr;
1271                 if (!dip->stream) {
1272                         err("Failed to set up pvrusb2 v4l video dev"
1273                             " due to missing stream instance");
1274                         return;
1275                 }
1276                 break;
1277         case VFL_TYPE_VBI:
1278                 dip->config = pvr2_config_vbi;
1279                 dip->minor_type = pvr2_v4l_type_vbi;
1280                 nr_ptr = vbi_nr;
1281                 break;
1282         case VFL_TYPE_RADIO:
1283                 dip->stream = &vp->channel.mc_head->video_stream;
1284                 dip->config = pvr2_config_mpeg;
1285                 dip->minor_type = pvr2_v4l_type_radio;
1286                 nr_ptr = radio_nr;
1287                 break;
1288         default:
1289                 /* Bail out (this should be impossible) */
1290                 err("Failed to set up pvrusb2 v4l dev"
1291                     " due to unrecognized config");
1292                 return;
1293         }
1294
1295         memcpy(&dip->devbase,&vdev_template,sizeof(vdev_template));
1296         dip->devbase.release = pvr2_video_device_release;
1297
1298         mindevnum = -1;
1299         unit_number = pvr2_hdw_get_unit_number(vp->channel.mc_head->hdw);
1300         if (nr_ptr && (unit_number >= 0) && (unit_number < PVR_NUM)) {
1301                 mindevnum = nr_ptr[unit_number];
1302         }
1303         if ((video_register_device(&dip->devbase,
1304                                    dip->v4l_type, mindevnum) < 0) &&
1305             (video_register_device(&dip->devbase,
1306                                    dip->v4l_type, -1) < 0)) {
1307                 err("Failed to register pvrusb2 v4l device");
1308         }
1309
1310         printk(KERN_INFO "pvrusb2: registered device %s%u [%s]\n",
1311                get_v4l_name(dip->v4l_type), dip->devbase.num,
1312                pvr2_config_get_name(dip->config));
1313
1314         pvr2_hdw_v4l_store_minor_number(vp->channel.mc_head->hdw,
1315                                         dip->minor_type,dip->devbase.minor);
1316 }
1317
1318
1319 struct pvr2_v4l2 *pvr2_v4l2_create(struct pvr2_context *mnp)
1320 {
1321         struct pvr2_v4l2 *vp;
1322
1323         vp = kzalloc(sizeof(*vp),GFP_KERNEL);
1324         if (!vp) return vp;
1325         pvr2_channel_init(&vp->channel,mnp);
1326         pvr2_trace(PVR2_TRACE_STRUCT,"Creating pvr2_v4l2 id=%p",vp);
1327
1328         vp->channel.check_func = pvr2_v4l2_internal_check;
1329
1330         /* register streams */
1331         vp->dev_video = kzalloc(sizeof(*vp->dev_video),GFP_KERNEL);
1332         if (!vp->dev_video) goto fail;
1333         pvr2_v4l2_dev_init(vp->dev_video,vp,VFL_TYPE_GRABBER);
1334         if (pvr2_hdw_get_input_available(vp->channel.mc_head->hdw) &
1335             (1 << PVR2_CVAL_INPUT_RADIO)) {
1336                 vp->dev_radio = kzalloc(sizeof(*vp->dev_radio),GFP_KERNEL);
1337                 if (!vp->dev_radio) goto fail;
1338                 pvr2_v4l2_dev_init(vp->dev_radio,vp,VFL_TYPE_RADIO);
1339         }
1340
1341         return vp;
1342  fail:
1343         pvr2_trace(PVR2_TRACE_STRUCT,"Failure creating pvr2_v4l2 id=%p",vp);
1344         pvr2_v4l2_destroy_no_lock(vp);
1345         return NULL;
1346 }
1347
1348 /*
1349   Stuff for Emacs to see, in order to encourage consistent editing style:
1350   *** Local Variables: ***
1351   *** mode: c ***
1352   *** fill-column: 75 ***
1353   *** tab-width: 8 ***
1354   *** c-basic-offset: 8 ***
1355   *** End: ***
1356   */