drivers/media/video/saa7134/saa7134-empress.c

   1 /*
   2  *
   3  * (c) 2004 Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]
   4  *
   5  *  This program is free software; you can redistribute it and/or modify
   6  *  it under the terms of the GNU General Public License as published by
   7  *  the Free Software Foundation; either version 2 of the License, or
   8  *  (at your option) any later version.
   9  *
  10  *  This program is distributed in the hope that it will be useful,
  11  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  12  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  13  *  GNU General Public License for more details.
  14  *
  15  *  You should have received a copy of the GNU General Public License
  16  *  along with this program; if not, write to the Free Software
  17  *  Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  18  */
  19
  20 #include <linux/init.h>
  21 #include <linux/list.h>
  22 #include <linux/module.h>
  23 #include <linux/moduleparam.h>
  24 #include <linux/kernel.h>
  25 #include <linux/slab.h>
  26 #include <linux/delay.h>
  27
  28 #include "saa7134-reg.h"
  29 #include "saa7134.h"
  30
  31 #include <media/saa6752hs.h>
  32 #include <media/v4l2-common.h>
  33
  34 /* ------------------------------------------------------------------ */
  35
  36 MODULE_AUTHOR("Gerd Knorr <kraxel@bytesex.org> [SuSE Labs]");
  37 MODULE_LICENSE("GPL");
  38
  39 static unsigned int empress_nr[] = {[0 ... (SAA7134_MAXBOARDS - 1)] = UNSET };
  40
  41 module_param_array(empress_nr, int, NULL, 0444);
  42 MODULE_PARM_DESC(empress_nr,"ts device number");
  43
  44 static unsigned int debug = 0;
  45 module_param(debug, int, 0644);
  46 MODULE_PARM_DESC(debug,"enable debug messages");
  47
  48 #define dprintk(fmt, arg...)    if (debug)                      \
  49         printk(KERN_DEBUG "%s/empress: " fmt, dev->name , ## arg)
  50
  51 /* ------------------------------------------------------------------ */
  52
  53 static void ts_reset_encoder(struct saa7134_dev* dev)
  54 {
  55         if (!dev->empress_started)
  56                 return;
  57
  58         saa_writeb(SAA7134_SPECIAL_MODE, 0x00);
  59         msleep(10);
  60         saa_writeb(SAA7134_SPECIAL_MODE, 0x01);
  61         msleep(100);
  62         dev->empress_started = 0;
  63 }
  64
  65 static int ts_init_encoder(struct saa7134_dev* dev)
  66 {
  67         struct v4l2_ext_controls ctrls = { V4L2_CTRL_CLASS_MPEG, 0 };
  68
  69         ts_reset_encoder(dev);
  70         saa7134_i2c_call_clients(dev, VIDIOC_S_EXT_CTRLS, &ctrls);
  71         dev->empress_started = 1;
  72         return 0;
  73 }
  74
  75 /* ------------------------------------------------------------------ */
  76
  77 static int ts_open(struct inode *inode, struct file *file)
  78 {
  79         int minor = iminor(inode);
  80         struct saa7134_dev *h,*dev = NULL;
  81         struct list_head *list;
  82         int err;
  83
  84         list_for_each(list,&saa7134_devlist) {
  85                 h = list_entry(list, struct saa7134_dev, devlist);
  86                 if (h->empress_dev && h->empress_dev->minor == minor)
  87                         dev = h;
  88         }
  89         if (NULL == dev)
  90                 return -ENODEV;
  91
  92         dprintk("open minor=%d\n",minor);
  93         err = -EBUSY;
  94         if (!mutex_trylock(&dev->empress_tsq.lock))
  95                 goto done;
  96         if (dev->empress_users)
  97                 goto done_up;
  98
  99         /* Unmute audio */
 100         saa_writeb(SAA7134_AUDIO_MUTE_CTRL,
 101                 saa_readb(SAA7134_AUDIO_MUTE_CTRL) & ~(1 << 6));
 102
 103         dev->empress_users++;
 104         file->private_data = dev;
 105         err = 0;
 106
 107 done_up:
 108         mutex_unlock(&dev->empress_tsq.lock);
 109 done:
 110         return err;
 111 }
 112
 113 static int ts_release(struct inode *inode, struct file *file)
 114 {
 115         struct saa7134_dev *dev = file->private_data;
 116
 117         if (dev->empress_tsq.streaming)
 118                 videobuf_streamoff(&dev->empress_tsq);
 119         mutex_lock(&dev->empress_tsq.lock);
 120         if (dev->empress_tsq.reading)
 121                 videobuf_read_stop(&dev->empress_tsq);
 122         videobuf_mmap_free(&dev->empress_tsq);
 123         dev->empress_users--;
 124
 125         /* stop the encoder */
 126         ts_reset_encoder(dev);
 127
 128         /* Mute audio */
 129         saa_writeb(SAA7134_AUDIO_MUTE_CTRL,
 130                 saa_readb(SAA7134_AUDIO_MUTE_CTRL) | (1 << 6));
 131
 132         mutex_unlock(&dev->empress_tsq.lock);
 133         return 0;
 134 }
 135
 136 static ssize_t
 137 ts_read(struct file *file, char __user *data, size_t count, loff_t *ppos)
 138 {
 139         struct saa7134_dev *dev = file->private_data;
 140
 141         if (!dev->empress_started)
 142                 ts_init_encoder(dev);
 143
 144         return videobuf_read_stream(&dev->empress_tsq,
 145                                     data, count, ppos, 0,
 146                                     file->f_flags & O_NONBLOCK);
 147 }
 148
 149 static unsigned int
 150 ts_poll(struct file *file, struct poll_table_struct *wait)
 151 {
 152         struct saa7134_dev *dev = file->private_data;
 153
 154         return videobuf_poll_stream(file, &dev->empress_tsq, wait);
 155 }
 156
 157
 158 static int
 159 ts_mmap(struct file *file, struct vm_area_struct * vma)
 160 {
 161         struct saa7134_dev *dev = file->private_data;
 162
 163         return videobuf_mmap_mapper(&dev->empress_tsq, vma);
 164 }
 165
 166 /*
 167  * This function is _not_ called directly, but from
 168  * video_generic_ioctl (and maybe others).  userspace
 169  * copying is done already, arg is a kernel pointer.
 170  */
 171 static int ts_do_ioctl(struct inode *inode, struct file *file,
 172                        unsigned int cmd, void *arg)
 173 {
 174         struct saa7134_dev *dev = file->private_data;
 175         struct v4l2_ext_controls *ctrls = arg;
 176
 177         if (debug > 1)
 178                 v4l_print_ioctl(dev->name,cmd);
 179         switch (cmd) {
 180         case VIDIOC_QUERYCAP:
 181         {
 182                 struct v4l2_capability *cap = arg;
 183
 184                 memset(cap,0,sizeof(*cap));
 185                 strcpy(cap->driver, "saa7134");
 186                 strlcpy(cap->card, saa7134_boards[dev->board].name,
 187                         sizeof(cap->card));
 188                 sprintf(cap->bus_info,"PCI:%s",pci_name(dev->pci));
 189                 cap->version = SAA7134_VERSION_CODE;
 190                 cap->capabilities =
 191                         V4L2_CAP_VIDEO_CAPTURE |
 192                         V4L2_CAP_READWRITE |
 193                         V4L2_CAP_STREAMING;
 194                 return 0;
 195         }
 196
 197         /* --- input switching --------------------------------------- */
 198         case VIDIOC_ENUMINPUT:
 199         {
 200                 struct v4l2_input *i = arg;
 201
 202                 if (i->index != 0)
 203                         return -EINVAL;
 204                 i->type = V4L2_INPUT_TYPE_CAMERA;
 205                 strcpy(i->name,"CCIR656");
 206                 return 0;
 207         }
 208         case VIDIOC_G_INPUT:
 209         {
 210                 int *i = arg;
 211                 *i = 0;
 212                 return 0;
 213         }
 214         case VIDIOC_S_INPUT:
 215         {
 216                 int *i = arg;
 217
 218                 if (*i != 0)
 219                         return -EINVAL;
 220                 return 0;
 221         }
 222         /* --- capture ioctls ---------------------------------------- */
 223
 224         case VIDIOC_ENUM_FMT:
 225         {
 226                 struct v4l2_fmtdesc *f = arg;
 227                 int index;
 228
 229                 index = f->index;
 230                 if (index != 0)
 231                         return -EINVAL;
 232
 233                 memset(f,0,sizeof(*f));
 234                 f->index = index;
 235                 strlcpy(f->description, "MPEG TS", sizeof(f->description));
 236                 f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 237                 f->pixelformat = V4L2_PIX_FMT_MPEG;
 238                 return 0;
 239         }
 240
 241         case VIDIOC_G_FMT:
 242         {
 243                 struct v4l2_format *f = arg;
 244
 245                 memset(f,0,sizeof(*f));
 246                 f->type = V4L2_BUF_TYPE_VIDEO_CAPTURE;
 247
 248                 saa7134_i2c_call_clients(dev, cmd, arg);
 249                 f->fmt.pix.pixelformat  = V4L2_PIX_FMT_MPEG;
 250                 f->fmt.pix.sizeimage    = TS_PACKET_SIZE * dev->ts.nr_packets;
 251                 return 0;
 252         }
 253
 254         case VIDIOC_S_FMT:
 255         {
 256                 struct v4l2_format *f = arg;
 257
 258                 if (f->type != V4L2_BUF_TYPE_VIDEO_CAPTURE)
 259                     return -EINVAL;
 260
 261                 saa7134_i2c_call_clients(dev, cmd, arg);
 262                 f->fmt.pix.pixelformat  = V4L2_PIX_FMT_MPEG;
 263                 f->fmt.pix.sizeimage    = TS_PACKET_SIZE* dev->ts.nr_packets;
 264                 return 0;
 265         }
 266
 267         case VIDIOC_REQBUFS:
 268                 return videobuf_reqbufs(&dev->empress_tsq,arg);
 269
 270         case VIDIOC_QUERYBUF:
 271                 return videobuf_querybuf(&dev->empress_tsq,arg);
 272
 273         case VIDIOC_QBUF:
 274                 return videobuf_qbuf(&dev->empress_tsq,arg);
 275
 276         case VIDIOC_DQBUF:
 277                 return videobuf_dqbuf(&dev->empress_tsq,arg,
 278                                       file->f_flags & O_NONBLOCK);
 279
 280         case VIDIOC_STREAMON:
 281                 return videobuf_streamon(&dev->empress_tsq);
 282
 283         case VIDIOC_STREAMOFF:
 284                 return videobuf_streamoff(&dev->empress_tsq);
 285
 286         case VIDIOC_QUERYCTRL:
 287         case VIDIOC_G_CTRL:
 288         case VIDIOC_S_CTRL:
 289                 return saa7134_common_ioctl(dev, cmd, arg);
 290
 291         case VIDIOC_S_MPEGCOMP:
 292                 printk(KERN_WARNING "VIDIOC_S_MPEGCOMP is obsolete. "
 293                                     "Replace with VIDIOC_S_EXT_CTRLS!");
 294                 saa7134_i2c_call_clients(dev, VIDIOC_S_MPEGCOMP, arg);
 295                 ts_init_encoder(dev);
 296                 return 0;
 297         case VIDIOC_G_MPEGCOMP:
 298                 printk(KERN_WARNING "VIDIOC_G_MPEGCOMP is obsolete. "
 299                                     "Replace with VIDIOC_G_EXT_CTRLS!");
 300                 saa7134_i2c_call_clients(dev, VIDIOC_G_MPEGCOMP, arg);
 301                 return 0;
 302         case VIDIOC_S_EXT_CTRLS:
 303                 /* count == 0 is abused in saa6752hs.c, so that special
 304                    case is handled here explicitly. */
 305                 if (ctrls->count == 0)
 306                         return 0;
 307                 if (ctrls->ctrl_class != V4L2_CTRL_CLASS_MPEG)
 308                         return -EINVAL;
 309                 saa7134_i2c_call_clients(dev, VIDIOC_S_EXT_CTRLS, arg);
 310                 ts_init_encoder(dev);
 311                 return 0;
 312         case VIDIOC_G_EXT_CTRLS:
 313                 if (ctrls->ctrl_class != V4L2_CTRL_CLASS_MPEG)
 314                         return -EINVAL;
 315                 saa7134_i2c_call_clients(dev, VIDIOC_G_EXT_CTRLS, arg);
 316                 return 0;
 317
 318         default:
 319                 return -ENOIOCTLCMD;
 320         }
 321         return 0;
 322 }
 323
 324 static int ts_ioctl(struct inode *inode, struct file *file,
 325                      unsigned int cmd, unsigned long arg)
 326 {
 327         return video_usercopy(inode, file, cmd, arg, ts_do_ioctl);
 328 }
 329
 330 static const struct file_operations ts_fops =
 331 {
 332         .owner    = THIS_MODULE,
 333         .open     = ts_open,
 334         .release  = ts_release,
 335         .read     = ts_read,
 336         .poll     = ts_poll,
 337         .mmap     = ts_mmap,
 338         .ioctl    = ts_ioctl,
 339         .llseek   = no_llseek,
 340 };
 341
 342 /* ----------------------------------------------------------- */
 343
 344 static struct video_device saa7134_empress_template =
 345 {
 346         .name          = "saa7134-empress",
 347         .type          = 0 /* FIXME */,
 348         .type2         = 0 /* FIXME */,
 349         .hardware      = 0,
 350         .fops          = &ts_fops,
 351         .minor         = -1,
 352 };
 353
 354 static void empress_signal_update(struct work_struct *work)
 355 {
 356         struct saa7134_dev* dev =
 357                 container_of(work, struct saa7134_dev, empress_workqueue);
 358
 359         if (dev->nosignal) {
 360                 dprintk("no video signal\n");
 361                 ts_reset_encoder(dev);
 362         } else {
 363                 dprintk("video signal acquired\n");
 364                 if (dev->empress_users)
 365                         ts_init_encoder(dev);
 366         }
 367 }
 368
 369 static void empress_signal_change(struct saa7134_dev *dev)
 370 {
 371         schedule_work(&dev->empress_workqueue);
 372 }
 373
 374
 375 static int empress_init(struct saa7134_dev *dev)
 376 {
 377         int err;
 378
 379         dprintk("%s: %s\n",dev->name,__FUNCTION__);
 380         dev->empress_dev = video_device_alloc();
 381         if (NULL == dev->empress_dev)
 382                 return -ENOMEM;
 383         *(dev->empress_dev) = saa7134_empress_template;
 384         dev->empress_dev->dev     = &dev->pci->dev;
 385         dev->empress_dev->release = video_device_release;
 386         snprintf(dev->empress_dev->name, sizeof(dev->empress_dev->name),
 387                  "%s empress (%s)", dev->name,
 388                  saa7134_boards[dev->board].name);
 389
 390         INIT_WORK(&dev->empress_workqueue, empress_signal_update);
 391
 392         err = video_register_device(dev->empress_dev,VFL_TYPE_GRABBER,
 393                                     empress_nr[dev->nr]);
 394         if (err < 0) {
 395                 printk(KERN_INFO "%s: can't register video device\n",
 396                        dev->name);
 397                 video_device_release(dev->empress_dev);
 398                 dev->empress_dev = NULL;
 399                 return err;
 400         }
 401         printk(KERN_INFO "%s: registered device video%d [mpeg]\n",
 402                dev->name,dev->empress_dev->minor & 0x1f);
 403
 404         videobuf_queue_init(&dev->empress_tsq, &saa7134_ts_qops,
 405                             dev->pci, &dev->slock,
 406                             V4L2_BUF_TYPE_VIDEO_CAPTURE,
 407                             V4L2_FIELD_ALTERNATE,
 408                             sizeof(struct saa7134_buf),
 409                             dev);
 410
 411         empress_signal_update(&dev->empress_workqueue);
 412         return 0;
 413 }
 414
 415 static int empress_fini(struct saa7134_dev *dev)
 416 {
 417         dprintk("%s: %s\n",dev->name,__FUNCTION__);
 418
 419         if (NULL == dev->empress_dev)
 420                 return 0;
 421         flush_scheduled_work();
 422         video_unregister_device(dev->empress_dev);
 423         dev->empress_dev = NULL;
 424         return 0;
 425 }
 426
 427 static struct saa7134_mpeg_ops empress_ops = {
 428         .type          = SAA7134_MPEG_EMPRESS,
 429         .init          = empress_init,
 430         .fini          = empress_fini,
 431         .signal_change = empress_signal_change,
 432 };
 433
 434 static int __init empress_register(void)
 435 {
 436         return saa7134_ts_register(&empress_ops);
 437 }
 438
 439 static void __exit empress_unregister(void)
 440 {
 441         saa7134_ts_unregister(&empress_ops);
 442 }
 443
 444 module_init(empress_register);
 445 module_exit(empress_unregister);
 446
 447 /* ----------------------------------------------------------- */
 448 /*
 449  * Local variables:
 450  * c-basic-offset: 8
 451  * End:
 452  */