1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
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
41DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
42
43int 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}
69EXPORT_SYMBOL_GPL(mantis_frontend_power);
70
71void 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}
87EXPORT_SYMBOL_GPL(mantis_frontend_soft_reset);
88
89static 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
103static 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
126static 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
147int __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
248err5:
249 tasklet_kill(&mantis->tasklet);
250 dvb_net_release(&mantis->dvbnet);
251 dvb_unregister_frontend(mantis->fe);
252 dvb_frontend_detach(mantis->fe);
253err4:
254 mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_mem);
255
256err3:
257 mantis->demux.dmx.remove_frontend(&mantis->demux.dmx, &mantis->fe_hw);
258
259err2:
260 dvb_dmxdev_release(&mantis->dmxdev);
261
262err1:
263 dvb_dmx_release(&mantis->demux);
264
265err0:
266 dvb_unregister_adapter(&mantis->dvb_adapter);
267
268 return result;
269}
270EXPORT_SYMBOL_GPL(mantis_dvb_init);
271
272int __devexit mantis_dvb_exit(struct mantis_pci *mantis)
273{
274 int err;
275
276 if (mantis->fe) {
277
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}
299EXPORT_SYMBOL_GPL(mantis_dvb_exit);
300
