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 mantis_gpio_set_bits(mantis, config->power, POWER_ON); 51 msleep(100); 52 mantis_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 mantis_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 mantis_gpio_set_bits(mantis, config->reset, 0); 77 msleep(100); 78 mantis_gpio_set_bits(mantis, config->reset, 0); 79 msleep(100); 80 mantis_gpio_set_bits(mantis, config->reset, 1); 81 msleep(100); 82 mantis_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 tasklet_enable(&mantis->tasklet); 121 } 122 123 return mantis->feeds; 124 } 125 126 static int mantis_dvb_stop_feed(struct dvb_demux_feed *dvbdmxfeed) 127 { 128 struct dvb_demux *dvbdmx = dvbdmxfeed->demux; 129 struct mantis_pci *mantis = dvbdmx->priv; 130 131 dprintk(MANTIS_DEBUG, 1, "Mantis DVB Stop feed"); 132 if (!dvbdmx->dmx.frontend) { 133 dprintk(MANTIS_DEBUG, 1, "no frontend ?"); 134 return -EINVAL; 135 } 136 137 mantis->feeds--; 138 if (mantis->feeds == 0) { 139 dprintk(MANTIS_DEBUG, 1, "mantis stop feed and dma"); 140 tasklet_disable(&mantis->tasklet); 141 mantis_dma_stop(mantis); 142 } 143 144 return 0; 145 } 146 147 int mantis_dvb_init(struct mantis_pci *mantis) 148 { 149 struct mantis_hwconfig *config = mantis->hwconfig; 150 int result = -1; 151 152 dprintk(MANTIS_DEBUG, 1, "dvb_register_adapter"); 153 154 result = dvb_register_adapter(&mantis->dvb_adapter, 155 "Mantis DVB adapter", 156 THIS_MODULE, 157 &mantis->pdev->dev, 158 adapter_nr); 159 160 if (result < 0) { 161 162 dprintk(MANTIS_ERROR, 1, "Error registering adapter"); 163 return -ENODEV; 164 } 165 166 mantis->dvb_adapter.priv = mantis; 167 mantis->demux.dmx.capabilities = DMX_TS_FILTERING | 168 DMX_SECTION_FILTERING | 169 DMX_MEMORY_BASED_FILTERING; 170 171 mantis->demux.priv = mantis; 172 mantis->demux.filternum = 256; 173 mantis->demux.feednum = 256; 174 mantis->demux.start_feed = mantis_dvb_start_feed; 175 mantis->demux.stop_feed = mantis_dvb_stop_feed; 176 mantis->demux.write_to_decoder = NULL; 177 178 dprintk(MANTIS_DEBUG, 1, "dvb_dmx_init"); 179 result = dvb_dmx_init(&mantis->demux); 180 if (result < 0) { 181 dprintk(MANTIS_ERROR, 1, "dvb_dmx_init failed, ERROR=%d", result); 182 183 goto err0; 184 } 185 186 mantis->dmxdev.filternum = 256; 187 mantis->dmxdev.demux = &mantis->demux.dmx; 188 mantis->dmxdev.capabilities = 0; 189 dprintk(MANTIS_DEBUG, 1, "dvb_dmxdev_init"); 190 191 result = dvb_dmxdev_init(&mantis->dmxdev, &mantis->dvb_adapter); 192 if (result < 0) { 193 194 dprintk(MANTIS_ERROR, 1, "dvb_dmxdev_init failed, ERROR=%d", result); 195 goto err1; 196 } 197 198 mantis->fe_hw.source = DMX_FRONTEND_0; 199 result = mantis->demux.dmx.add_frontend(&mantis->demux.dmx, &mantis->fe_hw); 200 if (result < 0) { 201 202 dprintk(MANTIS_ERROR, 1, "dvb_dmx_init failed, ERROR=%d", result); 203 goto err2; 204 } 205 206 mantis->fe_mem.source = DMX_MEMORY_FE; 207 result = mantis->demux.dmx.add_frontend(&mantis->demux.dmx, &mantis->fe_mem); 208 if (result < 0) { 209 dprintk(MANTIS_ERROR, 1, "dvb_dmx_init failed, ERROR=%d", result); 210 goto err3; 211 } 212 213 result = mantis->demux.dmx.connect_frontend(&mantis->demux.dmx, &mantis->fe_hw); 214 if (result < 0) { 215 dprintk(MANTIS_ERROR, 1, "dvb_dmx_init failed, ERROR=%d", result); 216 goto err4; 217 } 218 219 dvb_net_init(&mantis->dvb_adapter, &mantis->dvbnet, &mantis->demux.dmx); 220 tasklet_init(&mantis->tasklet, mantis_dma_xfer, (unsigned long) mantis); 221 tasklet_disable(&mantis->tasklet); 222 if (mantis->hwconfig) { 223 result = config->frontend_init(mantis, mantis->fe); 224 if (result < 0) { 225 dprintk(MANTIS_ERROR, 1, "!!! NO Frontends found !!!"); 226 goto err5; 227 } else { 228 if (mantis->fe == NULL) { 229 result = -ENOMEM; 230 dprintk(MANTIS_ERROR, 1, "FE <NULL>"); 231 goto err5; 232 } 233 result = dvb_register_frontend(&mantis->dvb_adapter, mantis->fe); 234 if (result) { 235 dprintk(MANTIS_ERROR, 1, "ERROR: Frontend registration failed"); 236 237 if (mantis->fe->ops.release) 238 mantis->fe->ops.release(mantis->fe); 239 240 mantis->fe = NULL; 241 goto err5; 242 } 243 } 244 } 245 246 return 0; 247 248 /* Error conditions .. */ 249 err5: 250 tasklet_kill(&mantis->tasklet); 251 dvb_net_release(&mantis->dvbnet); 252 if (mantis->fe) { 253 dvb_unregister_frontend(mantis->fe); 254 dvb_frontend_detach(mantis->fe); 255 } 256 err4: 257 mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_mem); 258 259 err3: 260 mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_hw); 261 262 err2: 263 dvb_dmxdev_release(&mantis->dmxdev); 264 265 err1: 266 dvb_dmx_release(&mantis->demux); 267 268 err0: 269 dvb_unregister_adapter(&mantis->dvb_adapter); 270 271 return result; 272 } 273 EXPORT_SYMBOL_GPL(mantis_dvb_init); 274 275 int mantis_dvb_exit(struct mantis_pci *mantis) 276 { 277 int err; 278 279 if (mantis->fe) { 280 /* mantis_ca_exit(mantis); */ 281 err = mantis_frontend_shutdown(mantis); 282 if (err != 0) 283 dprintk(MANTIS_ERROR, 1, "Frontend exit while POWER ON! <%d>", err); 284 dvb_unregister_frontend(mantis->fe); 285 dvb_frontend_detach(mantis->fe); 286 } 287 288 tasklet_kill(&mantis->tasklet); 289 dvb_net_release(&mantis->dvbnet); 290 291 mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_mem); 292 mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_hw); 293 294 dvb_dmxdev_release(&mantis->dmxdev); 295 dvb_dmx_release(&mantis->demux); 296 297 dprintk(MANTIS_DEBUG, 1, "dvb_unregister_adapter"); 298 dvb_unregister_adapter(&mantis->dvb_adapter); 299 300 return 0; 301 } 302 EXPORT_SYMBOL_GPL(mantis_dvb_exit); 303