0001
0002
0003
0004
0005
0006
0007
0008
0009
0010
0011
0012
0013
0014
0015
0016
0017
0018
0019
0020
0021 #include "flexcop.h"
0022
0023 #define DRIVER_NAME "B2C2 FlexcopII/II(b)/III digital TV receiver chip"
0024 #define DRIVER_AUTHOR "Patrick Boettcher <patrick.boettcher@posteo.de"
0025
0026 #ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG
0027 #define DEBSTATUS ""
0028 #else
0029 #define DEBSTATUS " (debugging is not enabled)"
0030 #endif
0031
0032 int b2c2_flexcop_debug;
0033 EXPORT_SYMBOL_GPL(b2c2_flexcop_debug);
0034 module_param_named(debug, b2c2_flexcop_debug, int, 0644);
0035 MODULE_PARM_DESC(debug,
0036 "set debug level (1=info,2=tuner,4=i2c,8=ts,16=sram,32=reg,64=i2cdump (|-able))."
0037 DEBSTATUS);
0038 #undef DEBSTATUS
0039
0040 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
0041
0042
0043 flexcop_ibi_value ibi_zero;
0044
0045 static int flexcop_dvb_start_feed(struct dvb_demux_feed *dvbdmxfeed)
0046 {
0047 struct flexcop_device *fc = dvbdmxfeed->demux->priv;
0048 return flexcop_pid_feed_control(fc, dvbdmxfeed, 1);
0049 }
0050
0051 static int flexcop_dvb_stop_feed(struct dvb_demux_feed *dvbdmxfeed)
0052 {
0053 struct flexcop_device *fc = dvbdmxfeed->demux->priv;
0054 return flexcop_pid_feed_control(fc, dvbdmxfeed, 0);
0055 }
0056
0057 static int flexcop_dvb_init(struct flexcop_device *fc)
0058 {
0059 int ret = dvb_register_adapter(&fc->dvb_adapter,
0060 "FlexCop Digital TV device", fc->owner,
0061 fc->dev, adapter_nr);
0062 if (ret < 0) {
0063 err("error registering DVB adapter");
0064 return ret;
0065 }
0066 fc->dvb_adapter.priv = fc;
0067
0068 fc->demux.dmx.capabilities = (DMX_TS_FILTERING | DMX_SECTION_FILTERING
0069 | DMX_MEMORY_BASED_FILTERING);
0070 fc->demux.priv = fc;
0071 fc->demux.filternum = fc->demux.feednum = FC_MAX_FEED;
0072 fc->demux.start_feed = flexcop_dvb_start_feed;
0073 fc->demux.stop_feed = flexcop_dvb_stop_feed;
0074 fc->demux.write_to_decoder = NULL;
0075
0076 ret = dvb_dmx_init(&fc->demux);
0077 if (ret < 0) {
0078 err("dvb_dmx failed: error %d", ret);
0079 goto err_dmx;
0080 }
0081
0082 fc->hw_frontend.source = DMX_FRONTEND_0;
0083
0084 fc->dmxdev.filternum = fc->demux.feednum;
0085 fc->dmxdev.demux = &fc->demux.dmx;
0086 fc->dmxdev.capabilities = 0;
0087 ret = dvb_dmxdev_init(&fc->dmxdev, &fc->dvb_adapter);
0088 if (ret < 0) {
0089 err("dvb_dmxdev_init failed: error %d", ret);
0090 goto err_dmx_dev;
0091 }
0092
0093 ret = fc->demux.dmx.add_frontend(&fc->demux.dmx, &fc->hw_frontend);
0094 if (ret < 0) {
0095 err("adding hw_frontend to dmx failed: error %d", ret);
0096 goto err_dmx_add_hw_frontend;
0097 }
0098
0099 fc->mem_frontend.source = DMX_MEMORY_FE;
0100 ret = fc->demux.dmx.add_frontend(&fc->demux.dmx, &fc->mem_frontend);
0101 if (ret < 0) {
0102 err("adding mem_frontend to dmx failed: error %d", ret);
0103 goto err_dmx_add_mem_frontend;
0104 }
0105
0106 ret = fc->demux.dmx.connect_frontend(&fc->demux.dmx, &fc->hw_frontend);
0107 if (ret < 0) {
0108 err("connect frontend failed: error %d", ret);
0109 goto err_connect_frontend;
0110 }
0111
0112 ret = dvb_net_init(&fc->dvb_adapter, &fc->dvbnet, &fc->demux.dmx);
0113 if (ret < 0) {
0114 err("dvb_net_init failed: error %d", ret);
0115 goto err_net;
0116 }
0117
0118 fc->init_state |= FC_STATE_DVB_INIT;
0119 return 0;
0120
0121 err_net:
0122 fc->demux.dmx.disconnect_frontend(&fc->demux.dmx);
0123 err_connect_frontend:
0124 fc->demux.dmx.remove_frontend(&fc->demux.dmx, &fc->mem_frontend);
0125 err_dmx_add_mem_frontend:
0126 fc->demux.dmx.remove_frontend(&fc->demux.dmx, &fc->hw_frontend);
0127 err_dmx_add_hw_frontend:
0128 dvb_dmxdev_release(&fc->dmxdev);
0129 err_dmx_dev:
0130 dvb_dmx_release(&fc->demux);
0131 err_dmx:
0132 dvb_unregister_adapter(&fc->dvb_adapter);
0133 return ret;
0134 }
0135
0136 static void flexcop_dvb_exit(struct flexcop_device *fc)
0137 {
0138 if (fc->init_state & FC_STATE_DVB_INIT) {
0139 dvb_net_release(&fc->dvbnet);
0140
0141 fc->demux.dmx.close(&fc->demux.dmx);
0142 fc->demux.dmx.remove_frontend(&fc->demux.dmx,
0143 &fc->mem_frontend);
0144 fc->demux.dmx.remove_frontend(&fc->demux.dmx,
0145 &fc->hw_frontend);
0146 dvb_dmxdev_release(&fc->dmxdev);
0147 dvb_dmx_release(&fc->demux);
0148 dvb_unregister_adapter(&fc->dvb_adapter);
0149 deb_info("deinitialized dvb stuff\n");
0150 }
0151 fc->init_state &= ~FC_STATE_DVB_INIT;
0152 }
0153
0154
0155
0156 void flexcop_pass_dmx_data(struct flexcop_device *fc, u8 *buf, u32 len)
0157 {
0158 dvb_dmx_swfilter(&fc->demux, buf, len);
0159 }
0160 EXPORT_SYMBOL(flexcop_pass_dmx_data);
0161
0162 void flexcop_pass_dmx_packets(struct flexcop_device *fc, u8 *buf, u32 no)
0163 {
0164 dvb_dmx_swfilter_packets(&fc->demux, buf, no);
0165 }
0166 EXPORT_SYMBOL(flexcop_pass_dmx_packets);
0167
0168 static void flexcop_reset(struct flexcop_device *fc)
0169 {
0170 flexcop_ibi_value v210, v204;
0171
0172
0173 fc->write_ibi_reg(fc,ctrl_208,ibi_zero);
0174
0175 v210.raw = 0;
0176 v210.sw_reset_210.reset_block_000 = 1;
0177 v210.sw_reset_210.reset_block_100 = 1;
0178 v210.sw_reset_210.reset_block_200 = 1;
0179 v210.sw_reset_210.reset_block_300 = 1;
0180 v210.sw_reset_210.reset_block_400 = 1;
0181 v210.sw_reset_210.reset_block_500 = 1;
0182 v210.sw_reset_210.reset_block_600 = 1;
0183 v210.sw_reset_210.reset_block_700 = 1;
0184 v210.sw_reset_210.Block_reset_enable = 0xb2;
0185 v210.sw_reset_210.Special_controls = 0xc259;
0186 fc->write_ibi_reg(fc,sw_reset_210,v210);
0187 msleep(1);
0188
0189
0190
0191 v204 = fc->read_ibi_reg(fc,misc_204);
0192 v204.misc_204.Per_reset_sig = 0;
0193 fc->write_ibi_reg(fc,misc_204,v204);
0194 msleep(1);
0195 v204.misc_204.Per_reset_sig = 1;
0196 fc->write_ibi_reg(fc,misc_204,v204);
0197 }
0198
0199 void flexcop_reset_block_300(struct flexcop_device *fc)
0200 {
0201 flexcop_ibi_value v208_save = fc->read_ibi_reg(fc, ctrl_208),
0202 v210 = fc->read_ibi_reg(fc, sw_reset_210);
0203
0204 deb_rdump("208: %08x, 210: %08x\n", v208_save.raw, v210.raw);
0205 fc->write_ibi_reg(fc,ctrl_208,ibi_zero);
0206
0207 v210.sw_reset_210.reset_block_300 = 1;
0208 v210.sw_reset_210.Block_reset_enable = 0xb2;
0209
0210 fc->write_ibi_reg(fc,sw_reset_210,v210);
0211 fc->write_ibi_reg(fc,ctrl_208,v208_save);
0212 }
0213
0214 struct flexcop_device *flexcop_device_kmalloc(size_t bus_specific_len)
0215 {
0216 void *bus;
0217 struct flexcop_device *fc = kzalloc(sizeof(struct flexcop_device),
0218 GFP_KERNEL);
0219 if (!fc) {
0220 err("no memory");
0221 return NULL;
0222 }
0223
0224 bus = kzalloc(bus_specific_len, GFP_KERNEL);
0225 if (!bus) {
0226 err("no memory");
0227 kfree(fc);
0228 return NULL;
0229 }
0230
0231 fc->bus_specific = bus;
0232
0233 return fc;
0234 }
0235 EXPORT_SYMBOL(flexcop_device_kmalloc);
0236
0237 void flexcop_device_kfree(struct flexcop_device *fc)
0238 {
0239 kfree(fc->bus_specific);
0240 kfree(fc);
0241 }
0242 EXPORT_SYMBOL(flexcop_device_kfree);
0243
0244 int flexcop_device_initialize(struct flexcop_device *fc)
0245 {
0246 int ret;
0247 ibi_zero.raw = 0;
0248
0249 flexcop_reset(fc);
0250 flexcop_determine_revision(fc);
0251 flexcop_sram_init(fc);
0252 flexcop_hw_filter_init(fc);
0253 flexcop_smc_ctrl(fc, 0);
0254
0255 ret = flexcop_dvb_init(fc);
0256 if (ret)
0257 goto error;
0258
0259
0260
0261 ret = flexcop_i2c_init(fc);
0262 if (ret)
0263 goto error;
0264
0265
0266 if (fc->get_mac_addr(fc, 0) == 0) {
0267 u8 *b = fc->dvb_adapter.proposed_mac;
0268 info("MAC address = %pM", b);
0269 flexcop_set_mac_filter(fc,b);
0270 flexcop_mac_filter_ctrl(fc,1);
0271 } else
0272 warn("reading of MAC address failed.\n");
0273
0274 ret = flexcop_frontend_init(fc);
0275 if (ret)
0276 goto error;
0277
0278 flexcop_device_name(fc,"initialization of","complete");
0279 return 0;
0280
0281 error:
0282 flexcop_device_exit(fc);
0283 return ret;
0284 }
0285 EXPORT_SYMBOL(flexcop_device_initialize);
0286
0287 void flexcop_device_exit(struct flexcop_device *fc)
0288 {
0289 flexcop_frontend_exit(fc);
0290 flexcop_i2c_exit(fc);
0291 flexcop_dvb_exit(fc);
0292 }
0293 EXPORT_SYMBOL(flexcop_device_exit);
0294
0295 static int flexcop_module_init(void)
0296 {
0297 info(DRIVER_NAME " loaded successfully");
0298 return 0;
0299 }
0300
0301 static void flexcop_module_cleanup(void)
0302 {
0303 info(DRIVER_NAME " unloaded successfully");
0304 }
0305
0306 module_init(flexcop_module_init);
0307 module_exit(flexcop_module_cleanup);
0308
0309 MODULE_AUTHOR(DRIVER_AUTHOR);
0310 MODULE_DESCRIPTION(DRIVER_NAME);
0311 MODULE_LICENSE("GPL");