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 
mantis_frontend_power(struct mantis_pci * mantis,enum mantis_power power)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 
mantis_frontend_soft_reset(struct mantis_pci * mantis)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 
mantis_frontend_shutdown(struct mantis_pci * mantis)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 
mantis_dvb_start_feed(struct dvb_demux_feed * dvbdmxfeed)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 
mantis_dvb_stop_feed(struct dvb_demux_feed * dvbdmxfeed)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 
mantis_dvb_init(struct mantis_pci * mantis)147 int __devinit 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 				dprintk(MANTIS_ERROR, 1, "FE <NULL>");
230 				goto err5;
231 			}
232 
233 			if (dvb_register_frontend(&mantis->dvb_adapter, mantis->fe)) {
234 				dprintk(MANTIS_ERROR, 1, "ERROR: Frontend registration failed");
235 
236 				if (mantis->fe->ops.release)
237 					mantis->fe->ops.release(mantis->fe);
238 
239 				mantis->fe = NULL;
240 				goto err5;
241 			}
242 		}
243 	}
244 
245 	return 0;
246 
247 	/* Error conditions ..	*/
248 err5:
249 	tasklet_kill(&mantis->tasklet);
250 	dvb_net_release(&mantis->dvbnet);
251 	dvb_unregister_frontend(mantis->fe);
252 	dvb_frontend_detach(mantis->fe);
253 err4:
254 	mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_mem);
255 
256 err3:
257 	mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_hw);
258 
259 err2:
260 	dvb_dmxdev_release(&mantis->dmxdev);
261 
262 err1:
263 	dvb_dmx_release(&mantis->demux);
264 
265 err0:
266 	dvb_unregister_adapter(&mantis->dvb_adapter);
267 
268 	return result;
269 }
270 EXPORT_SYMBOL_GPL(mantis_dvb_init);
271 
mantis_dvb_exit(struct mantis_pci * mantis)272 int __devexit mantis_dvb_exit(struct mantis_pci *mantis)
273 {
274 	int err;
275 
276 	if (mantis->fe) {
277 		/* mantis_ca_exit(mantis); */
278 		err = mantis_frontend_shutdown(mantis);
279 		if (err != 0)
280 			dprintk(MANTIS_ERROR, 1, "Frontend exit while POWER ON! <%d>", err);
281 		dvb_unregister_frontend(mantis->fe);
282 		dvb_frontend_detach(mantis->fe);
283 	}
284 
285 	tasklet_kill(&mantis->tasklet);
286 	dvb_net_release(&mantis->dvbnet);
287 
288 	mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_mem);
289 	mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_hw);
290 
291 	dvb_dmxdev_release(&mantis->dmxdev);
292 	dvb_dmx_release(&mantis->demux);
293 
294 	dprintk(MANTIS_DEBUG, 1, "dvb_unregister_adapter");
295 	dvb_unregister_adapter(&mantis->dvb_adapter);
296 
297 	return 0;
298 }
299 EXPORT_SYMBOL_GPL(mantis_dvb_exit);
300