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