2 * Linux driver for digital TV devices equipped with B2C2 FlexcopII(b)/III
3 * flexcop-usb.c - covers the USB part
4 * see flexcop.c for copyright information
6 #define FC_LOG_PREFIX "flexcop_usb"
7 #include "flexcop-usb.h"
8 #include "flexcop-common.h"
10 /* Version information */
11 #define DRIVER_VERSION "0.1"
12 #define DRIVER_NAME "Technisat/B2C2 FlexCop II/IIb/III Digital TV USB Driver"
13 #define DRIVER_AUTHOR "Patrick Boettcher <patrick.boettcher@posteo.de>"
16 #ifdef CONFIG_DVB_B2C2_FLEXCOP_DEBUG
17 #define dprintk(level,args...) \
18 do { if ((debug & level)) printk(args); } while (0)
20 #define debug_dump(b, l, method) do {\
22 for (i = 0; i < l; i++) \
23 method("%02x ", b[i]); \
29 #define dprintk(level, args...)
30 #define debug_dump(b, l, method)
31 #define DEBSTATUS " (debugging is not enabled)"
35 module_param(debug
, int, 0644);
36 MODULE_PARM_DESC(debug
, "set debugging level (1=info,ts=2,ctrl=4,i2c=8,v8mem=16 (or-able))." DEBSTATUS
);
39 #define deb_info(args...) dprintk(0x01, args)
40 #define deb_ts(args...) dprintk(0x02, args)
41 #define deb_ctrl(args...) dprintk(0x04, args)
42 #define deb_i2c(args...) dprintk(0x08, args)
43 #define deb_v8(args...) dprintk(0x10, args)
45 /* JLP 111700: we will include the 1 bit gap between the upper and lower 3 bits
46 * in the IBI address, to make the V8 code simpler.
47 * PCI ADDRESS FORMAT: 0x71C -> 0000 0111 0001 1100 (the six bits used)
48 * in general: 0000 0HHH 000L LL00
49 * IBI ADDRESS FORMAT: RHHH BLLL
51 * where R is the read(1)/write(0) bit, B is the busy bit
52 * and HHH and LLL are the two sets of three bits from the PCI address.
54 #define B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(usPCI) (u8) \
55 (((usPCI >> 2) & 0x07) + ((usPCI >> 4) & 0x70))
56 #define B2C2_FLEX_INTERNALADDR_TO_PCIOFFSET(ucAddr) (u16) \
57 (((ucAddr & 0x07) << 2) + ((ucAddr & 0x70) << 4))
61 * - forget about this VENDOR_BUFFER_SIZE, read and write register
62 * deal with DWORD or 4 bytes, that should be should from now on
63 * - from now on, we don't support anything older than firm 1.00
64 * I eliminated the write register as a 2 trip of writing hi word and lo word
65 * and force this to write only 4 bytes at a time.
66 * NOTE: this should work with all the firmware from 1.00 and newer
68 static int flexcop_usb_readwrite_dw(struct flexcop_device
*fc
, u16 wRegOffsPCI
, u32
*val
, u8 read
)
70 struct flexcop_usb
*fc_usb
= fc
->bus_specific
;
71 u8 request
= read
? B2C2_USB_READ_REG
: B2C2_USB_WRITE_REG
;
72 u8 request_type
= (read
? USB_DIR_IN
: USB_DIR_OUT
) | USB_TYPE_VENDOR
;
73 u8 wAddress
= B2C2_FLEX_PCIOFFSET_TO_INTERNALADDR(wRegOffsPCI
) |
77 mutex_lock(&fc_usb
->data_mutex
);
79 memcpy(fc_usb
->data
, val
, sizeof(*val
));
81 ret
= usb_control_msg(fc_usb
->udev
,
82 read
? B2C2_USB_CTRL_PIPE_IN
: B2C2_USB_CTRL_PIPE_OUT
,
84 request_type
, /* 0xc0 read or 0x40 write */
89 B2C2_WAIT_FOR_OPERATION_RDW
* HZ
);
91 if (ret
!= sizeof(u32
)) {
92 err("error while %s dword from %d (%d).", read
? "reading" :
93 "writing", wAddress
, wRegOffsPCI
);
99 memcpy(val
, fc_usb
->data
, sizeof(*val
));
100 mutex_unlock(&fc_usb
->data_mutex
);
105 * DKT 010817 - add support for V8 memory read/write and flash update
107 static int flexcop_usb_v8_memory_req(struct flexcop_usb
*fc_usb
,
108 flexcop_usb_request_t req
, u8 page
, u16 wAddress
,
109 u8
*pbBuffer
, u32 buflen
)
111 u8 request_type
= USB_TYPE_VENDOR
;
113 int nWaitTime
, pipe
, ret
;
116 if (buflen
> sizeof(fc_usb
->data
)) {
117 err("Buffer size bigger than max URB control message\n");
122 case B2C2_USB_READ_V8_MEM
:
123 nWaitTime
= B2C2_WAIT_FOR_OPERATION_V8READ
;
124 request_type
|= USB_DIR_IN
;
125 pipe
= B2C2_USB_CTRL_PIPE_IN
;
127 case B2C2_USB_WRITE_V8_MEM
:
128 wIndex
|= pbBuffer
[0];
129 request_type
|= USB_DIR_OUT
;
130 nWaitTime
= B2C2_WAIT_FOR_OPERATION_V8WRITE
;
131 pipe
= B2C2_USB_CTRL_PIPE_OUT
;
133 case B2C2_USB_FLASH_BLOCK
:
134 request_type
|= USB_DIR_OUT
;
135 nWaitTime
= B2C2_WAIT_FOR_OPERATION_V8FLASH
;
136 pipe
= B2C2_USB_CTRL_PIPE_OUT
;
139 deb_info("unsupported request for v8_mem_req %x.\n", req
);
142 deb_v8("v8mem: %02x %02x %04x %04x, len: %d\n", request_type
, req
,
143 wAddress
, wIndex
, buflen
);
145 mutex_lock(&fc_usb
->data_mutex
);
147 if ((request_type
& USB_ENDPOINT_DIR_MASK
) == USB_DIR_OUT
)
148 memcpy(fc_usb
->data
, pbBuffer
, buflen
);
150 ret
= usb_control_msg(fc_usb
->udev
, pipe
,
163 if ((request_type
& USB_ENDPOINT_DIR_MASK
) == USB_DIR_IN
)
164 memcpy(pbBuffer
, fc_usb
->data
, buflen
);
167 mutex_unlock(&fc_usb
->data_mutex
);
169 debug_dump(pbBuffer
, ret
, deb_v8
);
173 #define bytes_left_to_read_on_page(paddr,buflen) \
174 ((V8_MEMORY_PAGE_SIZE - (paddr & V8_MEMORY_PAGE_MASK)) > buflen \
175 ? buflen : (V8_MEMORY_PAGE_SIZE - (paddr & V8_MEMORY_PAGE_MASK)))
177 static int flexcop_usb_memory_req(struct flexcop_usb
*fc_usb
,
178 flexcop_usb_request_t req
, flexcop_usb_mem_page_t page_start
,
179 u32 addr
, int extended
, u8
*buf
, u32 len
)
186 case B2C2_USB_READ_V8_MEM
:
187 wMax
= USB_MEM_READ_MAX
;
189 case B2C2_USB_WRITE_V8_MEM
:
190 wMax
= USB_MEM_WRITE_MAX
;
192 case B2C2_USB_FLASH_BLOCK
:
193 wMax
= USB_FLASH_MAX
;
199 for (i
= 0; i
< len
;) {
201 wMax
< bytes_left_to_read_on_page(addr
, len
) ?
203 bytes_left_to_read_on_page(addr
, len
);
205 (addr
& V8_MEMORY_PAGE_MASK
) |
206 (V8_MEMORY_EXTENDED
*extended
));
208 ret
= flexcop_usb_v8_memory_req(fc_usb
, req
,
209 page_start
+ (addr
/ V8_MEMORY_PAGE_SIZE
),
210 (addr
& V8_MEMORY_PAGE_MASK
) |
211 (V8_MEMORY_EXTENDED
*extended
),
222 static int flexcop_usb_get_mac_addr(struct flexcop_device
*fc
, int extended
)
224 return flexcop_usb_memory_req(fc
->bus_specific
, B2C2_USB_READ_V8_MEM
,
225 V8_MEMORY_PAGE_FLASH
, 0x1f010, 1,
226 fc
->dvb_adapter
.proposed_mac
, 6);
230 static int flexcop_usb_i2c_req(struct flexcop_i2c_adapter
*i2c
,
231 flexcop_usb_request_t req
, flexcop_usb_i2c_function_t func
,
232 u8 chipaddr
, u8 addr
, u8
*buf
, u8 buflen
)
234 struct flexcop_usb
*fc_usb
= i2c
->fc
->bus_specific
;
236 int nWaitTime
, pipe
, ret
;
237 u8 request_type
= USB_TYPE_VENDOR
;
239 if (buflen
> sizeof(fc_usb
->data
)) {
240 err("Buffer size bigger than max URB control message\n");
245 case USB_FUNC_I2C_WRITE
:
246 case USB_FUNC_I2C_MULTIWRITE
:
247 case USB_FUNC_I2C_REPEATWRITE
:
248 /* DKT 020208 - add this to support special case of DiSEqC */
249 case USB_FUNC_I2C_CHECKWRITE
:
250 pipe
= B2C2_USB_CTRL_PIPE_OUT
;
252 request_type
|= USB_DIR_OUT
;
254 case USB_FUNC_I2C_READ
:
255 case USB_FUNC_I2C_REPEATREAD
:
256 pipe
= B2C2_USB_CTRL_PIPE_IN
;
258 request_type
|= USB_DIR_IN
;
261 deb_info("unsupported function for i2c_req %x\n", func
);
264 wValue
= (func
<< 8) | (i2c
->port
<< 4);
265 wIndex
= (chipaddr
<< 8 ) | addr
;
267 deb_i2c("i2c %2d: %02x %02x %02x %02x %02x %02x\n",
268 func
, request_type
, req
,
269 wValue
& 0xff, wValue
>> 8,
270 wIndex
& 0xff, wIndex
>> 8);
272 mutex_lock(&fc_usb
->data_mutex
);
274 if ((request_type
& USB_ENDPOINT_DIR_MASK
) == USB_DIR_OUT
)
275 memcpy(fc_usb
->data
, buf
, buflen
);
277 ret
= usb_control_msg(fc_usb
->udev
, pipe
,
291 if ((request_type
& USB_ENDPOINT_DIR_MASK
) == USB_DIR_IN
)
292 memcpy(buf
, fc_usb
->data
, buflen
);
295 mutex_unlock(&fc_usb
->data_mutex
);
300 /* actual bus specific access functions,
301 make sure prototype are/will be equal to pci */
302 static flexcop_ibi_value
flexcop_usb_read_ibi_reg(struct flexcop_device
*fc
,
303 flexcop_ibi_register reg
)
305 flexcop_ibi_value val
;
307 flexcop_usb_readwrite_dw(fc
, reg
, &val
.raw
, 1);
311 static int flexcop_usb_write_ibi_reg(struct flexcop_device
*fc
,
312 flexcop_ibi_register reg
, flexcop_ibi_value val
)
314 return flexcop_usb_readwrite_dw(fc
, reg
, &val
.raw
, 0);
317 static int flexcop_usb_i2c_request(struct flexcop_i2c_adapter
*i2c
,
318 flexcop_access_op_t op
, u8 chipaddr
, u8 addr
, u8
*buf
, u16 len
)
321 return flexcop_usb_i2c_req(i2c
, B2C2_USB_I2C_REQUEST
,
322 USB_FUNC_I2C_READ
, chipaddr
, addr
, buf
, len
);
324 return flexcop_usb_i2c_req(i2c
, B2C2_USB_I2C_REQUEST
,
325 USB_FUNC_I2C_WRITE
, chipaddr
, addr
, buf
, len
);
328 static void flexcop_usb_process_frame(struct flexcop_usb
*fc_usb
,
329 u8
*buffer
, int buffer_length
)
334 deb_ts("tmp_buffer_length=%d, buffer_length=%d\n",
335 fc_usb
->tmp_buffer_length
, buffer_length
);
337 if (fc_usb
->tmp_buffer_length
> 0) {
338 memcpy(fc_usb
->tmp_buffer
+fc_usb
->tmp_buffer_length
, buffer
,
340 fc_usb
->tmp_buffer_length
+= buffer_length
;
341 b
= fc_usb
->tmp_buffer
;
342 l
= fc_usb
->tmp_buffer_length
;
350 switch (*(b
+1) & 0x03) {
351 case 0x01: /* media packet */
353 flexcop_pass_dmx_packets(
354 fc_usb
->fc_dev
, b
+2, 1);
356 deb_ts("not ts packet %*ph\n", 4, b
+2);
361 deb_ts("wrong packet type\n");
366 deb_ts("wrong header\n");
372 memcpy(fc_usb
->tmp_buffer
, b
, l
);
373 fc_usb
->tmp_buffer_length
= l
;
376 static void flexcop_usb_urb_complete(struct urb
*urb
)
378 struct flexcop_usb
*fc_usb
= urb
->context
;
381 if (urb
->actual_length
> 0)
382 deb_ts("urb completed, bufsize: %d actlen; %d\n",
383 urb
->transfer_buffer_length
, urb
->actual_length
);
385 for (i
= 0; i
< urb
->number_of_packets
; i
++) {
386 if (urb
->iso_frame_desc
[i
].status
< 0) {
387 err("iso frame descriptor %d has an error: %d\n", i
,
388 urb
->iso_frame_desc
[i
].status
);
390 if (urb
->iso_frame_desc
[i
].actual_length
> 0) {
391 deb_ts("passed %d bytes to the demux\n",
392 urb
->iso_frame_desc
[i
].actual_length
);
394 flexcop_usb_process_frame(fc_usb
,
395 urb
->transfer_buffer
+
396 urb
->iso_frame_desc
[i
].offset
,
397 urb
->iso_frame_desc
[i
].actual_length
);
399 urb
->iso_frame_desc
[i
].status
= 0;
400 urb
->iso_frame_desc
[i
].actual_length
= 0;
402 usb_submit_urb(urb
,GFP_ATOMIC
);
405 static int flexcop_usb_stream_control(struct flexcop_device
*fc
, int onoff
)
407 /* submit/kill iso packets */
411 static void flexcop_usb_transfer_exit(struct flexcop_usb
*fc_usb
)
414 for (i
= 0; i
< B2C2_USB_NUM_ISO_URB
; i
++)
415 if (fc_usb
->iso_urb
[i
] != NULL
) {
416 deb_ts("unlinking/killing urb no. %d\n",i
);
417 usb_kill_urb(fc_usb
->iso_urb
[i
]);
418 usb_free_urb(fc_usb
->iso_urb
[i
]);
421 if (fc_usb
->iso_buffer
!= NULL
)
422 usb_free_coherent(fc_usb
->udev
,
423 fc_usb
->buffer_size
, fc_usb
->iso_buffer
,
427 static int flexcop_usb_transfer_init(struct flexcop_usb
*fc_usb
)
429 u16 frame_size
= le16_to_cpu(
430 fc_usb
->uintf
->cur_altsetting
->endpoint
[0].desc
.wMaxPacketSize
);
431 int bufsize
= B2C2_USB_NUM_ISO_URB
* B2C2_USB_FRAMES_PER_ISO
*
432 frame_size
, i
, j
, ret
;
433 int buffer_offset
= 0;
435 deb_ts("creating %d iso-urbs with %d frames each of %d bytes size = %d.\n",
436 B2C2_USB_NUM_ISO_URB
,
437 B2C2_USB_FRAMES_PER_ISO
, frame_size
, bufsize
);
439 fc_usb
->iso_buffer
= usb_alloc_coherent(fc_usb
->udev
,
440 bufsize
, GFP_KERNEL
, &fc_usb
->dma_addr
);
441 if (fc_usb
->iso_buffer
== NULL
)
444 memset(fc_usb
->iso_buffer
, 0, bufsize
);
445 fc_usb
->buffer_size
= bufsize
;
447 /* creating iso urbs */
448 for (i
= 0; i
< B2C2_USB_NUM_ISO_URB
; i
++) {
449 fc_usb
->iso_urb
[i
] = usb_alloc_urb(B2C2_USB_FRAMES_PER_ISO
,
451 if (fc_usb
->iso_urb
[i
] == NULL
) {
457 /* initialising and submitting iso urbs */
458 for (i
= 0; i
< B2C2_USB_NUM_ISO_URB
; i
++) {
459 int frame_offset
= 0;
460 struct urb
*urb
= fc_usb
->iso_urb
[i
];
461 deb_ts("initializing and submitting urb no. %d (buf_offset: %d).\n",
464 urb
->dev
= fc_usb
->udev
;
465 urb
->context
= fc_usb
;
466 urb
->complete
= flexcop_usb_urb_complete
;
467 urb
->pipe
= B2C2_USB_DATA_PIPE
;
468 urb
->transfer_flags
= URB_ISO_ASAP
;
470 urb
->number_of_packets
= B2C2_USB_FRAMES_PER_ISO
;
471 urb
->transfer_buffer_length
= frame_size
* B2C2_USB_FRAMES_PER_ISO
;
472 urb
->transfer_buffer
= fc_usb
->iso_buffer
+ buffer_offset
;
474 buffer_offset
+= frame_size
* B2C2_USB_FRAMES_PER_ISO
;
475 for (j
= 0; j
< B2C2_USB_FRAMES_PER_ISO
; j
++) {
476 deb_ts("urb no: %d, frame: %d, frame_offset: %d\n",
478 urb
->iso_frame_desc
[j
].offset
= frame_offset
;
479 urb
->iso_frame_desc
[j
].length
= frame_size
;
480 frame_offset
+= frame_size
;
483 if ((ret
= usb_submit_urb(fc_usb
->iso_urb
[i
],GFP_ATOMIC
))) {
484 err("submitting urb %d failed with %d.", i
, ret
);
487 deb_ts("submitted urb no. %d.\n",i
);
491 flexcop_sram_set_dest(fc_usb
->fc_dev
, FC_SRAM_DEST_MEDIA
|
492 FC_SRAM_DEST_NET
| FC_SRAM_DEST_CAO
| FC_SRAM_DEST_CAI
,
493 FC_SRAM_DEST_TARGET_WAN_USB
);
494 flexcop_wan_set_speed(fc_usb
->fc_dev
, FC_WAN_SPEED_8MBITS
);
495 flexcop_sram_ctrl(fc_usb
->fc_dev
, 1, 1, 1);
499 flexcop_usb_transfer_exit(fc_usb
);
503 static int flexcop_usb_init(struct flexcop_usb
*fc_usb
)
505 /* use the alternate setting with the larges buffer */
506 int ret
= usb_set_interface(fc_usb
->udev
, 0, 1);
509 err("set interface failed.");
513 if (fc_usb
->uintf
->cur_altsetting
->desc
.bNumEndpoints
< 1)
516 switch (fc_usb
->udev
->speed
) {
518 err("cannot handle USB speed because it is too slow.");
522 info("running at FULL speed.");
525 info("running at HIGH speed.");
527 case USB_SPEED_UNKNOWN
: /* fall through */
529 err("cannot handle USB speed because it is unknown.");
532 usb_set_intfdata(fc_usb
->uintf
, fc_usb
);
536 static void flexcop_usb_exit(struct flexcop_usb
*fc_usb
)
538 usb_set_intfdata(fc_usb
->uintf
, NULL
);
541 static int flexcop_usb_probe(struct usb_interface
*intf
,
542 const struct usb_device_id
*id
)
544 struct usb_device
*udev
= interface_to_usbdev(intf
);
545 struct flexcop_usb
*fc_usb
= NULL
;
546 struct flexcop_device
*fc
= NULL
;
549 if ((fc
= flexcop_device_kmalloc(sizeof(struct flexcop_usb
))) == NULL
) {
550 err("out of memory\n");
554 /* general flexcop init */
555 fc_usb
= fc
->bus_specific
;
557 mutex_init(&fc_usb
->data_mutex
);
559 fc
->read_ibi_reg
= flexcop_usb_read_ibi_reg
;
560 fc
->write_ibi_reg
= flexcop_usb_write_ibi_reg
;
561 fc
->i2c_request
= flexcop_usb_i2c_request
;
562 fc
->get_mac_addr
= flexcop_usb_get_mac_addr
;
564 fc
->stream_control
= flexcop_usb_stream_control
;
566 fc
->pid_filtering
= 1;
567 fc
->bus_type
= FC_USB
;
569 fc
->dev
= &udev
->dev
;
570 fc
->owner
= THIS_MODULE
;
572 /* bus specific part */
574 fc_usb
->uintf
= intf
;
575 if ((ret
= flexcop_usb_init(fc_usb
)) != 0)
579 if ((ret
= flexcop_device_initialize(fc
)) != 0)
583 if ((ret
= flexcop_usb_transfer_init(fc_usb
)) != 0)
586 info("%s successfully initialized and connected.", DRIVER_NAME
);
590 flexcop_device_exit(fc
);
592 flexcop_usb_exit(fc_usb
);
594 flexcop_device_kfree(fc
);
598 static void flexcop_usb_disconnect(struct usb_interface
*intf
)
600 struct flexcop_usb
*fc_usb
= usb_get_intfdata(intf
);
601 flexcop_usb_transfer_exit(fc_usb
);
602 flexcop_device_exit(fc_usb
->fc_dev
);
603 flexcop_usb_exit(fc_usb
);
604 flexcop_device_kfree(fc_usb
->fc_dev
);
605 info("%s successfully deinitialized and disconnected.", DRIVER_NAME
);
608 static const struct usb_device_id flexcop_usb_table
[] = {
609 { USB_DEVICE(0x0af7, 0x0101) },
612 MODULE_DEVICE_TABLE (usb
, flexcop_usb_table
);
614 /* usb specific object needed to register this driver with the usb subsystem */
615 static struct usb_driver flexcop_usb_driver
= {
616 .name
= "b2c2_flexcop_usb",
617 .probe
= flexcop_usb_probe
,
618 .disconnect
= flexcop_usb_disconnect
,
619 .id_table
= flexcop_usb_table
,
622 module_usb_driver(flexcop_usb_driver
);
624 MODULE_AUTHOR(DRIVER_AUTHOR
);
625 MODULE_DESCRIPTION(DRIVER_NAME
);
626 MODULE_LICENSE("GPL");