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