release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/media/video/cx231xx/cx231xx-dvb.c

   1 /*
   2  DVB device driver for cx231xx
   3
   4  Copyright (C) 2008 <srinivasa.deevi at conexant dot com>
   5                 Based on em28xx driver
   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, or
  10    (at your option) any later version.
  11
  12    This program is distributed in the hope that it will be useful,
  13    but WITHOUT ANY WARRANTY; without even the implied warranty of
  14    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15    GNU General Public License for more details.
  16
  17    You should have received a copy of the GNU General Public License
  18    along with this program; if not, write to the Free Software
  19    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
  20  */
  21
  22 #include <linux/kernel.h>
  23 #include <linux/slab.h>
  24 #include <linux/usb.h>
  25
  26 #include "cx231xx.h"
  27 #include <media/v4l2-common.h>
  28 #include <media/videobuf-vmalloc.h>
  29
  30 #include "xc5000.h"
  31 #include "dvb_dummy_fe.h"
  32
  33 MODULE_DESCRIPTION("driver for cx231xx based DVB cards");
  34 MODULE_AUTHOR("Srinivasa Deevi <srinivasa.deevi@conexant.com>");
  35 MODULE_LICENSE("GPL");
  36
  37 static unsigned int debug;
  38 module_param(debug, int, 0644);
  39 MODULE_PARM_DESC(debug, "enable debug messages [dvb]");
  40
  41 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  42
  43 #define dprintk(level, fmt, arg...) do {                        \
  44 if (debug >= level)                                             \
  45         printk(KERN_DEBUG "%s/2-dvb: " fmt, dev->name, ## arg); \
  46 } while (0)
  47
  48 #define CX231XX_DVB_NUM_BUFS 5
  49 #define CX231XX_DVB_MAX_PACKETSIZE 564
  50 #define CX231XX_DVB_MAX_PACKETS 64
  51
  52 struct cx231xx_dvb {
  53         struct dvb_frontend *frontend;
  54
  55         /* feed count management */
  56         struct mutex lock;
  57         int nfeeds;
  58
  59         /* general boilerplate stuff */
  60         struct dvb_adapter adapter;
  61         struct dvb_demux demux;
  62         struct dmxdev dmxdev;
  63         struct dmx_frontend fe_hw;
  64         struct dmx_frontend fe_mem;
  65         struct dvb_net net;
  66 };
  67
  68 static inline void print_err_status(struct cx231xx *dev, int packet, int status)
  69 {
  70         char *errmsg = "Unknown";
  71
  72         switch (status) {
  73         case -ENOENT:
  74                 errmsg = "unlinked synchronuously";
  75                 break;
  76         case -ECONNRESET:
  77                 errmsg = "unlinked asynchronuously";
  78                 break;
  79         case -ENOSR:
  80                 errmsg = "Buffer error (overrun)";
  81                 break;
  82         case -EPIPE:
  83                 errmsg = "Stalled (device not responding)";
  84                 break;
  85         case -EOVERFLOW:
  86                 errmsg = "Babble (bad cable?)";
  87                 break;
  88         case -EPROTO:
  89                 errmsg = "Bit-stuff error (bad cable?)";
  90                 break;
  91         case -EILSEQ:
  92                 errmsg = "CRC/Timeout (could be anything)";
  93                 break;
  94         case -ETIME:
  95                 errmsg = "Device does not respond";
  96                 break;
  97         }
  98         if (packet < 0) {
  99                 dprintk(1, "URB status %d [%s].\n", status, errmsg);
 100         } else {
 101                 dprintk(1, "URB packet %d, status %d [%s].\n",
 102                         packet, status, errmsg);
 103         }
 104 }
 105
 106 static inline int dvb_isoc_copy(struct cx231xx *dev, struct urb *urb)
 107 {
 108         int i;
 109
 110         if (!dev)
 111                 return 0;
 112
 113         if ((dev->state & DEV_DISCONNECTED) || (dev->state & DEV_MISCONFIGURED))
 114                 return 0;
 115
 116         if (urb->status < 0) {
 117                 print_err_status(dev, -1, urb->status);
 118                 if (urb->status == -ENOENT)
 119                         return 0;
 120         }
 121
 122         for (i = 0; i < urb->number_of_packets; i++) {
 123                 int status = urb->iso_frame_desc[i].status;
 124
 125                 if (status < 0) {
 126                         print_err_status(dev, i, status);
 127                         if (urb->iso_frame_desc[i].status != -EPROTO)
 128                                 continue;
 129                 }
 130
 131                 dvb_dmx_swfilter(&dev->dvb->demux, urb->transfer_buffer +
 132                                  urb->iso_frame_desc[i].offset,
 133                                  urb->iso_frame_desc[i].actual_length);
 134         }
 135
 136         return 0;
 137 }
 138
 139 static int start_streaming(struct cx231xx_dvb *dvb)
 140 {
 141         int rc;
 142         struct cx231xx *dev = dvb->adapter.priv;
 143
 144         usb_set_interface(dev->udev, 0, 1);
 145         rc = cx231xx_set_mode(dev, CX231XX_DIGITAL_MODE);
 146         if (rc < 0)
 147                 return rc;
 148
 149         return cx231xx_init_isoc(dev, CX231XX_DVB_MAX_PACKETS,
 150                                  CX231XX_DVB_NUM_BUFS,
 151                                  CX231XX_DVB_MAX_PACKETSIZE, dvb_isoc_copy);
 152 }
 153
 154 static int stop_streaming(struct cx231xx_dvb *dvb)
 155 {
 156         struct cx231xx *dev = dvb->adapter.priv;
 157
 158         cx231xx_uninit_isoc(dev);
 159
 160         cx231xx_set_mode(dev, CX231XX_SUSPEND);
 161
 162         return 0;
 163 }
 164
 165 static int start_feed(struct dvb_demux_feed *feed)
 166 {
 167         struct dvb_demux *demux = feed->demux;
 168         struct cx231xx_dvb *dvb = demux->priv;
 169         int rc, ret;
 170
 171         if (!demux->dmx.frontend)
 172                 return -EINVAL;
 173
 174         mutex_lock(&dvb->lock);
 175         dvb->nfeeds++;
 176         rc = dvb->nfeeds;
 177
 178         if (dvb->nfeeds == 1) {
 179                 ret = start_streaming(dvb);
 180                 if (ret < 0)
 181                         rc = ret;
 182         }
 183
 184         mutex_unlock(&dvb->lock);
 185         return rc;
 186 }
 187
 188 static int stop_feed(struct dvb_demux_feed *feed)
 189 {
 190         struct dvb_demux *demux = feed->demux;
 191         struct cx231xx_dvb *dvb = demux->priv;
 192         int err = 0;
 193
 194         mutex_lock(&dvb->lock);
 195         dvb->nfeeds--;
 196
 197         if (0 == dvb->nfeeds)
 198                 err = stop_streaming(dvb);
 199
 200         mutex_unlock(&dvb->lock);
 201         return err;
 202 }
 203
 204 /* ------------------------------------------------------------------ */
 205 static int cx231xx_dvb_bus_ctrl(struct dvb_frontend *fe, int acquire)
 206 {
 207         struct cx231xx *dev = fe->dvb->priv;
 208
 209         if (acquire)
 210                 return cx231xx_set_mode(dev, CX231XX_DIGITAL_MODE);
 211         else
 212                 return cx231xx_set_mode(dev, CX231XX_SUSPEND);
 213 }
 214
 215 /* ------------------------------------------------------------------ */
 216
 217 static struct xc5000_config cnxt_rde250_tunerconfig = {
 218         .i2c_address = 0x61,
 219         .if_khz = 5380,
 220 };
 221
 222 /* ------------------------------------------------------------------ */
 223
 224 int cx231xx_set_analog_freq(struct cx231xx *dev, u32 freq)
 225 {
 226         int status = 0;
 227
 228         if ((dev->dvb != NULL) && (dev->dvb->frontend != NULL)) {
 229
 230                 struct dvb_tuner_ops *dops = &dev->dvb->frontend->ops.tuner_ops;
 231
 232                 if (dops->set_analog_params != NULL) {
 233                         struct analog_parameters params;
 234
 235                         params.frequency = freq;
 236                         params.std = dev->norm;
 237                         params.mode = 0;        /* 0- Air; 1 - cable */
 238                         /*params.audmode = ;       */
 239
 240                         /* Set the analog parameters to set the frequency */
 241                         cx231xx_info("Setting Frequency for XC5000\n");
 242                         dops->set_analog_params(dev->dvb->frontend, &params);
 243                 }
 244
 245         }
 246
 247         return status;
 248 }
 249
 250 int cx231xx_reset_analog_tuner(struct cx231xx *dev)
 251 {
 252         int status = 0;
 253
 254         if ((dev->dvb != NULL) && (dev->dvb->frontend != NULL)) {
 255
 256                 struct dvb_tuner_ops *dops = &dev->dvb->frontend->ops.tuner_ops;
 257
 258                 if (dops->init != NULL && !dev->xc_fw_load_done) {
 259
 260                         cx231xx_info("Reloading firmware for XC5000\n");
 261                         status = dops->init(dev->dvb->frontend);
 262                         if (status == 0) {
 263                                 dev->xc_fw_load_done = 1;
 264                                 cx231xx_info
 265                                     ("XC5000 firmware download completed\n");
 266                         } else {
 267                                 dev->xc_fw_load_done = 0;
 268                                 cx231xx_info
 269                                     ("XC5000 firmware download failed !!!\n");
 270                         }
 271                 }
 272
 273         }
 274
 275         return status;
 276 }
 277
 278 /* ------------------------------------------------------------------ */
 279
 280 static int register_dvb(struct cx231xx_dvb *dvb,
 281                         struct module *module,
 282                         struct cx231xx *dev, struct device *device)
 283 {
 284         int result;
 285
 286         mutex_init(&dvb->lock);
 287
 288         /* register adapter */
 289         result = dvb_register_adapter(&dvb->adapter, dev->name, module, device,
 290                                       adapter_nr);
 291         if (result < 0) {
 292                 printk(KERN_WARNING
 293                        "%s: dvb_register_adapter failed (errno = %d)\n",
 294                        dev->name, result);
 295                 goto fail_adapter;
 296         }
 297
 298         /* Ensure all frontends negotiate bus access */
 299         dvb->frontend->ops.ts_bus_ctrl = cx231xx_dvb_bus_ctrl;
 300
 301         dvb->adapter.priv = dev;
 302
 303         /* register frontend */
 304         result = dvb_register_frontend(&dvb->adapter, dvb->frontend);
 305         if (result < 0) {
 306                 printk(KERN_WARNING
 307                        "%s: dvb_register_frontend failed (errno = %d)\n",
 308                        dev->name, result);
 309                 goto fail_frontend;
 310         }
 311
 312         /* register demux stuff */
 313         dvb->demux.dmx.capabilities =
 314             DMX_TS_FILTERING | DMX_SECTION_FILTERING |
 315             DMX_MEMORY_BASED_FILTERING;
 316         dvb->demux.priv = dvb;
 317         dvb->demux.filternum = 256;
 318         dvb->demux.feednum = 256;
 319         dvb->demux.start_feed = start_feed;
 320         dvb->demux.stop_feed = stop_feed;
 321
 322         result = dvb_dmx_init(&dvb->demux);
 323         if (result < 0) {
 324                 printk(KERN_WARNING "%s: dvb_dmx_init failed (errno = %d)\n",
 325                        dev->name, result);
 326                 goto fail_dmx;
 327         }
 328
 329         dvb->dmxdev.filternum = 256;
 330         dvb->dmxdev.demux = &dvb->demux.dmx;
 331         dvb->dmxdev.capabilities = 0;
 332         result = dvb_dmxdev_init(&dvb->dmxdev, &dvb->adapter);
 333         if (result < 0) {
 334                 printk(KERN_WARNING "%s: dvb_dmxdev_init failed (errno = %d)\n",
 335                        dev->name, result);
 336                 goto fail_dmxdev;
 337         }
 338
 339         dvb->fe_hw.source = DMX_FRONTEND_0;
 340         result = dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->fe_hw);
 341         if (result < 0) {
 342                 printk(KERN_WARNING
 343                        "%s: add_frontend failed (DMX_FRONTEND_0, errno = %d)\n",
 344                        dev->name, result);
 345                 goto fail_fe_hw;
 346         }
 347
 348         dvb->fe_mem.source = DMX_MEMORY_FE;
 349         result = dvb->demux.dmx.add_frontend(&dvb->demux.dmx, &dvb->fe_mem);
 350         if (result < 0) {
 351                 printk(KERN_WARNING
 352                        "%s: add_frontend failed (DMX_MEMORY_FE, errno = %d)\n",
 353                        dev->name, result);
 354                 goto fail_fe_mem;
 355         }
 356
 357         result = dvb->demux.dmx.connect_frontend(&dvb->demux.dmx, &dvb->fe_hw);
 358         if (result < 0) {
 359                 printk(KERN_WARNING
 360                        "%s: connect_frontend failed (errno = %d)\n", dev->name,
 361                        result);
 362                 goto fail_fe_conn;
 363         }
 364
 365         /* register network adapter */
 366         dvb_net_init(&dvb->adapter, &dvb->net, &dvb->demux.dmx);
 367         return 0;
 368
 369 fail_fe_conn:
 370         dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
 371 fail_fe_mem:
 372         dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
 373 fail_fe_hw:
 374         dvb_dmxdev_release(&dvb->dmxdev);
 375 fail_dmxdev:
 376         dvb_dmx_release(&dvb->demux);
 377 fail_dmx:
 378         dvb_unregister_frontend(dvb->frontend);
 379 fail_frontend:
 380         dvb_frontend_detach(dvb->frontend);
 381         dvb_unregister_adapter(&dvb->adapter);
 382 fail_adapter:
 383         return result;
 384 }
 385
 386 static void unregister_dvb(struct cx231xx_dvb *dvb)
 387 {
 388         dvb_net_release(&dvb->net);
 389         dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_mem);
 390         dvb->demux.dmx.remove_frontend(&dvb->demux.dmx, &dvb->fe_hw);
 391         dvb_dmxdev_release(&dvb->dmxdev);
 392         dvb_dmx_release(&dvb->demux);
 393         dvb_unregister_frontend(dvb->frontend);
 394         dvb_frontend_detach(dvb->frontend);
 395         dvb_unregister_adapter(&dvb->adapter);
 396 }
 397
 398 static int dvb_init(struct cx231xx *dev)
 399 {
 400         int result = 0;
 401         struct cx231xx_dvb *dvb;
 402
 403         if (!dev->board.has_dvb) {
 404                 /* This device does not support the extension */
 405                 return 0;
 406         }
 407
 408         dvb = kzalloc(sizeof(struct cx231xx_dvb), GFP_KERNEL);
 409
 410         if (dvb == NULL) {
 411                 printk(KERN_INFO "cx231xx_dvb: memory allocation failed\n");
 412                 return -ENOMEM;
 413         }
 414         dev->dvb = dvb;
 415         dev->cx231xx_set_analog_freq = cx231xx_set_analog_freq;
 416         dev->cx231xx_reset_analog_tuner = cx231xx_reset_analog_tuner;
 417
 418         cx231xx_set_mode(dev, CX231XX_DIGITAL_MODE);
 419         /* init frontend */
 420         switch (dev->model) {
 421         case CX231XX_BOARD_CNXT_RDE_250:
 422
 423                 /* dev->dvb->frontend = dvb_attach(s5h1411_attach,
 424                    &dvico_s5h1411_config,
 425                    &dev->i2c_bus[1].i2c_adap); */
 426                 dev->dvb->frontend = dvb_attach(dvb_dummy_fe_ofdm_attach);
 427
 428                 if (dev->dvb->frontend == NULL) {
 429                         printk(DRIVER_NAME
 430                                ": Failed to attach dummy front end\n");
 431                         result = -EINVAL;
 432                         goto out_free;
 433                 }
 434
 435                 /* define general-purpose callback pointer */
 436                 dvb->frontend->callback = cx231xx_tuner_callback;
 437
 438                 if (!dvb_attach(xc5000_attach, dev->dvb->frontend,
 439                                &dev->i2c_bus[1].i2c_adap,
 440                                &cnxt_rde250_tunerconfig)) {
 441                         result = -EINVAL;
 442                         goto out_free;
 443                 }
 444
 445                 break;
 446         case CX231XX_BOARD_CNXT_RDU_250:
 447
 448                 dev->dvb->frontend = dvb_attach(dvb_dummy_fe_ofdm_attach);
 449
 450                 if (dev->dvb->frontend == NULL) {
 451                         printk(DRIVER_NAME
 452                                ": Failed to attach dummy front end\n");
 453                         result = -EINVAL;
 454                         goto out_free;
 455                 }
 456
 457                 /* define general-purpose callback pointer */
 458                 dvb->frontend->callback = cx231xx_tuner_callback;
 459
 460                 if (!dvb_attach(xc5000_attach, dev->dvb->frontend,
 461                                &dev->i2c_bus[1].i2c_adap,
 462                                &cnxt_rde250_tunerconfig)) {
 463                         result = -EINVAL;
 464                         goto out_free;
 465                 }
 466                 break;
 467
 468         default:
 469                 printk(KERN_ERR "%s/2: The frontend of your DVB/ATSC card"
 470                        " isn't supported yet\n", dev->name);
 471                 break;
 472         }
 473         if (NULL == dvb->frontend) {
 474                 printk(KERN_ERR
 475                        "%s/2: frontend initialization failed\n", dev->name);
 476                 result = -EINVAL;
 477                 goto out_free;
 478         }
 479
 480         /* register everything */
 481         result = register_dvb(dvb, THIS_MODULE, dev, &dev->udev->dev);
 482
 483         if (result < 0)
 484                 goto out_free;
 485
 486         cx231xx_set_mode(dev, CX231XX_SUSPEND);
 487         printk(KERN_INFO "Successfully loaded cx231xx-dvb\n");
 488         return 0;
 489
 490 out_free:
 491         cx231xx_set_mode(dev, CX231XX_SUSPEND);
 492         kfree(dvb);
 493         dev->dvb = NULL;
 494         return result;
 495 }
 496
 497 static int dvb_fini(struct cx231xx *dev)
 498 {
 499         if (!dev->board.has_dvb) {
 500                 /* This device does not support the extension */
 501                 return 0;
 502         }
 503
 504         if (dev->dvb) {
 505                 unregister_dvb(dev->dvb);
 506                 dev->dvb = NULL;
 507         }
 508
 509         return 0;
 510 }
 511
 512 static struct cx231xx_ops dvb_ops = {
 513         .id = CX231XX_DVB,
 514         .name = "Cx231xx dvb Extension",
 515         .init = dvb_init,
 516         .fini = dvb_fini,
 517 };
 518
 519 static int __init cx231xx_dvb_register(void)
 520 {
 521         return cx231xx_register_extension(&dvb_ops);
 522 }
 523
 524 static void __exit cx231xx_dvb_unregister(void)
 525 {
 526         cx231xx_unregister_extension(&dvb_ops);
 527 }
 528
 529 module_init(cx231xx_dvb_register);
 530 module_exit(cx231xx_dvb_unregister);