1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34#include "flexcop.h"
35
36#define DRIVER_NAME "B2C2 FlexcopII/II(b)/III digital TV receiver chip"
37#define DRIVER_AUTHOR "Patrick Boettcher <patrick.boettcher@desy.de"
38
39#ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG
40#define DEBSTATUS ""
41#else
42#define DEBSTATUS " (debugging is not enabled)"
43#endif
44
45int b2c2_flexcop_debug;
46EXPORT_SYMBOL_GPL(b2c2_flexcop_debug);
47module_param_named(debug, b2c2_flexcop_debug, int, 0644);
48MODULE_PARM_DESC(debug,
49 "set debug level (1=info,2=tuner,4=i2c,8=ts,"
50 "16=sram,32=reg (|-able))."
51 DEBSTATUS);
52#undef DEBSTATUS
53
54DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
55
56
57flexcop_ibi_value ibi_zero;
58
59static int flexcop_dvb_start_feed(struct dvb_demux_feed *dvbdmxfeed)
60{
61 struct flexcop_device *fc = dvbdmxfeed->demux->priv;
62 return flexcop_pid_feed_control(fc, dvbdmxfeed, 1);
63}
64
65static int flexcop_dvb_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
66{
67 struct flexcop_device *fc = dvbdmxfeed->demux->priv;
68 return flexcop_pid_feed_control(fc, dvbdmxfeed, 0);
69}
70
71static int flexcop_dvb_init(struct flexcop_device *fc)
72{
73 int ret = dvb_register_adapter(&fc->dvb_adapter,
74 "FlexCop Digital TV device", fc->owner,
75 fc->dev, adapter_nr);
76 if (ret < 0) {
77 err("error registering DVB adapter");
78 return ret;
79 }
80 fc->dvb_adapter.priv = fc;
81
82 fc->demux.dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING
83 | DMX_MEMORY_BASED_FILTERING);
84 fc->demux.priv = fc;
85 fc->demux.filternum = fc->demux.feednum = FC_MAX_FEED;
86 fc->demux.start_feed = flexcop_dvb_start_feed;
87 fc->demux.stop_feed = flexcop_dvb_stop_feed;
88 fc->demux.write_to_decoder = NULL;
89
90 ret = dvb_dmx_init(&fc->demux);
91 if (ret < 0) {
92 err("dvb_dmx failed: error %d", ret);
93 goto err_dmx;
94 }
95
96 fc->hw_frontend.source = DMX_FRONTEND_0;
97
98 fc->dmxdev.filternum = fc->demux.feednum;
99 fc->dmxdev.demux = &fc->demux.dmx;
100 fc->dmxdev.capabilities = 0;
101 ret = dvb_dmxdev_init(&fc->dmxdev, &fc->dvb_adapter);
102 if (ret < 0) {
103 err("dvb_dmxdev_init failed: error %d", ret);
104 goto err_dmx_dev;
105 }
106
107 ret = fc->demux.dmx.add_frontend(&fc->demux.dmx, &fc->hw_frontend);
108 if (ret < 0) {
109 err("adding hw_frontend to dmx failed: error %d", ret);
110 goto err_dmx_add_hw_frontend;
111 }
112
113 fc->mem_frontend.source = DMX_MEMORY_FE;
114 ret = fc->demux.dmx.add_frontend(&fc->demux.dmx, &fc->mem_frontend);
115 if (ret < 0) {
116 err("adding mem_frontend to dmx failed: error %d", ret);
117 goto err_dmx_add_mem_frontend;
118 }
119
120 ret = fc->demux.dmx.connect_frontend(&fc->demux.dmx, &fc->hw_frontend);
121 if (ret < 0) {
122 err("connect frontend failed: error %d", ret);
123 goto err_connect_frontend;
124 }
125
126 ret = dvb_net_init(&fc->dvb_adapter, &fc->dvbnet, &fc->demux.dmx);
127 if (ret < 0) {
128 err("dvb_net_init failed: error %d", ret);
129 goto err_net;
130 }
131
132 fc->init_state |= FC_STATE_DVB_INIT;
133 return 0;
134
135err_net:
136 fc->demux.dmx.disconnect_frontend(&fc->demux.dmx);
137err_connect_frontend:
138 fc->demux.dmx.remove_frontend(&fc->demux.dmx, &fc->mem_frontend);
139err_dmx_add_mem_frontend:
140 fc->demux.dmx.remove_frontend(&fc->demux.dmx, &fc->hw_frontend);
141err_dmx_add_hw_frontend:
142 dvb_dmxdev_release(&fc->dmxdev);
143err_dmx_dev:
144 dvb_dmx_release(&fc->demux);
145err_dmx:
146 dvb_unregister_adapter(&fc->dvb_adapter);
147 return ret;
148}
149
150static void flexcop_dvb_exit(struct flexcop_device *fc)
151{
152 if (fc->init_state & FC_STATE_DVB_INIT) {
153 dvb_net_release(&fc->dvbnet);
154
155 fc->demux.dmx.close(&fc->demux.dmx);
156 fc->demux.dmx.remove_frontend(&fc->demux.dmx,
157 &fc->mem_frontend);
158 fc->demux.dmx.remove_frontend(&fc->demux.dmx,
159 &fc->hw_frontend);
160 dvb_dmxdev_release(&fc->dmxdev);
161 dvb_dmx_release(&fc->demux);
162 dvb_unregister_adapter(&fc->dvb_adapter);
163 deb_info("deinitialized dvb stuff\n");
164 }
165 fc->init_state &= ~FC_STATE_DVB_INIT;
166}
167
168
169
170void flexcop_pass_dmx_data(struct flexcop_device *fc, u8 *buf, u32 len)
171{
172 dvb_dmx_swfilter(&fc->demux, buf, len);
173}
174EXPORT_SYMBOL(flexcop_pass_dmx_data);
175
176void flexcop_pass_dmx_packets(struct flexcop_device *fc, u8 *buf, u32 no)
177{
178 dvb_dmx_swfilter_packets(&fc->demux, buf, no);
179}
180EXPORT_SYMBOL(flexcop_pass_dmx_packets);
181
182static void flexcop_reset(struct flexcop_device *fc)
183{
184 flexcop_ibi_value v210, v204;
185
186
187 fc->write_ibi_reg(fc,ctrl_208,ibi_zero);
188
189 v210.raw = 0;
190 v210.sw_reset_210.reset_block_000 = 1;
191 v210.sw_reset_210.reset_block_100 = 1;
192 v210.sw_reset_210.reset_block_200 = 1;
193 v210.sw_reset_210.reset_block_300 = 1;
194 v210.sw_reset_210.reset_block_400 = 1;
195 v210.sw_reset_210.reset_block_500 = 1;
196 v210.sw_reset_210.reset_block_600 = 1;
197 v210.sw_reset_210.reset_block_700 = 1;
198 v210.sw_reset_210.Block_reset_enable = 0xb2;
199 v210.sw_reset_210.Special_controls = 0xc259;
200 fc->write_ibi_reg(fc,sw_reset_210,v210);
201 msleep(1);
202
203
204
205 v204 = fc->read_ibi_reg(fc,misc_204);
206 v204.misc_204.Per_reset_sig = 0;
207 fc->write_ibi_reg(fc,misc_204,v204);
208 msleep(1);
209 v204.misc_204.Per_reset_sig = 1;
210 fc->write_ibi_reg(fc,misc_204,v204);
211}
212
213void flexcop_reset_block_300(struct flexcop_device *fc)
214{
215 flexcop_ibi_value v208_save = fc->read_ibi_reg(fc, ctrl_208),
216 v210 = fc->read_ibi_reg(fc, sw_reset_210);
217
218 deb_rdump("208: %08x, 210: %08x\n", v208_save.raw, v210.raw);
219 fc->write_ibi_reg(fc,ctrl_208,ibi_zero);
220
221 v210.sw_reset_210.reset_block_300 = 1;
222 v210.sw_reset_210.Block_reset_enable = 0xb2;
223
224 fc->write_ibi_reg(fc,sw_reset_210,v210);
225 fc->write_ibi_reg(fc,ctrl_208,v208_save);
226}
227
228struct flexcop_device *flexcop_device_kmalloc(size_t bus_specific_len)
229{
230 void *bus;
231 struct flexcop_device *fc = kzalloc(sizeof(struct flexcop_device),
232 GFP_KERNEL);
233 if (!fc) {
234 err("no memory");
235 return NULL;
236 }
237
238 bus = kzalloc(bus_specific_len, GFP_KERNEL);
239 if (!bus) {
240 err("no memory");
241 kfree(fc);
242 return NULL;
243 }
244
245 fc->bus_specific = bus;
246
247 return fc;
248}
249EXPORT_SYMBOL(flexcop_device_kmalloc);
250
251void flexcop_device_kfree(struct flexcop_device *fc)
252{
253 kfree(fc->bus_specific);
254 kfree(fc);
255}
256EXPORT_SYMBOL(flexcop_device_kfree);
257
258int flexcop_device_initialize(struct flexcop_device *fc)
259{
260 int ret;
261 ibi_zero.raw = 0;
262
263 flexcop_reset(fc);
264 flexcop_determine_revision(fc);
265 flexcop_sram_init(fc);
266 flexcop_hw_filter_init(fc);
267 flexcop_smc_ctrl(fc, 0);
268
269 ret = flexcop_dvb_init(fc);
270 if (ret)
271 goto error;
272
273
274
275 ret = flexcop_i2c_init(fc);
276 if (ret)
277 goto error;
278
279
280 if (fc->get_mac_addr(fc, 0) == 0) {
281 u8 *b = fc->dvb_adapter.proposed_mac;
282 info("MAC address = %pM", b);
283 flexcop_set_mac_filter(fc,b);
284 flexcop_mac_filter_ctrl(fc,1);
285 } else
286 warn("reading of MAC address failed.\n");
287
288 ret = flexcop_frontend_init(fc);
289 if (ret)
290 goto error;
291
292 flexcop_device_name(fc,"initialization of","complete");
293 return 0;
294
295error:
296 flexcop_device_exit(fc);
297 return ret;
298}
299EXPORT_SYMBOL(flexcop_device_initialize);
300
301void flexcop_device_exit(struct flexcop_device *fc)
302{
303 flexcop_frontend_exit(fc);
304 flexcop_i2c_exit(fc);
305 flexcop_dvb_exit(fc);
306}
307EXPORT_SYMBOL(flexcop_device_exit);
308
309static int flexcop_module_init(void)
310{
311 info(DRIVER_NAME " loaded successfully");
312 return 0;
313}
314
315static void flexcop_module_cleanup(void)
316{
317 info(DRIVER_NAME " unloaded successfully");
318}
319
320module_init(flexcop_module_init);
321module_exit(flexcop_module_cleanup);
322
323MODULE_AUTHOR(DRIVER_AUTHOR);
324MODULE_DESCRIPTION(DRIVER_NAME);
325MODULE_LICENSE("GPL");
326