Version:  2.0.40 2.2.26 2.4.37 3.0 3.1 3.2 3.3 3.4 3.5 3.6 3.7 3.8 3.9 3.10 3.11 3.12 3.13 3.14 3.15 3.16

Linux/drivers/media/usb/dvb-usb-v2/az6007.c

  1 /*
  2  * Driver for AzureWave 6007 DVB-C/T USB2.0 and clones
  3  *
  4  * Copyright (c) Henry Wang <Henry.wang@AzureWave.com>
  5  *
  6  * This driver was made publicly available by Terratec, at:
  7  *      http://linux.terratec.de/files/TERRATEC_H7/20110323_TERRATEC_H7_Linux.tar.gz
  8  * The original driver's license is GPL, as declared with MODULE_LICENSE()
  9  *
 10  * Copyright (c) 2010-2012 Mauro Carvalho Chehab
 11  *      Driver modified by in order to work with upstream drxk driver, and
 12  *      tons of bugs got fixed, and converted to use dvb-usb-v2.
 13  *
 14  * This program is free software; you can redistribute it and/or modify
 15  * it under the terms of the GNU General Public License as published by
 16  * the Free Software Foundation under version 2 of the License.
 17  *
 18  * This program is distributed in the hope that it will be useful,
 19  * but WITHOUT ANY WARRANTY; without even the implied warranty of
 20  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 21  * GNU General Public License for more details.
 22  */
 23 
 24 #include "drxk.h"
 25 #include "mt2063.h"
 26 #include "dvb_ca_en50221.h"
 27 #include "dvb_usb.h"
 28 #include "cypress_firmware.h"
 29 
 30 #define AZ6007_FIRMWARE "dvb-usb-terratec-h7-az6007.fw"
 31 
 32 static int az6007_xfer_debug;
 33 module_param_named(xfer_debug, az6007_xfer_debug, int, 0644);
 34 MODULE_PARM_DESC(xfer_debug, "Enable xfer debug");
 35 
 36 DVB_DEFINE_MOD_OPT_ADAPTER_NR(adapter_nr);
 37 
 38 /* Known requests (Cypress FX2 firmware + az6007 "private" ones*/
 39 
 40 #define FX2_OED                 0xb5
 41 #define AZ6007_READ_DATA        0xb7
 42 #define AZ6007_I2C_RD           0xb9
 43 #define AZ6007_POWER            0xbc
 44 #define AZ6007_I2C_WR           0xbd
 45 #define FX2_SCON1               0xc0
 46 #define AZ6007_TS_THROUGH       0xc7
 47 #define AZ6007_READ_IR          0xb4
 48 
 49 struct az6007_device_state {
 50         struct mutex            mutex;
 51         struct mutex            ca_mutex;
 52         struct dvb_ca_en50221   ca;
 53         unsigned                warm:1;
 54         int                     (*gate_ctrl) (struct dvb_frontend *, int);
 55         unsigned char           data[4096];
 56 };
 57 
 58 static struct drxk_config terratec_h7_drxk = {
 59         .adr = 0x29,
 60         .parallel_ts = true,
 61         .dynamic_clk = true,
 62         .single_master = true,
 63         .enable_merr_cfg = true,
 64         .no_i2c_bridge = false,
 65         .chunk_size = 64,
 66         .mpeg_out_clk_strength = 0x02,
 67         .qam_demod_parameter_count = 2,
 68         .microcode_name = "dvb-usb-terratec-h7-drxk.fw",
 69 };
 70 
 71 static struct drxk_config cablestar_hdci_drxk = {
 72         .adr = 0x29,
 73         .parallel_ts = true,
 74         .dynamic_clk = true,
 75         .single_master = true,
 76         .enable_merr_cfg = true,
 77         .no_i2c_bridge = false,
 78         .chunk_size = 64,
 79         .mpeg_out_clk_strength = 0x02,
 80         .qam_demod_parameter_count = 2,
 81         .microcode_name = "dvb-usb-technisat-cablestar-hdci-drxk.fw",
 82 };
 83 
 84 static int drxk_gate_ctrl(struct dvb_frontend *fe, int enable)
 85 {
 86         struct az6007_device_state *st = fe_to_priv(fe);
 87         struct dvb_usb_adapter *adap = fe->sec_priv;
 88         int status = 0;
 89 
 90         pr_debug("%s: %s\n", __func__, enable ? "enable" : "disable");
 91 
 92         if (!adap || !st)
 93                 return -EINVAL;
 94 
 95         if (enable)
 96                 status = st->gate_ctrl(fe, 1);
 97         else
 98                 status = st->gate_ctrl(fe, 0);
 99 
100         return status;
101 }
102 
103 static struct mt2063_config az6007_mt2063_config = {
104         .tuner_address = 0x60,
105         .refclock = 36125000,
106 };
107 
108 static int __az6007_read(struct usb_device *udev, u8 req, u16 value,
109                             u16 index, u8 *b, int blen)
110 {
111         int ret;
112 
113         ret = usb_control_msg(udev,
114                               usb_rcvctrlpipe(udev, 0),
115                               req,
116                               USB_TYPE_VENDOR | USB_DIR_IN,
117                               value, index, b, blen, 5000);
118         if (ret < 0) {
119                 pr_warn("usb read operation failed. (%d)\n", ret);
120                 return -EIO;
121         }
122 
123         if (az6007_xfer_debug) {
124                 printk(KERN_DEBUG "az6007: IN  req: %02x, value: %04x, index: %04x\n",
125                        req, value, index);
126                 print_hex_dump_bytes("az6007: payload: ",
127                                      DUMP_PREFIX_NONE, b, blen);
128         }
129 
130         return ret;
131 }
132 
133 static int az6007_read(struct dvb_usb_device *d, u8 req, u16 value,
134                             u16 index, u8 *b, int blen)
135 {
136         struct az6007_device_state *st = d->priv;
137         int ret;
138 
139         if (mutex_lock_interruptible(&st->mutex) < 0)
140                 return -EAGAIN;
141 
142         ret = __az6007_read(d->udev, req, value, index, b, blen);
143 
144         mutex_unlock(&st->mutex);
145 
146         return ret;
147 }
148 
149 static int __az6007_write(struct usb_device *udev, u8 req, u16 value,
150                              u16 index, u8 *b, int blen)
151 {
152         int ret;
153 
154         if (az6007_xfer_debug) {
155                 printk(KERN_DEBUG "az6007: OUT req: %02x, value: %04x, index: %04x\n",
156                        req, value, index);
157                 print_hex_dump_bytes("az6007: payload: ",
158                                      DUMP_PREFIX_NONE, b, blen);
159         }
160 
161         if (blen > 64) {
162                 pr_err("az6007: tried to write %d bytes, but I2C max size is 64 bytes\n",
163                        blen);
164                 return -EOPNOTSUPP;
165         }
166 
167         ret = usb_control_msg(udev,
168                               usb_sndctrlpipe(udev, 0),
169                               req,
170                               USB_TYPE_VENDOR | USB_DIR_OUT,
171                               value, index, b, blen, 5000);
172         if (ret != blen) {
173                 pr_err("usb write operation failed. (%d)\n", ret);
174                 return -EIO;
175         }
176 
177         return 0;
178 }
179 
180 static int az6007_write(struct dvb_usb_device *d, u8 req, u16 value,
181                             u16 index, u8 *b, int blen)
182 {
183         struct az6007_device_state *st = d->priv;
184         int ret;
185 
186         if (mutex_lock_interruptible(&st->mutex) < 0)
187                 return -EAGAIN;
188 
189         ret = __az6007_write(d->udev, req, value, index, b, blen);
190 
191         mutex_unlock(&st->mutex);
192 
193         return ret;
194 }
195 
196 static int az6007_streaming_ctrl(struct dvb_frontend *fe, int onoff)
197 {
198         struct dvb_usb_device *d = fe_to_d(fe);
199 
200         pr_debug("%s: %s\n", __func__, onoff ? "enable" : "disable");
201 
202         return az6007_write(d, 0xbc, onoff, 0, NULL, 0);
203 }
204 
205 #if IS_ENABLED(CONFIG_RC_CORE)
206 /* remote control stuff (does not work with my box) */
207 static int az6007_rc_query(struct dvb_usb_device *d)
208 {
209         struct az6007_device_state *st = d_to_priv(d);
210         unsigned code = 0;
211 
212         az6007_read(d, AZ6007_READ_IR, 0, 0, st->data, 10);
213 
214         if (st->data[1] == 0x44)
215                 return 0;
216 
217         if ((st->data[1] ^ st->data[2]) == 0xff)
218                 code = st->data[1];
219         else
220                 code = st->data[1] << 8 | st->data[2];
221 
222         if ((st->data[3] ^ st->data[4]) == 0xff)
223                 code = code << 8 | st->data[3];
224         else
225                 code = code << 16 | st->data[3] << 8 | st->data[4];
226 
227         rc_keydown(d->rc_dev, code, st->data[5]);
228 
229         return 0;
230 }
231 
232 static int az6007_get_rc_config(struct dvb_usb_device *d, struct dvb_usb_rc *rc)
233 {
234         pr_debug("Getting az6007 Remote Control properties\n");
235 
236         rc->allowed_protos = RC_BIT_NEC;
237         rc->query          = az6007_rc_query;
238         rc->interval       = 400;
239 
240         return 0;
241 }
242 #else
243         #define az6007_get_rc_config NULL
244 #endif
245 
246 static int az6007_ci_read_attribute_mem(struct dvb_ca_en50221 *ca,
247                                         int slot,
248                                         int address)
249 {
250         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
251         struct az6007_device_state *state = d_to_priv(d);
252 
253         int ret;
254         u8 req;
255         u16 value;
256         u16 index;
257         int blen;
258         u8 *b;
259 
260         if (slot != 0)
261                 return -EINVAL;
262 
263         b = kmalloc(12, GFP_KERNEL);
264         if (!b)
265                 return -ENOMEM;
266 
267         mutex_lock(&state->ca_mutex);
268 
269         req = 0xC1;
270         value = address;
271         index = 0;
272         blen = 1;
273 
274         ret = az6007_read(d, req, value, index, b, blen);
275         if (ret < 0) {
276                 pr_warn("usb in operation failed. (%d)\n", ret);
277                 ret = -EINVAL;
278         } else {
279                 ret = b[0];
280         }
281 
282         mutex_unlock(&state->ca_mutex);
283         kfree(b);
284         return ret;
285 }
286 
287 static int az6007_ci_write_attribute_mem(struct dvb_ca_en50221 *ca,
288                                          int slot,
289                                          int address,
290                                          u8 value)
291 {
292         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
293         struct az6007_device_state *state = d_to_priv(d);
294 
295         int ret;
296         u8 req;
297         u16 value1;
298         u16 index;
299         int blen;
300 
301         pr_debug("%s(), slot %d\n", __func__, slot);
302         if (slot != 0)
303                 return -EINVAL;
304 
305         mutex_lock(&state->ca_mutex);
306         req = 0xC2;
307         value1 = address;
308         index = value;
309         blen = 0;
310 
311         ret = az6007_write(d, req, value1, index, NULL, blen);
312         if (ret != 0)
313                 pr_warn("usb out operation failed. (%d)\n", ret);
314 
315         mutex_unlock(&state->ca_mutex);
316         return ret;
317 }
318 
319 static int az6007_ci_read_cam_control(struct dvb_ca_en50221 *ca,
320                                       int slot,
321                                       u8 address)
322 {
323         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
324         struct az6007_device_state *state = d_to_priv(d);
325 
326         int ret;
327         u8 req;
328         u16 value;
329         u16 index;
330         int blen;
331         u8 *b;
332 
333         if (slot != 0)
334                 return -EINVAL;
335 
336         b = kmalloc(12, GFP_KERNEL);
337         if (!b)
338                 return -ENOMEM;
339 
340         mutex_lock(&state->ca_mutex);
341 
342         req = 0xC3;
343         value = address;
344         index = 0;
345         blen = 2;
346 
347         ret = az6007_read(d, req, value, index, b, blen);
348         if (ret < 0) {
349                 pr_warn("usb in operation failed. (%d)\n", ret);
350                 ret = -EINVAL;
351         } else {
352                 if (b[0] == 0)
353                         pr_warn("Read CI IO error\n");
354 
355                 ret = b[1];
356                 pr_debug("read cam data = %x from 0x%x\n", b[1], value);
357         }
358 
359         mutex_unlock(&state->ca_mutex);
360         kfree(b);
361         return ret;
362 }
363 
364 static int az6007_ci_write_cam_control(struct dvb_ca_en50221 *ca,
365                                        int slot,
366                                        u8 address,
367                                        u8 value)
368 {
369         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
370         struct az6007_device_state *state = d_to_priv(d);
371 
372         int ret;
373         u8 req;
374         u16 value1;
375         u16 index;
376         int blen;
377 
378         if (slot != 0)
379                 return -EINVAL;
380 
381         mutex_lock(&state->ca_mutex);
382         req = 0xC4;
383         value1 = address;
384         index = value;
385         blen = 0;
386 
387         ret = az6007_write(d, req, value1, index, NULL, blen);
388         if (ret != 0) {
389                 pr_warn("usb out operation failed. (%d)\n", ret);
390                 goto failed;
391         }
392 
393 failed:
394         mutex_unlock(&state->ca_mutex);
395         return ret;
396 }
397 
398 static int CI_CamReady(struct dvb_ca_en50221 *ca, int slot)
399 {
400         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
401 
402         int ret;
403         u8 req;
404         u16 value;
405         u16 index;
406         int blen;
407         u8 *b;
408 
409         b = kmalloc(12, GFP_KERNEL);
410         if (!b)
411                 return -ENOMEM;
412 
413         req = 0xC8;
414         value = 0;
415         index = 0;
416         blen = 1;
417 
418         ret = az6007_read(d, req, value, index, b, blen);
419         if (ret < 0) {
420                 pr_warn("usb in operation failed. (%d)\n", ret);
421                 ret = -EIO;
422         } else{
423                 ret = b[0];
424         }
425         kfree(b);
426         return ret;
427 }
428 
429 static int az6007_ci_slot_reset(struct dvb_ca_en50221 *ca, int slot)
430 {
431         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
432         struct az6007_device_state *state = d_to_priv(d);
433 
434         int ret, i;
435         u8 req;
436         u16 value;
437         u16 index;
438         int blen;
439 
440         mutex_lock(&state->ca_mutex);
441 
442         req = 0xC6;
443         value = 1;
444         index = 0;
445         blen = 0;
446 
447         ret = az6007_write(d, req, value, index, NULL, blen);
448         if (ret != 0) {
449                 pr_warn("usb out operation failed. (%d)\n", ret);
450                 goto failed;
451         }
452 
453         msleep(500);
454         req = 0xC6;
455         value = 0;
456         index = 0;
457         blen = 0;
458 
459         ret = az6007_write(d, req, value, index, NULL, blen);
460         if (ret != 0) {
461                 pr_warn("usb out operation failed. (%d)\n", ret);
462                 goto failed;
463         }
464 
465         for (i = 0; i < 15; i++) {
466                 msleep(100);
467 
468                 if (CI_CamReady(ca, slot)) {
469                         pr_debug("CAM Ready\n");
470                         break;
471                 }
472         }
473         msleep(5000);
474 
475 failed:
476         mutex_unlock(&state->ca_mutex);
477         return ret;
478 }
479 
480 static int az6007_ci_slot_shutdown(struct dvb_ca_en50221 *ca, int slot)
481 {
482         return 0;
483 }
484 
485 static int az6007_ci_slot_ts_enable(struct dvb_ca_en50221 *ca, int slot)
486 {
487         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
488         struct az6007_device_state *state = d_to_priv(d);
489 
490         int ret;
491         u8 req;
492         u16 value;
493         u16 index;
494         int blen;
495 
496         pr_debug("%s()\n", __func__);
497         mutex_lock(&state->ca_mutex);
498         req = 0xC7;
499         value = 1;
500         index = 0;
501         blen = 0;
502 
503         ret = az6007_write(d, req, value, index, NULL, blen);
504         if (ret != 0) {
505                 pr_warn("usb out operation failed. (%d)\n", ret);
506                 goto failed;
507         }
508 
509 failed:
510         mutex_unlock(&state->ca_mutex);
511         return ret;
512 }
513 
514 static int az6007_ci_poll_slot_status(struct dvb_ca_en50221 *ca, int slot, int open)
515 {
516         struct dvb_usb_device *d = (struct dvb_usb_device *)ca->data;
517         struct az6007_device_state *state = d_to_priv(d);
518         int ret;
519         u8 req;
520         u16 value;
521         u16 index;
522         int blen;
523         u8 *b;
524 
525         b = kmalloc(12, GFP_KERNEL);
526         if (!b)
527                 return -ENOMEM;
528         mutex_lock(&state->ca_mutex);
529 
530         req = 0xC5;
531         value = 0;
532         index = 0;
533         blen = 1;
534 
535         ret = az6007_read(d, req, value, index, b, blen);
536         if (ret < 0) {
537                 pr_warn("usb in operation failed. (%d)\n", ret);
538                 ret = -EIO;
539         } else
540                 ret = 0;
541 
542         if (!ret && b[0] == 1) {
543                 ret = DVB_CA_EN50221_POLL_CAM_PRESENT |
544                       DVB_CA_EN50221_POLL_CAM_READY;
545         }
546 
547         mutex_unlock(&state->ca_mutex);
548         kfree(b);
549         return ret;
550 }
551 
552 
553 static void az6007_ci_uninit(struct dvb_usb_device *d)
554 {
555         struct az6007_device_state *state;
556 
557         pr_debug("%s()\n", __func__);
558 
559         if (NULL == d)
560                 return;
561 
562         state = d_to_priv(d);
563         if (NULL == state)
564                 return;
565 
566         if (NULL == state->ca.data)
567                 return;
568 
569         dvb_ca_en50221_release(&state->ca);
570 
571         memset(&state->ca, 0, sizeof(state->ca));
572 }
573 
574 
575 static int az6007_ci_init(struct dvb_usb_adapter *adap)
576 {
577         struct dvb_usb_device *d = adap_to_d(adap);
578         struct az6007_device_state *state = adap_to_priv(adap);
579         int ret;
580 
581         pr_debug("%s()\n", __func__);
582 
583         mutex_init(&state->ca_mutex);
584         state->ca.owner                 = THIS_MODULE;
585         state->ca.read_attribute_mem    = az6007_ci_read_attribute_mem;
586         state->ca.write_attribute_mem   = az6007_ci_write_attribute_mem;
587         state->ca.read_cam_control      = az6007_ci_read_cam_control;
588         state->ca.write_cam_control     = az6007_ci_write_cam_control;
589         state->ca.slot_reset            = az6007_ci_slot_reset;
590         state->ca.slot_shutdown         = az6007_ci_slot_shutdown;
591         state->ca.slot_ts_enable        = az6007_ci_slot_ts_enable;
592         state->ca.poll_slot_status      = az6007_ci_poll_slot_status;
593         state->ca.data                  = d;
594 
595         ret = dvb_ca_en50221_init(&adap->dvb_adap,
596                                   &state->ca,
597                                   0, /* flags */
598                                   1);/* n_slots */
599         if (ret != 0) {
600                 pr_err("Cannot initialize CI: Error %d.\n", ret);
601                 memset(&state->ca, 0, sizeof(state->ca));
602                 return ret;
603         }
604 
605         pr_debug("CI initialized.\n");
606 
607         return 0;
608 }
609 
610 static int az6007_read_mac_addr(struct dvb_usb_adapter *adap, u8 mac[6])
611 {
612         struct dvb_usb_device *d = adap_to_d(adap);
613         struct az6007_device_state *st = adap_to_priv(adap);
614         int ret;
615 
616         ret = az6007_read(d, AZ6007_READ_DATA, 6, 0, st->data, 6);
617         memcpy(mac, st->data, 6);
618 
619         if (ret > 0)
620                 pr_debug("%s: mac is %pM\n", __func__, mac);
621 
622         return ret;
623 }
624 
625 static int az6007_frontend_attach(struct dvb_usb_adapter *adap)
626 {
627         struct az6007_device_state *st = adap_to_priv(adap);
628         struct dvb_usb_device *d = adap_to_d(adap);
629 
630         pr_debug("attaching demod drxk\n");
631 
632         adap->fe[0] = dvb_attach(drxk_attach, &terratec_h7_drxk,
633                                  &d->i2c_adap);
634         if (!adap->fe[0])
635                 return -EINVAL;
636 
637         adap->fe[0]->sec_priv = adap;
638         st->gate_ctrl = adap->fe[0]->ops.i2c_gate_ctrl;
639         adap->fe[0]->ops.i2c_gate_ctrl = drxk_gate_ctrl;
640 
641         az6007_ci_init(adap);
642 
643         return 0;
644 }
645 
646 static int az6007_cablestar_hdci_frontend_attach(struct dvb_usb_adapter *adap)
647 {
648         struct az6007_device_state *st = adap_to_priv(adap);
649         struct dvb_usb_device *d = adap_to_d(adap);
650 
651         pr_debug("attaching demod drxk\n");
652 
653         adap->fe[0] = dvb_attach(drxk_attach, &cablestar_hdci_drxk,
654                                  &d->i2c_adap);
655         if (!adap->fe[0])
656                 return -EINVAL;
657 
658         adap->fe[0]->sec_priv = adap;
659         st->gate_ctrl = adap->fe[0]->ops.i2c_gate_ctrl;
660         adap->fe[0]->ops.i2c_gate_ctrl = drxk_gate_ctrl;
661 
662         az6007_ci_init(adap);
663 
664         return 0;
665 }
666 
667 static int az6007_tuner_attach(struct dvb_usb_adapter *adap)
668 {
669         struct dvb_usb_device *d = adap_to_d(adap);
670 
671         pr_debug("attaching tuner mt2063\n");
672 
673         /* Attach mt2063 to DVB-C frontend */
674         if (adap->fe[0]->ops.i2c_gate_ctrl)
675                 adap->fe[0]->ops.i2c_gate_ctrl(adap->fe[0], 1);
676         if (!dvb_attach(mt2063_attach, adap->fe[0],
677                         &az6007_mt2063_config,
678                         &d->i2c_adap))
679                 return -EINVAL;
680 
681         if (adap->fe[0]->ops.i2c_gate_ctrl)
682                 adap->fe[0]->ops.i2c_gate_ctrl(adap->fe[0], 0);
683 
684         return 0;
685 }
686 
687 static int az6007_power_ctrl(struct dvb_usb_device *d, int onoff)
688 {
689         struct az6007_device_state *state = d_to_priv(d);
690         int ret;
691 
692         pr_debug("%s()\n", __func__);
693 
694         if (!state->warm) {
695                 mutex_init(&state->mutex);
696 
697                 ret = az6007_write(d, AZ6007_POWER, 0, 2, NULL, 0);
698                 if (ret < 0)
699                         return ret;
700                 msleep(60);
701                 ret = az6007_write(d, AZ6007_POWER, 1, 4, NULL, 0);
702                 if (ret < 0)
703                         return ret;
704                 msleep(100);
705                 ret = az6007_write(d, AZ6007_POWER, 1, 3, NULL, 0);
706                 if (ret < 0)
707                         return ret;
708                 msleep(20);
709                 ret = az6007_write(d, AZ6007_POWER, 1, 4, NULL, 0);
710                 if (ret < 0)
711                         return ret;
712 
713                 msleep(400);
714                 ret = az6007_write(d, FX2_SCON1, 0, 3, NULL, 0);
715                 if (ret < 0)
716                         return ret;
717                 msleep(150);
718                 ret = az6007_write(d, FX2_SCON1, 1, 3, NULL, 0);
719                 if (ret < 0)
720                         return ret;
721                 msleep(430);
722                 ret = az6007_write(d, AZ6007_POWER, 0, 0, NULL, 0);
723                 if (ret < 0)
724                         return ret;
725 
726                 state->warm = true;
727 
728                 return 0;
729         }
730 
731         if (!onoff)
732                 return 0;
733 
734         az6007_write(d, AZ6007_POWER, 0, 0, NULL, 0);
735         az6007_write(d, AZ6007_TS_THROUGH, 0, 0, NULL, 0);
736 
737         return 0;
738 }
739 
740 /* I2C */
741 static int az6007_i2c_xfer(struct i2c_adapter *adap, struct i2c_msg msgs[],
742                            int num)
743 {
744         struct dvb_usb_device *d = i2c_get_adapdata(adap);
745         struct az6007_device_state *st = d_to_priv(d);
746         int i, j, len;
747         int ret = 0;
748         u16 index;
749         u16 value;
750         int length;
751         u8 req, addr;
752 
753         if (mutex_lock_interruptible(&st->mutex) < 0)
754                 return -EAGAIN;
755 
756         for (i = 0; i < num; i++) {
757                 addr = msgs[i].addr << 1;
758                 if (((i + 1) < num)
759                     && (msgs[i].len == 1)
760                     && ((msgs[i].flags & I2C_M_RD) != I2C_M_RD)
761                     && (msgs[i + 1].flags & I2C_M_RD)
762                     && (msgs[i].addr == msgs[i + 1].addr)) {
763                         /*
764                          * A write + read xfer for the same address, where
765                          * the first xfer has just 1 byte length.
766                          * Need to join both into one operation
767                          */
768                         if (az6007_xfer_debug)
769                                 printk(KERN_DEBUG "az6007: I2C W/R addr=0x%x len=%d/%d\n",
770                                        addr, msgs[i].len, msgs[i + 1].len);
771                         req = AZ6007_I2C_RD;
772                         index = msgs[i].buf[0];
773                         value = addr | (1 << 8);
774                         length = 6 + msgs[i + 1].len;
775                         len = msgs[i + 1].len;
776                         ret = __az6007_read(d->udev, req, value, index,
777                                             st->data, length);
778                         if (ret >= len) {
779                                 for (j = 0; j < len; j++)
780                                         msgs[i + 1].buf[j] = st->data[j + 5];
781                         } else
782                                 ret = -EIO;
783                         i++;
784                 } else if (!(msgs[i].flags & I2C_M_RD)) {
785                         /* write bytes */
786                         if (az6007_xfer_debug)
787                                 printk(KERN_DEBUG "az6007: I2C W addr=0x%x len=%d\n",
788                                        addr, msgs[i].len);
789                         req = AZ6007_I2C_WR;
790                         index = msgs[i].buf[0];
791                         value = addr | (1 << 8);
792                         length = msgs[i].len - 1;
793                         len = msgs[i].len - 1;
794                         for (j = 0; j < len; j++)
795                                 st->data[j] = msgs[i].buf[j + 1];
796                         ret =  __az6007_write(d->udev, req, value, index,
797                                               st->data, length);
798                 } else {
799                         /* read bytes */
800                         if (az6007_xfer_debug)
801                                 printk(KERN_DEBUG "az6007: I2C R addr=0x%x len=%d\n",
802                                        addr, msgs[i].len);
803                         req = AZ6007_I2C_RD;
804                         index = msgs[i].buf[0];
805                         value = addr;
806                         length = msgs[i].len + 6;
807                         len = msgs[i].len;
808                         ret = __az6007_read(d->udev, req, value, index,
809                                             st->data, length);
810                         for (j = 0; j < len; j++)
811                                 msgs[i].buf[j] = st->data[j + 5];
812                 }
813                 if (ret < 0)
814                         goto err;
815         }
816 err:
817         mutex_unlock(&st->mutex);
818 
819         if (ret < 0) {
820                 pr_info("%s ERROR: %i\n", __func__, ret);
821                 return ret;
822         }
823         return num;
824 }
825 
826 static u32 az6007_i2c_func(struct i2c_adapter *adapter)
827 {
828         return I2C_FUNC_I2C;
829 }
830 
831 static struct i2c_algorithm az6007_i2c_algo = {
832         .master_xfer = az6007_i2c_xfer,
833         .functionality = az6007_i2c_func,
834 };
835 
836 static int az6007_identify_state(struct dvb_usb_device *d, const char **name)
837 {
838         int ret;
839         u8 *mac;
840 
841         pr_debug("Identifying az6007 state\n");
842 
843         mac = kmalloc(6, GFP_ATOMIC);
844         if (!mac)
845                 return -ENOMEM;
846 
847         /* Try to read the mac address */
848         ret = __az6007_read(d->udev, AZ6007_READ_DATA, 6, 0, mac, 6);
849         if (ret == 6)
850                 ret = WARM;
851         else
852                 ret = COLD;
853 
854         kfree(mac);
855 
856         if (ret == COLD) {
857                 __az6007_write(d->udev, 0x09, 1, 0, NULL, 0);
858                 __az6007_write(d->udev, 0x00, 0, 0, NULL, 0);
859                 __az6007_write(d->udev, 0x00, 0, 0, NULL, 0);
860         }
861 
862         pr_debug("Device is on %s state\n",
863                  ret == WARM ? "warm" : "cold");
864         return ret;
865 }
866 
867 static void az6007_usb_disconnect(struct usb_interface *intf)
868 {
869         struct dvb_usb_device *d = usb_get_intfdata(intf);
870         az6007_ci_uninit(d);
871         dvb_usbv2_disconnect(intf);
872 }
873 
874 static int az6007_download_firmware(struct dvb_usb_device *d,
875         const struct firmware *fw)
876 {
877         pr_debug("Loading az6007 firmware\n");
878 
879         return cypress_load_firmware(d->udev, fw, CYPRESS_FX2);
880 }
881 
882 /* DVB USB Driver stuff */
883 static struct dvb_usb_device_properties az6007_props = {
884         .driver_name         = KBUILD_MODNAME,
885         .owner               = THIS_MODULE,
886         .firmware            = AZ6007_FIRMWARE,
887 
888         .adapter_nr          = adapter_nr,
889         .size_of_priv        = sizeof(struct az6007_device_state),
890         .i2c_algo            = &az6007_i2c_algo,
891         .tuner_attach        = az6007_tuner_attach,
892         .frontend_attach     = az6007_frontend_attach,
893         .streaming_ctrl      = az6007_streaming_ctrl,
894         .get_rc_config       = az6007_get_rc_config,
895         .read_mac_address    = az6007_read_mac_addr,
896         .download_firmware   = az6007_download_firmware,
897         .identify_state      = az6007_identify_state,
898         .power_ctrl          = az6007_power_ctrl,
899         .num_adapters        = 1,
900         .adapter             = {
901                 { .stream = DVB_USB_STREAM_BULK(0x02, 10, 4096), }
902         }
903 };
904 
905 static struct dvb_usb_device_properties az6007_cablestar_hdci_props = {
906         .driver_name         = KBUILD_MODNAME,
907         .owner               = THIS_MODULE,
908         .firmware            = AZ6007_FIRMWARE,
909 
910         .adapter_nr          = adapter_nr,
911         .size_of_priv        = sizeof(struct az6007_device_state),
912         .i2c_algo            = &az6007_i2c_algo,
913         .tuner_attach        = az6007_tuner_attach,
914         .frontend_attach     = az6007_cablestar_hdci_frontend_attach,
915         .streaming_ctrl      = az6007_streaming_ctrl,
916 /* ditch get_rc_config as it can't work (TS35 remote, I believe it's rc5) */
917         .get_rc_config       = NULL,
918         .read_mac_address    = az6007_read_mac_addr,
919         .download_firmware   = az6007_download_firmware,
920         .identify_state      = az6007_identify_state,
921         .power_ctrl          = az6007_power_ctrl,
922         .num_adapters        = 1,
923         .adapter             = {
924                 { .stream = DVB_USB_STREAM_BULK(0x02, 10, 4096), }
925         }
926 };
927 
928 static struct usb_device_id az6007_usb_table[] = {
929         {DVB_USB_DEVICE(USB_VID_AZUREWAVE, USB_PID_AZUREWAVE_6007,
930                 &az6007_props, "Azurewave 6007", RC_MAP_EMPTY)},
931         {DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_H7,
932                 &az6007_props, "Terratec H7", RC_MAP_NEC_TERRATEC_CINERGY_XS)},
933         {DVB_USB_DEVICE(USB_VID_TERRATEC, USB_PID_TERRATEC_H7_2,
934                 &az6007_props, "Terratec H7", RC_MAP_NEC_TERRATEC_CINERGY_XS)},
935         {DVB_USB_DEVICE(USB_VID_TECHNISAT, USB_PID_TECHNISAT_USB2_CABLESTAR_HDCI,
936                 &az6007_cablestar_hdci_props, "Technisat CableStar Combo HD CI", RC_MAP_EMPTY)},
937         {0},
938 };
939 
940 MODULE_DEVICE_TABLE(usb, az6007_usb_table);
941 
942 static int az6007_suspend(struct usb_interface *intf, pm_message_t msg)
943 {
944         struct dvb_usb_device *d = usb_get_intfdata(intf);
945 
946         az6007_ci_uninit(d);
947         return dvb_usbv2_suspend(intf, msg);
948 }
949 
950 static int az6007_resume(struct usb_interface *intf)
951 {
952         struct dvb_usb_device *d = usb_get_intfdata(intf);
953         struct dvb_usb_adapter *adap = &d->adapter[0];
954 
955         az6007_ci_init(adap);
956         return dvb_usbv2_resume(intf);
957 }
958 
959 /* usb specific object needed to register this driver with the usb subsystem */
960 static struct usb_driver az6007_usb_driver = {
961         .name           = KBUILD_MODNAME,
962         .id_table       = az6007_usb_table,
963         .probe          = dvb_usbv2_probe,
964         .disconnect     = az6007_usb_disconnect,
965         .no_dynamic_id  = 1,
966         .soft_unbind    = 1,
967         /*
968          * FIXME: need to implement reset_resume, likely with
969          * dvb-usb-v2 core support
970          */
971         .suspend        = az6007_suspend,
972         .resume         = az6007_resume,
973 };
974 
975 module_usb_driver(az6007_usb_driver);
976 
977 MODULE_AUTHOR("Henry Wang <Henry.wang@AzureWave.com>");
978 MODULE_AUTHOR("Mauro Carvalho Chehab");
979 MODULE_DESCRIPTION("Driver for AzureWave 6007 DVB-C/T USB2.0 and clones");
980 MODULE_VERSION("2.0");
981 MODULE_LICENSE("GPL");
982 MODULE_FIRMWARE(AZ6007_FIRMWARE);
983 

This page was automatically generated by LXR 0.3.1 (source).  •  Linux is a registered trademark of Linus Torvalds  •  Contact us