treewide: remove redundant IS_ERR() before error code check
[linux/fpc-iii.git] / drivers / media / usb / dvb-usb / az6027.c
blob8de18da0c4bd134e401a2c1a56c5e3938223d188
1 // SPDX-License-Identifier: GPL-2.0-only
2 /* DVB USB compliant Linux driver for the AZUREWAVE DVB-S/S2 USB2.0 (AZ6027)
3 * receiver.
5 * Copyright (C) 2009 Adams.Xu <adams.xu@azwave.com.cn>
7 * see Documentation/media/dvb-drivers/dvb-usb.rst for more information
8 */
9 #include "az6027.h"
11 #include "stb0899_drv.h"
12 #include "stb0899_reg.h"
13 #include "stb0899_cfg.h"
15 #include "stb6100.h"
16 #include "stb6100_cfg.h"
17 #include <media/dvb_ca_en50221.h>
19 int dvb_usb_az6027_debug;
20 module_param_named(debug, dvb_usb_az6027_debug, int, 0644);
21 MODULE_PARM_DESC(debug, "set debugging level (1=info,xfer=2,rc=4 (or-able))." DVB_USB_DEBUG_STATUS);
23 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
25 struct az6027_device_state {
26 struct dvb_ca_en50221 ca;
27 struct mutex ca_mutex;
28 u8 power_state;
31 static const struct stb0899_s1_reg az6027_stb0899_s1_init_1[] = {
33 /* 0x0000000b, SYSREG */
34 { STB0899_DEV_ID , 0x30 },
35 { STB0899_DISCNTRL1 , 0x32 },
36 { STB0899_DISCNTRL2 , 0x80 },
37 { STB0899_DISRX_ST0 , 0x04 },
38 { STB0899_DISRX_ST1 , 0x00 },
39 { STB0899_DISPARITY , 0x00 },
40 { STB0899_DISSTATUS , 0x20 },
41 { STB0899_DISF22 , 0x99 },
42 { STB0899_DISF22RX , 0xa8 },
43 /* SYSREG ? */
44 { STB0899_ACRPRESC , 0x11 },
45 { STB0899_ACRDIV1 , 0x0a },
46 { STB0899_ACRDIV2 , 0x05 },
47 { STB0899_DACR1 , 0x00 },
48 { STB0899_DACR2 , 0x00 },
49 { STB0899_OUTCFG , 0x00 },
50 { STB0899_MODECFG , 0x00 },
51 { STB0899_IRQSTATUS_3 , 0xfe },
52 { STB0899_IRQSTATUS_2 , 0x03 },
53 { STB0899_IRQSTATUS_1 , 0x7c },
54 { STB0899_IRQSTATUS_0 , 0xf4 },
55 { STB0899_IRQMSK_3 , 0xf3 },
56 { STB0899_IRQMSK_2 , 0xfc },
57 { STB0899_IRQMSK_1 , 0xff },
58 { STB0899_IRQMSK_0 , 0xff },
59 { STB0899_IRQCFG , 0x00 },
60 { STB0899_I2CCFG , 0x88 },
61 { STB0899_I2CRPT , 0x58 },
62 { STB0899_IOPVALUE5 , 0x00 },
63 { STB0899_IOPVALUE4 , 0x33 },
64 { STB0899_IOPVALUE3 , 0x6d },
65 { STB0899_IOPVALUE2 , 0x90 },
66 { STB0899_IOPVALUE1 , 0x60 },
67 { STB0899_IOPVALUE0 , 0x00 },
68 { STB0899_GPIO00CFG , 0x82 },
69 { STB0899_GPIO01CFG , 0x82 },
70 { STB0899_GPIO02CFG , 0x82 },
71 { STB0899_GPIO03CFG , 0x82 },
72 { STB0899_GPIO04CFG , 0x82 },
73 { STB0899_GPIO05CFG , 0x82 },
74 { STB0899_GPIO06CFG , 0x82 },
75 { STB0899_GPIO07CFG , 0x82 },
76 { STB0899_GPIO08CFG , 0x82 },
77 { STB0899_GPIO09CFG , 0x82 },
78 { STB0899_GPIO10CFG , 0x82 },
79 { STB0899_GPIO11CFG , 0x82 },
80 { STB0899_GPIO12CFG , 0x82 },
81 { STB0899_GPIO13CFG , 0x82 },
82 { STB0899_GPIO14CFG , 0x82 },
83 { STB0899_GPIO15CFG , 0x82 },
84 { STB0899_GPIO16CFG , 0x82 },
85 { STB0899_GPIO17CFG , 0x82 },
86 { STB0899_GPIO18CFG , 0x82 },
87 { STB0899_GPIO19CFG , 0x82 },
88 { STB0899_GPIO20CFG , 0x82 },
89 { STB0899_SDATCFG , 0xb8 },
90 { STB0899_SCLTCFG , 0xba },
91 { STB0899_AGCRFCFG , 0x1c }, /* 0x11 */
92 { STB0899_GPIO22 , 0x82 }, /* AGCBB2CFG */
93 { STB0899_GPIO21 , 0x91 }, /* AGCBB1CFG */
94 { STB0899_DIRCLKCFG , 0x82 },
95 { STB0899_CLKOUT27CFG , 0x7e },
96 { STB0899_STDBYCFG , 0x82 },
97 { STB0899_CS0CFG , 0x82 },
98 { STB0899_CS1CFG , 0x82 },
99 { STB0899_DISEQCOCFG , 0x20 },
100 { STB0899_GPIO32CFG , 0x82 },
101 { STB0899_GPIO33CFG , 0x82 },
102 { STB0899_GPIO34CFG , 0x82 },
103 { STB0899_GPIO35CFG , 0x82 },
104 { STB0899_GPIO36CFG , 0x82 },
105 { STB0899_GPIO37CFG , 0x82 },
106 { STB0899_GPIO38CFG , 0x82 },
107 { STB0899_GPIO39CFG , 0x82 },
108 { STB0899_NCOARSE , 0x17 }, /* 0x15 = 27 Mhz Clock, F/3 = 198MHz, F/6 = 99MHz */
109 { STB0899_SYNTCTRL , 0x02 }, /* 0x00 = CLK from CLKI, 0x02 = CLK from XTALI */
110 { STB0899_FILTCTRL , 0x00 },
111 { STB0899_SYSCTRL , 0x01 },
112 { STB0899_STOPCLK1 , 0x20 },
113 { STB0899_STOPCLK2 , 0x00 },
114 { STB0899_INTBUFSTATUS , 0x00 },
115 { STB0899_INTBUFCTRL , 0x0a },
116 { 0xffff , 0xff },
119 static const struct stb0899_s1_reg az6027_stb0899_s1_init_3[] = {
120 { STB0899_DEMOD , 0x00 },
121 { STB0899_RCOMPC , 0xc9 },
122 { STB0899_AGC1CN , 0x01 },
123 { STB0899_AGC1REF , 0x10 },
124 { STB0899_RTC , 0x23 },
125 { STB0899_TMGCFG , 0x4e },
126 { STB0899_AGC2REF , 0x34 },
127 { STB0899_TLSR , 0x84 },
128 { STB0899_CFD , 0xf7 },
129 { STB0899_ACLC , 0x87 },
130 { STB0899_BCLC , 0x94 },
131 { STB0899_EQON , 0x41 },
132 { STB0899_LDT , 0xf1 },
133 { STB0899_LDT2 , 0xe3 },
134 { STB0899_EQUALREF , 0xb4 },
135 { STB0899_TMGRAMP , 0x10 },
136 { STB0899_TMGTHD , 0x30 },
137 { STB0899_IDCCOMP , 0xfd },
138 { STB0899_QDCCOMP , 0xff },
139 { STB0899_POWERI , 0x0c },
140 { STB0899_POWERQ , 0x0f },
141 { STB0899_RCOMP , 0x6c },
142 { STB0899_AGCIQIN , 0x80 },
143 { STB0899_AGC2I1 , 0x06 },
144 { STB0899_AGC2I2 , 0x00 },
145 { STB0899_TLIR , 0x30 },
146 { STB0899_RTF , 0x7f },
147 { STB0899_DSTATUS , 0x00 },
148 { STB0899_LDI , 0xbc },
149 { STB0899_CFRM , 0xea },
150 { STB0899_CFRL , 0x31 },
151 { STB0899_NIRM , 0x2b },
152 { STB0899_NIRL , 0x80 },
153 { STB0899_ISYMB , 0x1d },
154 { STB0899_QSYMB , 0xa6 },
155 { STB0899_SFRH , 0x2f },
156 { STB0899_SFRM , 0x68 },
157 { STB0899_SFRL , 0x40 },
158 { STB0899_SFRUPH , 0x2f },
159 { STB0899_SFRUPM , 0x68 },
160 { STB0899_SFRUPL , 0x40 },
161 { STB0899_EQUAI1 , 0x02 },
162 { STB0899_EQUAQ1 , 0xff },
163 { STB0899_EQUAI2 , 0x04 },
164 { STB0899_EQUAQ2 , 0x05 },
165 { STB0899_EQUAI3 , 0x02 },
166 { STB0899_EQUAQ3 , 0xfd },
167 { STB0899_EQUAI4 , 0x03 },
168 { STB0899_EQUAQ4 , 0x07 },
169 { STB0899_EQUAI5 , 0x08 },
170 { STB0899_EQUAQ5 , 0xf5 },
171 { STB0899_DSTATUS2 , 0x00 },
172 { STB0899_VSTATUS , 0x00 },
173 { STB0899_VERROR , 0x86 },
174 { STB0899_IQSWAP , 0x2a },
175 { STB0899_ECNT1M , 0x00 },
176 { STB0899_ECNT1L , 0x00 },
177 { STB0899_ECNT2M , 0x00 },
178 { STB0899_ECNT2L , 0x00 },
179 { STB0899_ECNT3M , 0x0a },
180 { STB0899_ECNT3L , 0xad },
181 { STB0899_FECAUTO1 , 0x06 },
182 { STB0899_FECM , 0x01 },
183 { STB0899_VTH12 , 0xb0 },
184 { STB0899_VTH23 , 0x7a },
185 { STB0899_VTH34 , 0x58 },
186 { STB0899_VTH56 , 0x38 },
187 { STB0899_VTH67 , 0x34 },
188 { STB0899_VTH78 , 0x24 },
189 { STB0899_PRVIT , 0xff },
190 { STB0899_VITSYNC , 0x19 },
191 { STB0899_RSULC , 0xb1 }, /* DVB = 0xb1, DSS = 0xa1 */
192 { STB0899_TSULC , 0x42 },
193 { STB0899_RSLLC , 0x41 },
194 { STB0899_TSLPL , 0x12 },
195 { STB0899_TSCFGH , 0x0c },
196 { STB0899_TSCFGM , 0x00 },
197 { STB0899_TSCFGL , 0x00 },
198 { STB0899_TSOUT , 0x69 }, /* 0x0d for CAM */
199 { STB0899_RSSYNCDEL , 0x00 },
200 { STB0899_TSINHDELH , 0x02 },
201 { STB0899_TSINHDELM , 0x00 },
202 { STB0899_TSINHDELL , 0x00 },
203 { STB0899_TSLLSTKM , 0x1b },
204 { STB0899_TSLLSTKL , 0xb3 },
205 { STB0899_TSULSTKM , 0x00 },
206 { STB0899_TSULSTKL , 0x00 },
207 { STB0899_PCKLENUL , 0xbc },
208 { STB0899_PCKLENLL , 0xcc },
209 { STB0899_RSPCKLEN , 0xbd },
210 { STB0899_TSSTATUS , 0x90 },
211 { STB0899_ERRCTRL1 , 0xb6 },
212 { STB0899_ERRCTRL2 , 0x95 },
213 { STB0899_ERRCTRL3 , 0x8d },
214 { STB0899_DMONMSK1 , 0x27 },
215 { STB0899_DMONMSK0 , 0x03 },
216 { STB0899_DEMAPVIT , 0x5c },
217 { STB0899_PLPARM , 0x19 },
218 { STB0899_PDELCTRL , 0x48 },
219 { STB0899_PDELCTRL2 , 0x00 },
220 { STB0899_BBHCTRL1 , 0x00 },
221 { STB0899_BBHCTRL2 , 0x00 },
222 { STB0899_HYSTTHRESH , 0x77 },
223 { STB0899_MATCSTM , 0x00 },
224 { STB0899_MATCSTL , 0x00 },
225 { STB0899_UPLCSTM , 0x00 },
226 { STB0899_UPLCSTL , 0x00 },
227 { STB0899_DFLCSTM , 0x00 },
228 { STB0899_DFLCSTL , 0x00 },
229 { STB0899_SYNCCST , 0x00 },
230 { STB0899_SYNCDCSTM , 0x00 },
231 { STB0899_SYNCDCSTL , 0x00 },
232 { STB0899_ISI_ENTRY , 0x00 },
233 { STB0899_ISI_BIT_EN , 0x00 },
234 { STB0899_MATSTRM , 0xf0 },
235 { STB0899_MATSTRL , 0x02 },
236 { STB0899_UPLSTRM , 0x45 },
237 { STB0899_UPLSTRL , 0x60 },
238 { STB0899_DFLSTRM , 0xe3 },
239 { STB0899_DFLSTRL , 0x00 },
240 { STB0899_SYNCSTR , 0x47 },
241 { STB0899_SYNCDSTRM , 0x05 },
242 { STB0899_SYNCDSTRL , 0x18 },
243 { STB0899_CFGPDELSTATUS1 , 0x19 },
244 { STB0899_CFGPDELSTATUS2 , 0x2b },
245 { STB0899_BBFERRORM , 0x00 },
246 { STB0899_BBFERRORL , 0x01 },
247 { STB0899_UPKTERRORM , 0x00 },
248 { STB0899_UPKTERRORL , 0x00 },
249 { 0xffff , 0xff },
254 static struct stb0899_config az6027_stb0899_config = {
255 .init_dev = az6027_stb0899_s1_init_1,
256 .init_s2_demod = stb0899_s2_init_2,
257 .init_s1_demod = az6027_stb0899_s1_init_3,
258 .init_s2_fec = stb0899_s2_init_4,
259 .init_tst = stb0899_s1_init_5,
261 .demod_address = 0xd0, /* 0x68, 0xd0 >> 1 */
263 .xtal_freq = 27000000,
264 .inversion = IQ_SWAP_ON,
266 .lo_clk = 76500000,
267 .hi_clk = 99000000,
269 .esno_ave = STB0899_DVBS2_ESNO_AVE,
270 .esno_quant = STB0899_DVBS2_ESNO_QUANT,
271 .avframes_coarse = STB0899_DVBS2_AVFRAMES_COARSE,
272 .avframes_fine = STB0899_DVBS2_AVFRAMES_FINE,
273 .miss_threshold = STB0899_DVBS2_MISS_THRESHOLD,
274 .uwp_threshold_acq = STB0899_DVBS2_UWP_THRESHOLD_ACQ,
275 .uwp_threshold_track = STB0899_DVBS2_UWP_THRESHOLD_TRACK,
276 .uwp_threshold_sof = STB0899_DVBS2_UWP_THRESHOLD_SOF,
277 .sof_search_timeout = STB0899_DVBS2_SOF_SEARCH_TIMEOUT,
279 .btr_nco_bits = STB0899_DVBS2_BTR_NCO_BITS,
280 .btr_gain_shift_offset = STB0899_DVBS2_BTR_GAIN_SHIFT_OFFSET,
281 .crl_nco_bits = STB0899_DVBS2_CRL_NCO_BITS,
282 .ldpc_max_iter = STB0899_DVBS2_LDPC_MAX_ITER,
284 .tuner_get_frequency = stb6100_get_frequency,
285 .tuner_set_frequency = stb6100_set_frequency,
286 .tuner_set_bandwidth = stb6100_set_bandwidth,
287 .tuner_get_bandwidth = stb6100_get_bandwidth,
288 .tuner_set_rfsiggain = NULL,
291 static struct stb6100_config az6027_stb6100_config = {
292 .tuner_address = 0xc0,
293 .refclock = 27000000,
297 /* check for mutex FIXME */
298 static int az6027_usb_in_op(struct dvb_usb_device *d, u8 req,
299 u16 value, u16 index, u8 *b, int blen)
301 int ret = -1;
302 if (mutex_lock_interruptible(&d->usb_mutex))
303 return -EAGAIN;
305 ret = usb_control_msg(d->udev,
306 usb_rcvctrlpipe(d->udev, 0),
307 req,
308 USB_TYPE_VENDOR | USB_DIR_IN,
309 value,
310 index,
312 blen,
313 2000);
315 if (ret < 0) {
316 warn("usb in operation failed. (%d)", ret);
317 ret = -EIO;
318 } else
319 ret = 0;
321 deb_xfer("in: req. %02x, val: %04x, ind: %04x, buffer: ", req, value, index);
322 debug_dump(b, blen, deb_xfer);
324 mutex_unlock(&d->usb_mutex);
325 return ret;
328 static int az6027_usb_out_op(struct dvb_usb_device *d,
329 u8 req,
330 u16 value,
331 u16 index,
332 u8 *b,
333 int blen)
335 int ret;
337 deb_xfer("out: req. %02x, val: %04x, ind: %04x, buffer: ", req, value, index);
338 debug_dump(b, blen, deb_xfer);
340 if (mutex_lock_interruptible(&d->usb_mutex))
341 return -EAGAIN;
343 ret = usb_control_msg(d->udev,
344 usb_sndctrlpipe(d->udev, 0),
345 req,
346 USB_TYPE_VENDOR | USB_DIR_OUT,
347 value,
348 index,
350 blen,
351 2000);
353 if (ret != blen) {
354 warn("usb out operation failed. (%d)", ret);
355 mutex_unlock(&d->usb_mutex);
356 return -EIO;
357 } else{
358 mutex_unlock(&d->usb_mutex);
359 return 0;
363 static int az6027_streaming_ctrl(struct dvb_usb_adapter *adap, int onoff)
365 int ret;
366 u8 req;
367 u16 value;
368 u16 index;
369 int blen;
371 deb_info("%s %d", __func__, onoff);
373 req = 0xBC;
374 value = onoff;
375 index = 0;
376 blen = 0;
378 ret = az6027_usb_out_op(adap->dev, req, value, index, NULL, blen);
379 if (ret != 0)
380 warn("usb out operation failed. (%d)", ret);
382 return ret;
385 /* keys for the enclosed remote control */
386 static struct rc_map_table rc_map_az6027_table[] = {
387 { 0x01, KEY_1 },
388 { 0x02, KEY_2 },
391 /* remote control stuff (does not work with my box) */
392 static int az6027_rc_query(struct dvb_usb_device *d, u32 *event, int *state)
394 return 0;
398 int az6027_power_ctrl(struct dvb_usb_device *d, int onoff)
400 u8 v = onoff;
401 return az6027_usb_out_op(d,0xBC,v,3,NULL,1);
405 static int az6027_ci_read_attribute_mem(struct dvb_ca_en50221 *ca,
406 int slot,
407 int address)
409 struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
410 struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
412 int ret;
413 u8 req;
414 u16 value;
415 u16 index;
416 int blen;
417 u8 *b;
419 if (slot != 0)
420 return -EINVAL;
422 b = kmalloc(12, GFP_KERNEL);
423 if (!b)
424 return -ENOMEM;
426 mutex_lock(&state->ca_mutex);
428 req = 0xC1;
429 value = address;
430 index = 0;
431 blen = 1;
433 ret = az6027_usb_in_op(d, req, value, index, b, blen);
434 if (ret < 0) {
435 warn("usb in operation failed. (%d)", ret);
436 ret = -EINVAL;
437 } else {
438 ret = b[0];
441 mutex_unlock(&state->ca_mutex);
442 kfree(b);
443 return ret;
446 static int az6027_ci_write_attribute_mem(struct dvb_ca_en50221 *ca,
447 int slot,
448 int address,
449 u8 value)
451 struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
452 struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
454 int ret;
455 u8 req;
456 u16 value1;
457 u16 index;
458 int blen;
460 deb_info("%s %d", __func__, slot);
461 if (slot != 0)
462 return -EINVAL;
464 mutex_lock(&state->ca_mutex);
465 req = 0xC2;
466 value1 = address;
467 index = value;
468 blen = 0;
470 ret = az6027_usb_out_op(d, req, value1, index, NULL, blen);
471 if (ret != 0)
472 warn("usb out operation failed. (%d)", ret);
474 mutex_unlock(&state->ca_mutex);
475 return ret;
478 static int az6027_ci_read_cam_control(struct dvb_ca_en50221 *ca,
479 int slot,
480 u8 address)
482 struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
483 struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
485 int ret;
486 u8 req;
487 u16 value;
488 u16 index;
489 int blen;
490 u8 *b;
492 if (slot != 0)
493 return -EINVAL;
495 b = kmalloc(12, GFP_KERNEL);
496 if (!b)
497 return -ENOMEM;
499 mutex_lock(&state->ca_mutex);
501 req = 0xC3;
502 value = address;
503 index = 0;
504 blen = 2;
506 ret = az6027_usb_in_op(d, req, value, index, b, blen);
507 if (ret < 0) {
508 warn("usb in operation failed. (%d)", ret);
509 ret = -EINVAL;
510 } else {
511 if (b[0] == 0)
512 warn("Read CI IO error");
514 ret = b[1];
515 deb_info("read cam data = %x from 0x%x", b[1], value);
518 mutex_unlock(&state->ca_mutex);
519 kfree(b);
520 return ret;
523 static int az6027_ci_write_cam_control(struct dvb_ca_en50221 *ca,
524 int slot,
525 u8 address,
526 u8 value)
528 struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
529 struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
531 int ret;
532 u8 req;
533 u16 value1;
534 u16 index;
535 int blen;
537 if (slot != 0)
538 return -EINVAL;
540 mutex_lock(&state->ca_mutex);
541 req = 0xC4;
542 value1 = address;
543 index = value;
544 blen = 0;
546 ret = az6027_usb_out_op(d, req, value1, index, NULL, blen);
547 if (ret != 0) {
548 warn("usb out operation failed. (%d)", ret);
549 goto failed;
552 failed:
553 mutex_unlock(&state->ca_mutex);
554 return ret;
557 static int CI_CamReady(struct dvb_ca_en50221 *ca, int slot)
559 struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
561 int ret;
562 u8 req;
563 u16 value;
564 u16 index;
565 int blen;
566 u8 *b;
568 b = kmalloc(12, GFP_KERNEL);
569 if (!b)
570 return -ENOMEM;
572 req = 0xC8;
573 value = 0;
574 index = 0;
575 blen = 1;
577 ret = az6027_usb_in_op(d, req, value, index, b, blen);
578 if (ret < 0) {
579 warn("usb in operation failed. (%d)", ret);
580 ret = -EIO;
581 } else{
582 ret = b[0];
584 kfree(b);
585 return ret;
588 static int az6027_ci_slot_reset(struct dvb_ca_en50221 *ca, int slot)
590 struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
591 struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
593 int ret, i;
594 u8 req;
595 u16 value;
596 u16 index;
597 int blen;
599 mutex_lock(&state->ca_mutex);
601 req = 0xC6;
602 value = 1;
603 index = 0;
604 blen = 0;
606 ret = az6027_usb_out_op(d, req, value, index, NULL, blen);
607 if (ret != 0) {
608 warn("usb out operation failed. (%d)", ret);
609 goto failed;
612 msleep(500);
613 req = 0xC6;
614 value = 0;
615 index = 0;
616 blen = 0;
618 ret = az6027_usb_out_op(d, req, value, index, NULL, blen);
619 if (ret != 0) {
620 warn("usb out operation failed. (%d)", ret);
621 goto failed;
624 for (i = 0; i < 15; i++) {
625 msleep(100);
627 if (CI_CamReady(ca, slot)) {
628 deb_info("CAM Ready");
629 break;
632 msleep(5000);
634 failed:
635 mutex_unlock(&state->ca_mutex);
636 return ret;
639 static int az6027_ci_slot_shutdown(struct dvb_ca_en50221 *ca, int slot)
641 return 0;
644 static int az6027_ci_slot_ts_enable(struct dvb_ca_en50221 *ca, int slot)
646 struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
647 struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
649 int ret;
650 u8 req;
651 u16 value;
652 u16 index;
653 int blen;
655 deb_info("%s", __func__);
656 mutex_lock(&state->ca_mutex);
657 req = 0xC7;
658 value = 1;
659 index = 0;
660 blen = 0;
662 ret = az6027_usb_out_op(d, req, value, index, NULL, blen);
663 if (ret != 0) {
664 warn("usb out operation failed. (%d)", ret);
665 goto failed;
668 failed:
669 mutex_unlock(&state->ca_mutex);
670 return ret;
673 static int az6027_ci_poll_slot_status(struct dvb_ca_en50221 *ca, int slot, int open)
675 struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
676 struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
677 int ret;
678 u8 req;
679 u16 value;
680 u16 index;
681 int blen;
682 u8 *b;
684 b = kmalloc(12, GFP_KERNEL);
685 if (!b)
686 return -ENOMEM;
687 mutex_lock(&state->ca_mutex);
689 req = 0xC5;
690 value = 0;
691 index = 0;
692 blen = 1;
694 ret = az6027_usb_in_op(d, req, value, index, b, blen);
695 if (ret < 0) {
696 warn("usb in operation failed. (%d)", ret);
697 ret = -EIO;
698 } else
699 ret = 0;
701 if (!ret && b[0] == 1) {
702 ret = DVB_CA_EN50221_POLL_CAM_PRESENT |
703 DVB_CA_EN50221_POLL_CAM_READY;
706 mutex_unlock(&state->ca_mutex);
707 kfree(b);
708 return ret;
712 static void az6027_ci_uninit(struct dvb_usb_device *d)
714 struct az6027_device_state *state;
716 deb_info("%s", __func__);
718 if (NULL == d)
719 return;
721 state = (struct az6027_device_state *)d->priv;
722 if (NULL == state)
723 return;
725 if (NULL == state->ca.data)
726 return;
728 dvb_ca_en50221_release(&state->ca);
730 memset(&state->ca, 0, sizeof(state->ca));
734 static int az6027_ci_init(struct dvb_usb_adapter *a)
736 struct dvb_usb_device *d = a->dev;
737 struct az6027_device_state *state = (struct az6027_device_state *)d->priv;
738 int ret;
740 deb_info("%s", __func__);
742 mutex_init(&state->ca_mutex);
744 state->ca.owner = THIS_MODULE;
745 state->ca.read_attribute_mem = az6027_ci_read_attribute_mem;
746 state->ca.write_attribute_mem = az6027_ci_write_attribute_mem;
747 state->ca.read_cam_control = az6027_ci_read_cam_control;
748 state->ca.write_cam_control = az6027_ci_write_cam_control;
749 state->ca.slot_reset = az6027_ci_slot_reset;
750 state->ca.slot_shutdown = az6027_ci_slot_shutdown;
751 state->ca.slot_ts_enable = az6027_ci_slot_ts_enable;
752 state->ca.poll_slot_status = az6027_ci_poll_slot_status;
753 state->ca.data = d;
755 ret = dvb_ca_en50221_init(&a->dvb_adap,
756 &state->ca,
757 0, /* flags */
758 1);/* n_slots */
759 if (ret != 0) {
760 err("Cannot initialize CI: Error %d.", ret);
761 memset(&state->ca, 0, sizeof(state->ca));
762 return ret;
765 deb_info("CI initialized.");
767 return 0;
771 static int az6027_read_mac_addr(struct dvb_usb_device *d, u8 mac[6])
773 az6027_usb_in_op(d, 0xb7, 6, 0, &mac[0], 6);
774 return 0;
778 static int az6027_set_voltage(struct dvb_frontend *fe,
779 enum fe_sec_voltage voltage)
782 u8 buf;
783 struct dvb_usb_adapter *adap = fe->dvb->priv;
785 struct i2c_msg i2c_msg = {
786 .addr = 0x99,
787 .flags = 0,
788 .buf = &buf,
789 .len = 1
793 * 2 --18v
794 * 1 --13v
795 * 0 --off
797 switch (voltage) {
798 case SEC_VOLTAGE_13:
799 buf = 1;
800 i2c_transfer(&adap->dev->i2c_adap, &i2c_msg, 1);
801 break;
803 case SEC_VOLTAGE_18:
804 buf = 2;
805 i2c_transfer(&adap->dev->i2c_adap, &i2c_msg, 1);
806 break;
808 case SEC_VOLTAGE_OFF:
809 buf = 0;
810 i2c_transfer(&adap->dev->i2c_adap, &i2c_msg, 1);
811 break;
813 default:
814 return -EINVAL;
816 return 0;
820 static int az6027_frontend_poweron(struct dvb_usb_adapter *adap)
822 int ret;
823 u8 req;
824 u16 value;
825 u16 index;
826 int blen;
828 req = 0xBC;
829 value = 1; /* power on */
830 index = 3;
831 blen = 0;
833 ret = az6027_usb_out_op(adap->dev, req, value, index, NULL, blen);
834 if (ret != 0)
835 return -EIO;
837 return 0;
839 static int az6027_frontend_reset(struct dvb_usb_adapter *adap)
841 int ret;
842 u8 req;
843 u16 value;
844 u16 index;
845 int blen;
847 /* reset demodulator */
848 req = 0xC0;
849 value = 1; /* high */
850 index = 3;
851 blen = 0;
853 ret = az6027_usb_out_op(adap->dev, req, value, index, NULL, blen);
854 if (ret != 0)
855 return -EIO;
857 req = 0xC0;
858 value = 0; /* low */
859 index = 3;
860 blen = 0;
861 msleep_interruptible(200);
863 ret = az6027_usb_out_op(adap->dev, req, value, index, NULL, blen);
864 if (ret != 0)
865 return -EIO;
867 msleep_interruptible(200);
869 req = 0xC0;
870 value = 1; /*high */
871 index = 3;
872 blen = 0;
874 ret = az6027_usb_out_op(adap->dev, req, value, index, NULL, blen);
875 if (ret != 0)
876 return -EIO;
878 msleep_interruptible(200);
879 return 0;
882 static int az6027_frontend_tsbypass(struct dvb_usb_adapter *adap, int onoff)
884 int ret;
885 u8 req;
886 u16 value;
887 u16 index;
888 int blen;
890 /* TS passthrough */
891 req = 0xC7;
892 value = onoff;
893 index = 0;
894 blen = 0;
896 ret = az6027_usb_out_op(adap->dev, req, value, index, NULL, blen);
897 if (ret != 0)
898 return -EIO;
900 return 0;
903 static int az6027_frontend_attach(struct dvb_usb_adapter *adap)
906 az6027_frontend_poweron(adap);
907 az6027_frontend_reset(adap);
909 deb_info("adap = %p, dev = %p\n", adap, adap->dev);
910 adap->fe_adap[0].fe = stb0899_attach(&az6027_stb0899_config, &adap->dev->i2c_adap);
912 if (adap->fe_adap[0].fe) {
913 deb_info("found STB0899 DVB-S/DVB-S2 frontend @0x%02x", az6027_stb0899_config.demod_address);
914 if (stb6100_attach(adap->fe_adap[0].fe, &az6027_stb6100_config, &adap->dev->i2c_adap)) {
915 deb_info("found STB6100 DVB-S/DVB-S2 frontend @0x%02x", az6027_stb6100_config.tuner_address);
916 adap->fe_adap[0].fe->ops.set_voltage = az6027_set_voltage;
917 az6027_ci_init(adap);
918 } else {
919 adap->fe_adap[0].fe = NULL;
921 } else
922 warn("no front-end attached\n");
924 az6027_frontend_tsbypass(adap, 0);
926 return 0;
929 static struct dvb_usb_device_properties az6027_properties;
931 static void az6027_usb_disconnect(struct usb_interface *intf)
933 struct dvb_usb_device *d = usb_get_intfdata(intf);
934 az6027_ci_uninit(d);
935 dvb_usb_device_exit(intf);
939 static int az6027_usb_probe(struct usb_interface *intf,
940 const struct usb_device_id *id)
942 return dvb_usb_device_init(intf,
943 &az6027_properties,
944 THIS_MODULE,
945 NULL,
946 adapter_nr);
949 /* I2C */
950 static int az6027_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msg[], int num)
952 struct dvb_usb_device *d = i2c_get_adapdata(adap);
953 int i = 0, j = 0, len = 0;
954 u16 index;
955 u16 value;
956 int length;
957 u8 req;
958 u8 *data;
960 data = kmalloc(256, GFP_KERNEL);
961 if (!data)
962 return -ENOMEM;
964 if (mutex_lock_interruptible(&d->i2c_mutex) < 0) {
965 kfree(data);
966 return -EAGAIN;
969 if (num > 2)
970 warn("more than 2 i2c messages at a time is not handled yet. TODO.");
972 for (i = 0; i < num; i++) {
974 if (msg[i].addr == 0x99) {
975 req = 0xBE;
976 index = 0;
977 value = msg[i].buf[0] & 0x00ff;
978 length = 1;
979 az6027_usb_out_op(d, req, value, index, data, length);
982 if (msg[i].addr == 0xd0) {
983 /* write/read request */
984 if (i + 1 < num && (msg[i + 1].flags & I2C_M_RD)) {
985 req = 0xB9;
986 index = (((msg[i].buf[0] << 8) & 0xff00) | (msg[i].buf[1] & 0x00ff));
987 value = msg[i].addr + (msg[i].len << 8);
988 length = msg[i + 1].len + 6;
989 az6027_usb_in_op(d, req, value, index, data, length);
990 len = msg[i + 1].len;
991 for (j = 0; j < len; j++)
992 msg[i + 1].buf[j] = data[j + 5];
994 i++;
995 } else {
997 /* demod 16bit addr */
998 req = 0xBD;
999 index = (((msg[i].buf[0] << 8) & 0xff00) | (msg[i].buf[1] & 0x00ff));
1000 value = msg[i].addr + (2 << 8);
1001 length = msg[i].len - 2;
1002 len = msg[i].len - 2;
1003 for (j = 0; j < len; j++)
1004 data[j] = msg[i].buf[j + 2];
1005 az6027_usb_out_op(d, req, value, index, data, length);
1009 if (msg[i].addr == 0xc0) {
1010 if (msg[i].flags & I2C_M_RD) {
1012 req = 0xB9;
1013 index = 0x0;
1014 value = msg[i].addr;
1015 length = msg[i].len + 6;
1016 az6027_usb_in_op(d, req, value, index, data, length);
1017 len = msg[i].len;
1018 for (j = 0; j < len; j++)
1019 msg[i].buf[j] = data[j + 5];
1021 } else {
1023 req = 0xBD;
1024 index = msg[i].buf[0] & 0x00FF;
1025 value = msg[i].addr + (1 << 8);
1026 length = msg[i].len - 1;
1027 len = msg[i].len - 1;
1029 for (j = 0; j < len; j++)
1030 data[j] = msg[i].buf[j + 1];
1032 az6027_usb_out_op(d, req, value, index, data, length);
1036 mutex_unlock(&d->i2c_mutex);
1037 kfree(data);
1039 return i;
1043 static u32 az6027_i2c_func(struct i2c_adapter *adapter)
1045 return I2C_FUNC_I2C;
1048 static struct i2c_algorithm az6027_i2c_algo = {
1049 .master_xfer = az6027_i2c_xfer,
1050 .functionality = az6027_i2c_func,
1053 static int az6027_identify_state(struct usb_device *udev,
1054 struct dvb_usb_device_properties *props,
1055 struct dvb_usb_device_description **desc,
1056 int *cold)
1058 u8 *b;
1059 s16 ret;
1061 b = kmalloc(16, GFP_KERNEL);
1062 if (!b)
1063 return -ENOMEM;
1065 ret = usb_control_msg(udev,
1066 usb_rcvctrlpipe(udev, 0),
1067 0xb7,
1068 USB_TYPE_VENDOR | USB_DIR_IN,
1073 USB_CTRL_GET_TIMEOUT);
1075 *cold = ret <= 0;
1076 kfree(b);
1077 deb_info("cold: %d\n", *cold);
1078 return 0;
1082 static struct usb_device_id az6027_usb_table[] = {
1083 { USB_DEVICE(USB_VID_AZUREWAVE, USB_PID_AZUREWAVE_AZ6027) },
1084 { USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_DVBS2CI_V1) },
1085 { USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_DVBS2CI_V2) },
1086 { USB_DEVICE(USB_VID_TECHNISAT, USB_PID_TECHNISAT_USB2_HDCI_V1) },
1087 { USB_DEVICE(USB_VID_TECHNISAT, USB_PID_TECHNISAT_USB2_HDCI_V2) },
1088 { USB_DEVICE(USB_VID_ELGATO, USB_PID_ELGATO_EYETV_SAT) },
1089 { USB_DEVICE(USB_VID_ELGATO, USB_PID_ELGATO_EYETV_SAT_V2) },
1090 { USB_DEVICE(USB_VID_ELGATO, USB_PID_ELGATO_EYETV_SAT_V3) },
1091 { },
1094 MODULE_DEVICE_TABLE(usb, az6027_usb_table);
1096 static struct dvb_usb_device_properties az6027_properties = {
1097 .caps = DVB_USB_IS_AN_I2C_ADAPTER,
1098 .usb_ctrl = CYPRESS_FX2,
1099 .firmware = "dvb-usb-az6027-03.fw",
1100 .no_reconnect = 1,
1102 .size_of_priv = sizeof(struct az6027_device_state),
1103 .identify_state = az6027_identify_state,
1104 .num_adapters = 1,
1105 .adapter = {
1107 .num_frontends = 1,
1108 .fe = {{
1109 .streaming_ctrl = az6027_streaming_ctrl,
1110 .frontend_attach = az6027_frontend_attach,
1112 /* parameter for the MPEG2-data transfer */
1113 .stream = {
1114 .type = USB_BULK,
1115 .count = 10,
1116 .endpoint = 0x02,
1117 .u = {
1118 .bulk = {
1119 .buffersize = 4096,
1127 .power_ctrl = az6027_power_ctrl,
1128 .read_mac_address = az6027_read_mac_addr,
1130 .rc.legacy = {
1131 .rc_map_table = rc_map_az6027_table,
1132 .rc_map_size = ARRAY_SIZE(rc_map_az6027_table),
1133 .rc_interval = 400,
1134 .rc_query = az6027_rc_query,
1137 .i2c_algo = &az6027_i2c_algo,
1139 .num_device_descs = 8,
1140 .devices = {
1142 .name = "AZUREWAVE DVB-S/S2 USB2.0 (AZ6027)",
1143 .cold_ids = { &az6027_usb_table[0], NULL },
1144 .warm_ids = { NULL },
1145 }, {
1146 .name = "TERRATEC S7",
1147 .cold_ids = { &az6027_usb_table[1], NULL },
1148 .warm_ids = { NULL },
1149 }, {
1150 .name = "TERRATEC S7 MKII",
1151 .cold_ids = { &az6027_usb_table[2], NULL },
1152 .warm_ids = { NULL },
1153 }, {
1154 .name = "Technisat SkyStar USB 2 HD CI",
1155 .cold_ids = { &az6027_usb_table[3], NULL },
1156 .warm_ids = { NULL },
1157 }, {
1158 .name = "Technisat SkyStar USB 2 HD CI",
1159 .cold_ids = { &az6027_usb_table[4], NULL },
1160 .warm_ids = { NULL },
1161 }, {
1162 .name = "Elgato EyeTV Sat",
1163 .cold_ids = { &az6027_usb_table[5], NULL },
1164 .warm_ids = { NULL },
1165 }, {
1166 .name = "Elgato EyeTV Sat",
1167 .cold_ids = { &az6027_usb_table[6], NULL },
1168 .warm_ids = { NULL },
1169 }, {
1170 .name = "Elgato EyeTV Sat",
1171 .cold_ids = { &az6027_usb_table[7], NULL },
1172 .warm_ids = { NULL },
1174 { NULL },
1178 /* usb specific object needed to register this driver with the usb subsystem */
1179 static struct usb_driver az6027_usb_driver = {
1180 .name = "dvb_usb_az6027",
1181 .probe = az6027_usb_probe,
1182 .disconnect = az6027_usb_disconnect,
1183 .id_table = az6027_usb_table,
1186 module_usb_driver(az6027_usb_driver);
1188 MODULE_AUTHOR("Adams Xu <Adams.xu@azwave.com.cn>");
1189 MODULE_DESCRIPTION("Driver for AZUREWAVE DVB-S/S2 USB2.0 (AZ6027)");
1190 MODULE_VERSION("1.0");
1191 MODULE_LICENSE("GPL");