release/src-rt-6.x.4708/linux/linux-2.6.36/drivers/media/dvb/mantis/mantis_dvb.c

   1 /*
   2         Mantis PCI bridge driver
   3         Copyright (C) Manu Abraham (abraham.manu@gmail.com)
   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/kernel.h>
  21 #include <linux/bitops.h>
  22
  23 #include <linux/signal.h>
  24 #include <linux/sched.h>
  25 #include <linux/interrupt.h>
  26 #include <linux/pci.h>
  27 #include <linux/i2c.h>
  28
  29 #include "dmxdev.h"
  30 #include "dvbdev.h"
  31 #include "dvb_demux.h"
  32 #include "dvb_frontend.h"
  33 #include "dvb_net.h"
  34
  35 #include "mantis_common.h"
  36 #include "mantis_dma.h"
  37 #include "mantis_ca.h"
  38 #include "mantis_ioc.h"
  39 #include "mantis_dvb.h"
  40
  41 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
  42
  43 int mantis_frontend_power(struct mantis_pci *mantis, enum mantis_power power)
  44 {
  45         struct mantis_hwconfig *config = mantis->hwconfig;
  46
  47         switch (power) {
  48         case POWER_ON:
  49                 dprintk(MANTIS_DEBUG, 1, "Power ON");
  50                 gpio_set_bits(mantis, config->power, POWER_ON);
  51                 msleep(100);
  52                 gpio_set_bits(mantis, config->power, POWER_ON);
  53                 msleep(100);
  54                 break;
  55
  56         case POWER_OFF:
  57                 dprintk(MANTIS_DEBUG, 1, "Power OFF");
  58                 gpio_set_bits(mantis, config->power, POWER_OFF);
  59                 msleep(100);
  60                 break;
  61
  62         default:
  63                 dprintk(MANTIS_DEBUG, 1, "Unknown state <%02x>", power);
  64                 return -1;
  65         }
  66
  67         return 0;
  68 }
  69 EXPORT_SYMBOL_GPL(mantis_frontend_power);
  70
  71 void mantis_frontend_soft_reset(struct mantis_pci *mantis)
  72 {
  73         struct mantis_hwconfig *config = mantis->hwconfig;
  74
  75         dprintk(MANTIS_DEBUG, 1, "Frontend RESET");
  76         gpio_set_bits(mantis, config->reset, 0);
  77         msleep(100);
  78         gpio_set_bits(mantis, config->reset, 0);
  79         msleep(100);
  80         gpio_set_bits(mantis, config->reset, 1);
  81         msleep(100);
  82         gpio_set_bits(mantis, config->reset, 1);
  83         msleep(100);
  84
  85         return;
  86 }
  87 EXPORT_SYMBOL_GPL(mantis_frontend_soft_reset);
  88
  89 static int mantis_frontend_shutdown(struct mantis_pci *mantis)
  90 {
  91         int err;
  92
  93         mantis_frontend_soft_reset(mantis);
  94         err = mantis_frontend_power(mantis, POWER_OFF);
  95         if (err != 0) {
  96                 dprintk(MANTIS_ERROR, 1, "Frontend POWER OFF failed! <%d>", err);
  97                 return 1;
  98         }
  99
 100         return 0;
 101 }
 102
 103 static int mantis_dvb_start_feed(struct dvb_demux_feed *dvbdmxfeed)
 104 {
 105         struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
 106         struct mantis_pci *mantis = dvbdmx->priv;
 107
 108         dprintk(MANTIS_DEBUG, 1, "Mantis DVB Start feed");
 109         if (!dvbdmx->dmx.frontend) {
 110                 dprintk(MANTIS_DEBUG, 1, "no frontend ?");
 111                 return -EINVAL;
 112         }
 113
 114         mantis->feeds++;
 115         dprintk(MANTIS_DEBUG, 1, "mantis start feed, feeds=%d", mantis->feeds);
 116
 117         if (mantis->feeds == 1)  {
 118                 dprintk(MANTIS_DEBUG, 1, "mantis start feed & dma");
 119                 mantis_dma_start(mantis);
 120         }
 121
 122         return mantis->feeds;
 123 }
 124
 125 static int mantis_dvb_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
 126 {
 127         struct dvb_demux *dvbdmx = dvbdmxfeed->demux;
 128         struct mantis_pci *mantis = dvbdmx->priv;
 129
 130         dprintk(MANTIS_DEBUG, 1, "Mantis DVB Stop feed");
 131         if (!dvbdmx->dmx.frontend) {
 132                 dprintk(MANTIS_DEBUG, 1, "no frontend ?");
 133                 return -EINVAL;
 134         }
 135
 136         mantis->feeds--;
 137         if (mantis->feeds == 0) {
 138                 dprintk(MANTIS_DEBUG, 1, "mantis stop feed and dma");
 139                 mantis_dma_stop(mantis);
 140         }
 141
 142         return 0;
 143 }
 144
 145 int __devinit mantis_dvb_init(struct mantis_pci *mantis)
 146 {
 147         struct mantis_hwconfig *config = mantis->hwconfig;
 148         int result = -1;
 149
 150         dprintk(MANTIS_DEBUG, 1, "dvb_register_adapter");
 151
 152         result = dvb_register_adapter(&mantis->dvb_adapter,
 153                                       "Mantis DVB adapter",
 154                                       THIS_MODULE,
 155                                       &mantis->pdev->dev,
 156                                       adapter_nr);
 157
 158         if (result < 0) {
 159
 160                 dprintk(MANTIS_ERROR, 1, "Error registering adapter");
 161                 return -ENODEV;
 162         }
 163
 164         mantis->dvb_adapter.priv        = mantis;
 165         mantis->demux.dmx.capabilities  = DMX_TS_FILTERING      |
 166                                          DMX_SECTION_FILTERING  |
 167                                          DMX_MEMORY_BASED_FILTERING;
 168
 169         mantis->demux.priv              = mantis;
 170         mantis->demux.filternum         = 256;
 171         mantis->demux.feednum           = 256;
 172         mantis->demux.start_feed        = mantis_dvb_start_feed;
 173         mantis->demux.stop_feed         = mantis_dvb_stop_feed;
 174         mantis->demux.write_to_decoder  = NULL;
 175
 176         dprintk(MANTIS_DEBUG, 1, "dvb_dmx_init");
 177         result = dvb_dmx_init(&mantis->demux);
 178         if (result < 0) {
 179                 dprintk(MANTIS_ERROR, 1, "dvb_dmx_init failed, ERROR=%d", result);
 180
 181                 goto err0;
 182         }
 183
 184         mantis->dmxdev.filternum        = 256;
 185         mantis->dmxdev.demux            = &mantis->demux.dmx;
 186         mantis->dmxdev.capabilities     = 0;
 187         dprintk(MANTIS_DEBUG, 1, "dvb_dmxdev_init");
 188
 189         result = dvb_dmxdev_init(&mantis->dmxdev, &mantis->dvb_adapter);
 190         if (result < 0) {
 191
 192                 dprintk(MANTIS_ERROR, 1, "dvb_dmxdev_init failed, ERROR=%d", result);
 193                 goto err1;
 194         }
 195
 196         mantis->fe_hw.source            = DMX_FRONTEND_0;
 197         result = mantis->demux.dmx.add_frontend(&mantis->demux.dmx, &mantis->fe_hw);
 198         if (result < 0) {
 199
 200                 dprintk(MANTIS_ERROR, 1, "dvb_dmx_init failed, ERROR=%d", result);
 201                 goto err2;
 202         }
 203
 204         mantis->fe_mem.source           = DMX_MEMORY_FE;
 205         result = mantis->demux.dmx.add_frontend(&mantis->demux.dmx, &mantis->fe_mem);
 206         if (result < 0) {
 207                 dprintk(MANTIS_ERROR, 1, "dvb_dmx_init failed, ERROR=%d", result);
 208                 goto err3;
 209         }
 210
 211         result = mantis->demux.dmx.connect_frontend(&mantis->demux.dmx, &mantis->fe_hw);
 212         if (result < 0) {
 213                 dprintk(MANTIS_ERROR, 1, "dvb_dmx_init failed, ERROR=%d", result);
 214                 goto err4;
 215         }
 216
 217         dvb_net_init(&mantis->dvb_adapter, &mantis->dvbnet, &mantis->demux.dmx);
 218         tasklet_init(&mantis->tasklet, mantis_dma_xfer, (unsigned long) mantis);
 219         if (mantis->hwconfig) {
 220                 result = config->frontend_init(mantis, mantis->fe);
 221                 if (result < 0) {
 222                         dprintk(MANTIS_ERROR, 1, "!!! NO Frontends found !!!");
 223                         goto err5;
 224                 } else {
 225                         if (mantis->fe == NULL) {
 226                                 dprintk(MANTIS_ERROR, 1, "FE <NULL>");
 227                                 goto err5;
 228                         }
 229
 230                         if (dvb_register_frontend(&mantis->dvb_adapter, mantis->fe)) {
 231                                 dprintk(MANTIS_ERROR, 1, "ERROR: Frontend registration failed");
 232
 233                                 if (mantis->fe->ops.release)
 234                                         mantis->fe->ops.release(mantis->fe);
 235
 236                                 mantis->fe = NULL;
 237                                 goto err5;
 238                         }
 239                 }
 240         }
 241
 242         return 0;
 243
 244         /* Error conditions ..  */
 245 err5:
 246         tasklet_kill(&mantis->tasklet);
 247         dvb_net_release(&mantis->dvbnet);
 248         dvb_unregister_frontend(mantis->fe);
 249         dvb_frontend_detach(mantis->fe);
 250 err4:
 251         mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_mem);
 252
 253 err3:
 254         mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_hw);
 255
 256 err2:
 257         dvb_dmxdev_release(&mantis->dmxdev);
 258
 259 err1:
 260         dvb_dmx_release(&mantis->demux);
 261
 262 err0:
 263         dvb_unregister_adapter(&mantis->dvb_adapter);
 264
 265         return result;
 266 }
 267 EXPORT_SYMBOL_GPL(mantis_dvb_init);
 268
 269 int __devexit mantis_dvb_exit(struct mantis_pci *mantis)
 270 {
 271         int err;
 272
 273         if (mantis->fe) {
 274                 /* mantis_ca_exit(mantis); */
 275                 err = mantis_frontend_shutdown(mantis);
 276                 if (err != 0)
 277                         dprintk(MANTIS_ERROR, 1, "Frontend exit while POWER ON! <%d>", err);
 278                 dvb_unregister_frontend(mantis->fe);
 279                 dvb_frontend_detach(mantis->fe);
 280         }
 281
 282         tasklet_kill(&mantis->tasklet);
 283         dvb_net_release(&mantis->dvbnet);
 284
 285         mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_mem);
 286         mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_hw);
 287
 288         dvb_dmxdev_release(&mantis->dmxdev);
 289         dvb_dmx_release(&mantis->demux);
 290
 291         dprintk(MANTIS_DEBUG, 1, "dvb_unregister_adapter");
 292         dvb_unregister_adapter(&mantis->dvb_adapter);
 293
 294         return 0;
 295 }
 296 EXPORT_SYMBOL_GPL(mantis_dvb_exit);