2 * TerraTec Cinergy T²/qanu USB2 DVB-T adapter.
4 * Copyright (C) 2004 Daniel Mack <daniel@qanu.de> and
5 * Holger Waechtler <holger@qanu.de>
7 * Protocol Spec published on http://qanu.de/specs/terratec_cinergyT2.pdf
9 * This program is free software; you can redistribute it and/or modify
10 * it under the terms of the GNU General Public License as published by
11 * the Free Software Foundation; either version 2 of the License, or
12 * (at your option) any later version.
14 * This program is distributed in the hope that it will be useful,
15 * but WITHOUT ANY WARRANTY; without even the implied warranty of
16 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
17 * GNU General Public License for more details.
19 * You should have received a copy of the GNU General Public License
20 * along with this program; if not, write to the Free Software
21 * Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
25 #include <linux/config.h>
26 #include <linux/init.h>
27 #include <linux/module.h>
28 #include <linux/slab.h>
29 #include <linux/usb.h>
30 #include <linux/pci.h>
31 #include <linux/input.h>
32 #include <linux/dvb/frontend.h>
35 #include "dvb_demux.h"
38 #ifdef CONFIG_DVB_CINERGYT2_TUNING
39 #define STREAM_URB_COUNT (CONFIG_DVB_CINERGYT2_STREAM_URB_COUNT)
40 #define STREAM_BUF_SIZE (CONFIG_DVB_CINERGYT2_STREAM_BUF_SIZE)
41 #define QUERY_INTERVAL (CONFIG_DVB_CINERGYT2_QUERY_INTERVAL)
42 #ifdef CONFIG_DVB_CINERGYT2_ENABLE_RC_INPUT_DEVICE
43 #define RC_QUERY_INTERVAL (CONFIG_DVB_CINERGYT2_RC_QUERY_INTERVAL)
47 #define STREAM_URB_COUNT (32)
48 #define STREAM_BUF_SIZE (512) /* bytes */
50 #define RC_QUERY_INTERVAL (50) /* milliseconds */
51 #define QUERY_INTERVAL (333) /* milliseconds */
54 #define DRIVER_NAME "TerraTec/qanu USB2.0 Highspeed DVB-T Receiver"
57 module_param_named(debug
, debug
, int, 0644);
58 MODULE_PARM_DESC(debug
, "Turn on/off debugging (default:off).");
60 #define dprintk(level, args...) \
62 if ((debug & level)) { \
63 printk("%s: %s(): ", KBUILD_MODNAME, \
68 enum cinergyt2_ep1_cmd
{
69 CINERGYT2_EP1_PID_TABLE_RESET
= 0x01,
70 CINERGYT2_EP1_PID_SETUP
= 0x02,
71 CINERGYT2_EP1_CONTROL_STREAM_TRANSFER
= 0x03,
72 CINERGYT2_EP1_SET_TUNER_PARAMETERS
= 0x04,
73 CINERGYT2_EP1_GET_TUNER_STATUS
= 0x05,
74 CINERGYT2_EP1_START_SCAN
= 0x06,
75 CINERGYT2_EP1_CONTINUE_SCAN
= 0x07,
76 CINERGYT2_EP1_GET_RC_EVENTS
= 0x08,
77 CINERGYT2_EP1_SLEEP_MODE
= 0x09
80 struct dvbt_set_parameters_msg
{
86 } __attribute__((packed
));
88 struct dvbt_get_status_msg
{
95 uint32_t viterbi_error_rate
;
96 uint32_t rs_error_rate
;
97 uint32_t uncorrected_block_count
;
99 uint8_t prev_lock_bits
;
100 } __attribute__((packed
));
102 static struct dvb_frontend_info cinergyt2_fe_info
= {
105 .frequency_min
= 174000000,
106 .frequency_max
= 862000000,
107 .frequency_stepsize
= 166667,
108 .caps
= FE_CAN_INVERSION_AUTO
| FE_CAN_FEC_1_2
| FE_CAN_FEC_2_3
|
109 FE_CAN_FEC_3_4
| FE_CAN_FEC_5_6
| FE_CAN_FEC_7_8
|
111 FE_CAN_QPSK
| FE_CAN_QAM_16
| FE_CAN_QAM_64
| FE_CAN_QAM_AUTO
|
112 FE_CAN_TRANSMISSION_MODE_AUTO
| FE_CAN_GUARD_INTERVAL_AUTO
|
113 FE_CAN_HIERARCHY_AUTO
| FE_CAN_RECOVER
| FE_CAN_MUTE_TS
117 struct dvb_demux demux
;
118 struct usb_device
*udev
;
119 struct semaphore sem
;
120 struct dvb_adapter adapter
;
121 struct dvb_device
*fedev
;
122 struct dmxdev dmxdev
;
123 struct dvb_net dvbnet
;
128 struct dvbt_set_parameters_msg param
;
129 struct dvbt_get_status_msg status
;
130 struct work_struct query_work
;
132 wait_queue_head_t poll_wq
;
133 int pending_fe_events
;
134 int disconnect_pending
;
138 dma_addr_t streambuf_dmahandle
;
139 struct urb
*stream_urb
[STREAM_URB_COUNT
];
142 struct input_dev
*rc_input_dev
;
144 struct work_struct rc_query_work
;
147 unsigned long last_event_jiffies
;
152 CINERGYT2_RC_EVENT_TYPE_NONE
= 0x00,
153 CINERGYT2_RC_EVENT_TYPE_NEC
= 0x01,
154 CINERGYT2_RC_EVENT_TYPE_RC5
= 0x02
157 struct cinergyt2_rc_event
{
160 } __attribute__((packed
));
162 static const uint32_t rc_keys
[] = {
163 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xfe01eb04, KEY_POWER
,
164 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xfd02eb04, KEY_1
,
165 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xfc03eb04, KEY_2
,
166 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xfb04eb04, KEY_3
,
167 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xfa05eb04, KEY_4
,
168 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf906eb04, KEY_5
,
169 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf807eb04, KEY_6
,
170 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf708eb04, KEY_7
,
171 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf609eb04, KEY_8
,
172 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf50aeb04, KEY_9
,
173 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf30ceb04, KEY_0
,
174 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf40beb04, KEY_VIDEO
,
175 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf20deb04, KEY_REFRESH
,
176 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf10eeb04, KEY_SELECT
,
177 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xf00feb04, KEY_EPG
,
178 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xef10eb04, KEY_UP
,
179 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xeb14eb04, KEY_DOWN
,
180 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xee11eb04, KEY_LEFT
,
181 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xec13eb04, KEY_RIGHT
,
182 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xed12eb04, KEY_OK
,
183 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xea15eb04, KEY_TEXT
,
184 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe916eb04, KEY_INFO
,
185 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe817eb04, KEY_RED
,
186 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe718eb04, KEY_GREEN
,
187 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe619eb04, KEY_YELLOW
,
188 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe51aeb04, KEY_BLUE
,
189 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe31ceb04, KEY_VOLUMEUP
,
190 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe11eeb04, KEY_VOLUMEDOWN
,
191 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe21deb04, KEY_MUTE
,
192 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe41beb04, KEY_CHANNELUP
,
193 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xe01feb04, KEY_CHANNELDOWN
,
194 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xbf40eb04, KEY_PAUSE
,
195 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xb34ceb04, KEY_PLAY
,
196 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xa758eb04, KEY_RECORD
,
197 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xab54eb04, KEY_PREVIOUS
,
198 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xb748eb04, KEY_STOP
,
199 CINERGYT2_RC_EVENT_TYPE_NEC
, 0xa35ceb04, KEY_NEXT
202 static int cinergyt2_command (struct cinergyt2
*cinergyt2
,
203 char *send_buf
, int send_buf_len
,
204 char *recv_buf
, int recv_buf_len
)
210 ret
= usb_bulk_msg(cinergyt2
->udev
, usb_sndbulkpipe(cinergyt2
->udev
, 1),
211 send_buf
, send_buf_len
, &actual_len
, 1000);
214 dprintk(1, "usb_bulk_msg (send) failed, err %i\n", ret
);
219 ret
= usb_bulk_msg(cinergyt2
->udev
, usb_rcvbulkpipe(cinergyt2
->udev
, 1),
220 recv_buf
, recv_buf_len
, &actual_len
, 1000);
223 dprintk(1, "usb_bulk_msg (read) failed, err %i\n", ret
);
225 return ret
? ret
: actual_len
;
228 static void cinergyt2_control_stream_transfer (struct cinergyt2
*cinergyt2
, int enable
)
230 char buf
[] = { CINERGYT2_EP1_CONTROL_STREAM_TRANSFER
, enable
? 1 : 0 };
231 cinergyt2_command(cinergyt2
, buf
, sizeof(buf
), NULL
, 0);
234 static void cinergyt2_sleep (struct cinergyt2
*cinergyt2
, int sleep
)
236 char buf
[] = { CINERGYT2_EP1_SLEEP_MODE
, sleep
? 1 : 0 };
237 cinergyt2_command(cinergyt2
, buf
, sizeof(buf
), NULL
, 0);
238 cinergyt2
->sleeping
= sleep
;
241 static void cinergyt2_stream_irq (struct urb
*urb
, struct pt_regs
*regs
);
243 static int cinergyt2_submit_stream_urb (struct cinergyt2
*cinergyt2
, struct urb
*urb
)
247 usb_fill_bulk_urb(urb
,
249 usb_rcvbulkpipe(cinergyt2
->udev
, 0x2),
250 urb
->transfer_buffer
,
252 cinergyt2_stream_irq
,
255 if ((err
= usb_submit_urb(urb
, GFP_ATOMIC
)))
256 dprintk(1, "urb submission failed (err = %i)!\n", err
);
261 static void cinergyt2_stream_irq (struct urb
*urb
, struct pt_regs
*regs
)
263 struct cinergyt2
*cinergyt2
= urb
->context
;
265 if (urb
->actual_length
> 0)
266 dvb_dmx_swfilter(&cinergyt2
->demux
,
267 urb
->transfer_buffer
, urb
->actual_length
);
269 if (cinergyt2
->streaming
)
270 cinergyt2_submit_stream_urb(cinergyt2
, urb
);
273 static void cinergyt2_free_stream_urbs (struct cinergyt2
*cinergyt2
)
277 for (i
=0; i
<STREAM_URB_COUNT
; i
++)
278 if (cinergyt2
->stream_urb
[i
])
279 usb_free_urb(cinergyt2
->stream_urb
[i
]);
281 usb_buffer_free(cinergyt2
->udev
, STREAM_URB_COUNT
*STREAM_BUF_SIZE
,
282 cinergyt2
->streambuf
, cinergyt2
->streambuf_dmahandle
);
285 static int cinergyt2_alloc_stream_urbs (struct cinergyt2
*cinergyt2
)
289 cinergyt2
->streambuf
= usb_buffer_alloc(cinergyt2
->udev
, STREAM_URB_COUNT
*STREAM_BUF_SIZE
,
290 SLAB_KERNEL
, &cinergyt2
->streambuf_dmahandle
);
291 if (!cinergyt2
->streambuf
) {
292 dprintk(1, "failed to alloc consistent stream memory area, bailing out!\n");
296 memset(cinergyt2
->streambuf
, 0, STREAM_URB_COUNT
*STREAM_BUF_SIZE
);
298 for (i
=0; i
<STREAM_URB_COUNT
; i
++) {
301 if (!(urb
= usb_alloc_urb(0, GFP_ATOMIC
))) {
302 dprintk(1, "failed to alloc consistent stream urbs, bailing out!\n");
303 cinergyt2_free_stream_urbs(cinergyt2
);
307 urb
->transfer_buffer
= cinergyt2
->streambuf
+ i
* STREAM_BUF_SIZE
;
308 urb
->transfer_buffer_length
= STREAM_BUF_SIZE
;
310 cinergyt2
->stream_urb
[i
] = urb
;
316 static void cinergyt2_stop_stream_xfer (struct cinergyt2
*cinergyt2
)
320 cinergyt2_control_stream_transfer(cinergyt2
, 0);
322 for (i
=0; i
<STREAM_URB_COUNT
; i
++)
323 if (cinergyt2
->stream_urb
[i
])
324 usb_kill_urb(cinergyt2
->stream_urb
[i
]);
327 static int cinergyt2_start_stream_xfer (struct cinergyt2
*cinergyt2
)
331 for (i
=0; i
<STREAM_URB_COUNT
; i
++) {
332 if ((err
= cinergyt2_submit_stream_urb(cinergyt2
, cinergyt2
->stream_urb
[i
]))) {
333 cinergyt2_stop_stream_xfer(cinergyt2
);
334 dprintk(1, "failed urb submission (%i: err = %i)!\n", i
, err
);
339 cinergyt2_control_stream_transfer(cinergyt2
, 1);
343 static int cinergyt2_start_feed(struct dvb_demux_feed
*dvbdmxfeed
)
345 struct dvb_demux
*demux
= dvbdmxfeed
->demux
;
346 struct cinergyt2
*cinergyt2
= demux
->priv
;
348 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
351 if (cinergyt2
->streaming
== 0)
352 cinergyt2_start_stream_xfer(cinergyt2
);
354 cinergyt2
->streaming
++;
359 static int cinergyt2_stop_feed(struct dvb_demux_feed
*dvbdmxfeed
)
361 struct dvb_demux
*demux
= dvbdmxfeed
->demux
;
362 struct cinergyt2
*cinergyt2
= demux
->priv
;
364 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
367 if (--cinergyt2
->streaming
== 0)
368 cinergyt2_stop_stream_xfer(cinergyt2
);
375 * convert linux-dvb frontend parameter set into TPS.
376 * See ETSI ETS-300744, section 4.6.2, table 9 for details.
378 * This function is probably reusable and may better get placed in a support
381 * We replace errornous fields by default TPS fields (the ones with value 0).
383 static uint16_t compute_tps (struct dvb_frontend_parameters
*p
)
385 struct dvb_ofdm_parameters
*op
= &p
->u
.ofdm
;
388 switch (op
->code_rate_HP
) {
404 /* tps |= (0 << 7) */;
407 switch (op
->code_rate_LP
) {
423 /* tps |= (0 << 4) */;
426 switch (op
->constellation
) {
435 /* tps |= (0 << 13) */;
438 switch (op
->transmission_mode
) {
439 case TRANSMISSION_MODE_8K
:
442 case TRANSMISSION_MODE_2K
:
444 /* tps |= (0 << 0) */;
447 switch (op
->guard_interval
) {
448 case GUARD_INTERVAL_1_16
:
451 case GUARD_INTERVAL_1_8
:
454 case GUARD_INTERVAL_1_4
:
457 case GUARD_INTERVAL_1_32
:
459 /* tps |= (0 << 2) */;
462 switch (op
->hierarchy_information
) {
474 /* tps |= (0 << 10) */;
480 static int cinergyt2_open (struct inode
*inode
, struct file
*file
)
482 struct dvb_device
*dvbdev
= file
->private_data
;
483 struct cinergyt2
*cinergyt2
= dvbdev
->priv
;
484 int err
= -ERESTARTSYS
;
486 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
489 if ((err
= dvb_generic_open(inode
, file
))) {
495 if ((file
->f_flags
& O_ACCMODE
) != O_RDONLY
) {
496 cinergyt2_sleep(cinergyt2
, 0);
497 schedule_delayed_work(&cinergyt2
->query_work
, HZ
/2);
500 atomic_inc(&cinergyt2
->inuse
);
506 static void cinergyt2_unregister(struct cinergyt2
*cinergyt2
)
508 dvb_unregister_device(cinergyt2
->fedev
);
509 dvb_unregister_adapter(&cinergyt2
->adapter
);
511 cinergyt2_free_stream_urbs(cinergyt2
);
515 static int cinergyt2_release (struct inode
*inode
, struct file
*file
)
517 struct dvb_device
*dvbdev
= file
->private_data
;
518 struct cinergyt2
*cinergyt2
= dvbdev
->priv
;
520 if (down_interruptible(&cinergyt2
->sem
))
523 if (!cinergyt2
->disconnect_pending
&& (file
->f_flags
& O_ACCMODE
) != O_RDONLY
) {
524 cancel_delayed_work(&cinergyt2
->query_work
);
525 flush_scheduled_work();
526 cinergyt2_sleep(cinergyt2
, 1);
531 if (atomic_dec_and_test(&cinergyt2
->inuse
) && cinergyt2
->disconnect_pending
) {
532 warn("delayed unregister in release");
533 cinergyt2_unregister(cinergyt2
);
536 return dvb_generic_release(inode
, file
);
539 static unsigned int cinergyt2_poll (struct file
*file
, struct poll_table_struct
*wait
)
541 struct dvb_device
*dvbdev
= file
->private_data
;
542 struct cinergyt2
*cinergyt2
= dvbdev
->priv
;
544 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
547 poll_wait(file
, &cinergyt2
->poll_wq
, wait
);
551 return (POLLIN
| POLLRDNORM
| POLLPRI
);
555 static int cinergyt2_ioctl (struct inode
*inode
, struct file
*file
,
556 unsigned cmd
, unsigned long arg
)
558 struct dvb_device
*dvbdev
= file
->private_data
;
559 struct cinergyt2
*cinergyt2
= dvbdev
->priv
;
560 struct dvbt_get_status_msg
*stat
= &cinergyt2
->status
;
561 fe_status_t status
= 0;
565 return copy_to_user((void __user
*) arg
, &cinergyt2_fe_info
,
566 sizeof(struct dvb_frontend_info
));
569 if (0xffff - le16_to_cpu(stat
->gain
) > 30)
570 status
|= FE_HAS_SIGNAL
;
571 if (stat
->lock_bits
& (1 << 6))
572 status
|= FE_HAS_LOCK
;
573 if (stat
->lock_bits
& (1 << 5))
574 status
|= FE_HAS_SYNC
;
575 if (stat
->lock_bits
& (1 << 4))
576 status
|= FE_HAS_CARRIER
;
577 if (stat
->lock_bits
& (1 << 1))
578 status
|= FE_HAS_VITERBI
;
580 return copy_to_user((void __user
*) arg
, &status
, sizeof(status
));
583 return put_user(le32_to_cpu(stat
->viterbi_error_rate
),
584 (__u32 __user
*) arg
);
586 case FE_READ_SIGNAL_STRENGTH
:
587 return put_user(0xffff - le16_to_cpu(stat
->gain
),
588 (__u16 __user
*) arg
);
591 return put_user((stat
->snr
<< 8) | stat
->snr
,
592 (__u16 __user
*) arg
);
594 case FE_READ_UNCORRECTED_BLOCKS
:
598 unc_count
= stat
->uncorrected_block_count
;
599 stat
->uncorrected_block_count
= 0;
601 /* UNC are already converted to host byte order... */
602 return put_user(unc_count
,(__u32 __user
*) arg
);
604 case FE_SET_FRONTEND
:
606 struct dvbt_set_parameters_msg
*param
= &cinergyt2
->param
;
607 struct dvb_frontend_parameters p
;
610 if ((file
->f_flags
& O_ACCMODE
) == O_RDONLY
)
613 if (copy_from_user(&p
, (void __user
*) arg
, sizeof(p
)))
616 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
619 param
->cmd
= CINERGYT2_EP1_SET_TUNER_PARAMETERS
;
620 param
->tps
= cpu_to_le16(compute_tps(&p
));
621 param
->freq
= cpu_to_le32(p
.frequency
/ 1000);
622 param
->bandwidth
= 8 - p
.u
.ofdm
.bandwidth
- BANDWIDTH_8_MHZ
;
625 cinergyt2
->pending_fe_events
++;
626 wake_up_interruptible(&cinergyt2
->poll_wq
);
628 err
= cinergyt2_command(cinergyt2
,
629 (char *) param
, sizeof(*param
),
634 return (err
< 0) ? err
: 0;
637 case FE_GET_FRONTEND
:
639 * trivial to implement (see struct dvbt_get_status_msg).
640 * equivalent to FE_READ ioctls, but needs
641 * TPS -> linux-dvb parameter set conversion. Feel free
642 * to implement this and send us a patch if you need this
650 * for now we only fill the status field. the parameters
651 * are trivial to fill as soon FE_GET_FRONTEND is done.
653 struct dvb_frontend_event __user
*e
= (void __user
*) arg
;
654 if (cinergyt2
->pending_fe_events
== 0) {
655 if (file
->f_flags
& O_NONBLOCK
)
657 wait_event_interruptible(cinergyt2
->poll_wq
,
658 cinergyt2
->pending_fe_events
> 0);
660 cinergyt2
->pending_fe_events
= 0;
661 return cinergyt2_ioctl(inode
, file
, FE_READ_STATUS
,
662 (unsigned long) &e
->status
);
672 static int cinergyt2_mmap(struct file
*file
, struct vm_area_struct
*vma
)
674 struct dvb_device
*dvbdev
= file
->private_data
;
675 struct cinergyt2
*cinergyt2
= dvbdev
->priv
;
680 if (vma
->vm_flags
& (VM_WRITE
| VM_EXEC
)) {
685 if (vma
->vm_end
> vma
->vm_start
+ STREAM_URB_COUNT
* STREAM_BUF_SIZE
) {
690 vma
->vm_flags
|= (VM_IO
| VM_DONTCOPY
);
693 ret
= remap_pfn_range(vma
, vma
->vm_start
,
694 virt_to_phys(cinergyt2
->streambuf
) >> PAGE_SHIFT
,
695 vma
->vm_end
- vma
->vm_start
,
696 vma
->vm_page_prot
) ? -EAGAIN
: 0;
702 static struct file_operations cinergyt2_fops
= {
703 .owner
= THIS_MODULE
,
704 .ioctl
= cinergyt2_ioctl
,
705 .poll
= cinergyt2_poll
,
706 .open
= cinergyt2_open
,
707 .release
= cinergyt2_release
,
708 .mmap
= cinergyt2_mmap
711 static struct dvb_device cinergyt2_fe_template
= {
715 .fops
= &cinergyt2_fops
720 static void cinergyt2_query_rc (void *data
)
722 struct cinergyt2
*cinergyt2
= data
;
723 char buf
[1] = { CINERGYT2_EP1_GET_RC_EVENTS
};
724 struct cinergyt2_rc_event rc_events
[12];
727 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
730 len
= cinergyt2_command(cinergyt2
, buf
, sizeof(buf
),
731 (char *) rc_events
, sizeof(rc_events
));
735 if (time_after(jiffies
, cinergyt2
->last_event_jiffies
+
736 msecs_to_jiffies(150))) {
737 /* stop key repeat */
738 if (cinergyt2
->rc_input_event
!= KEY_MAX
) {
739 dprintk(1, "rc_input_event=%d Up\n", cinergyt2
->rc_input_event
);
740 input_report_key(cinergyt2
->rc_input_dev
,
741 cinergyt2
->rc_input_event
, 0);
742 cinergyt2
->rc_input_event
= KEY_MAX
;
744 cinergyt2
->rc_last_code
= ~0;
748 cinergyt2
->last_event_jiffies
= jiffies
;
750 for (n
= 0; n
< (len
/ sizeof(rc_events
[0])); n
++) {
751 dprintk(1, "rc_events[%d].value = %x, type=%x\n",
752 n
, le32_to_cpu(rc_events
[n
].value
), rc_events
[n
].type
);
754 if (rc_events
[n
].type
== CINERGYT2_RC_EVENT_TYPE_NEC
&&
755 rc_events
[n
].value
== ~0) {
756 /* keyrepeat bit -> just repeat last rc_input_event */
758 cinergyt2
->rc_input_event
= KEY_MAX
;
759 for (i
= 0; i
< ARRAY_SIZE(rc_keys
); i
+= 3) {
760 if (rc_keys
[i
+ 0] == rc_events
[n
].type
&&
761 rc_keys
[i
+ 1] == le32_to_cpu(rc_events
[n
].value
)) {
762 cinergyt2
->rc_input_event
= rc_keys
[i
+ 2];
768 if (cinergyt2
->rc_input_event
!= KEY_MAX
) {
769 if (rc_events
[n
].value
== cinergyt2
->rc_last_code
&&
770 cinergyt2
->rc_last_code
!= ~0) {
771 /* emit a key-up so the double event is recognized */
772 dprintk(1, "rc_input_event=%d UP\n", cinergyt2
->rc_input_event
);
773 input_report_key(cinergyt2
->rc_input_dev
,
774 cinergyt2
->rc_input_event
, 0);
776 dprintk(1, "rc_input_event=%d\n", cinergyt2
->rc_input_event
);
777 input_report_key(cinergyt2
->rc_input_dev
,
778 cinergyt2
->rc_input_event
, 1);
779 cinergyt2
->rc_last_code
= rc_events
[n
].value
;
784 schedule_delayed_work(&cinergyt2
->rc_query_work
,
785 msecs_to_jiffies(RC_QUERY_INTERVAL
));
790 static int cinergyt2_register_rc(struct cinergyt2
*cinergyt2
)
792 struct input_dev
*input_dev
;
795 cinergyt2
->rc_input_dev
= input_dev
= input_allocate_device();
799 usb_make_path(cinergyt2
->udev
, cinergyt2
->phys
, sizeof(cinergyt2
->phys
));
800 strlcat(cinergyt2
->phys
, "/input0", sizeof(cinergyt2
->phys
));
801 cinergyt2
->rc_input_event
= KEY_MAX
;
802 cinergyt2
->rc_last_code
= ~0;
803 INIT_WORK(&cinergyt2
->rc_query_work
, cinergyt2_query_rc
, cinergyt2
);
805 input_dev
->name
= DRIVER_NAME
" remote control";
806 input_dev
->phys
= cinergyt2
->phys
;
807 input_dev
->evbit
[0] = BIT(EV_KEY
) | BIT(EV_REP
);
808 for (i
= 0; i
< ARRAY_SIZE(rc_keys
); i
+= 3)
809 set_bit(rc_keys
[i
+ 2], input_dev
->keybit
);
810 input_dev
->keycodesize
= 0;
811 input_dev
->keycodemax
= 0;
813 input_register_device(cinergyt2
->rc_input_dev
);
814 schedule_delayed_work(&cinergyt2
->rc_query_work
, HZ
/2);
819 static void cinergyt2_unregister_rc(struct cinergyt2
*cinergyt2
)
821 cancel_delayed_work(&cinergyt2
->rc_query_work
);
822 input_unregister_device(cinergyt2
->rc_input_dev
);
825 static inline void cinergyt2_suspend_rc(struct cinergyt2
*cinergyt2
)
827 cancel_delayed_work(&cinergyt2
->rc_query_work
);
830 static inline void cinergyt2_resume_rc(struct cinergyt2
*cinergyt2
)
832 schedule_delayed_work(&cinergyt2
->rc_query_work
, HZ
/2);
837 static inline int cinergyt2_register_rc(struct cinergyt2
*cinergyt2
) { return 0; }
838 static inline void cinergyt2_unregister_rc(struct cinergyt2
*cinergyt2
) { }
839 static inline void cinergyt2_suspend_rc(struct cinergyt2
*cinergyt2
) { }
840 static inline void cinergyt2_resume_rc(struct cinergyt2
*cinergyt2
) { }
842 #endif /* ENABLE_RC */
844 static void cinergyt2_query (void *data
)
846 struct cinergyt2
*cinergyt2
= (struct cinergyt2
*) data
;
847 char cmd
[] = { CINERGYT2_EP1_GET_TUNER_STATUS
};
848 struct dvbt_get_status_msg
*s
= &cinergyt2
->status
;
852 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
855 unc
= s
->uncorrected_block_count
;
856 lock_bits
= s
->lock_bits
;
858 cinergyt2_command(cinergyt2
, cmd
, sizeof(cmd
), (char *) s
, sizeof(*s
));
860 unc
+= le32_to_cpu(s
->uncorrected_block_count
);
861 s
->uncorrected_block_count
= unc
;
863 if (lock_bits
!= s
->lock_bits
) {
864 wake_up_interruptible(&cinergyt2
->poll_wq
);
865 cinergyt2
->pending_fe_events
++;
868 schedule_delayed_work(&cinergyt2
->query_work
,
869 msecs_to_jiffies(QUERY_INTERVAL
));
874 static int cinergyt2_probe (struct usb_interface
*intf
,
875 const struct usb_device_id
*id
)
877 struct cinergyt2
*cinergyt2
;
880 if (!(cinergyt2
= kmalloc (sizeof(struct cinergyt2
), GFP_KERNEL
))) {
881 dprintk(1, "out of memory?!?\n");
885 memset (cinergyt2
, 0, sizeof (struct cinergyt2
));
886 usb_set_intfdata (intf
, (void *) cinergyt2
);
888 init_MUTEX(&cinergyt2
->sem
);
889 init_waitqueue_head (&cinergyt2
->poll_wq
);
890 INIT_WORK(&cinergyt2
->query_work
, cinergyt2_query
, cinergyt2
);
892 cinergyt2
->udev
= interface_to_usbdev(intf
);
893 cinergyt2
->param
.cmd
= CINERGYT2_EP1_SET_TUNER_PARAMETERS
;
895 if (cinergyt2_alloc_stream_urbs (cinergyt2
) < 0) {
896 dprintk(1, "unable to allocate stream urbs\n");
901 dvb_register_adapter(&cinergyt2
->adapter
, DRIVER_NAME
, THIS_MODULE
);
903 cinergyt2
->demux
.priv
= cinergyt2
;
904 cinergyt2
->demux
.filternum
= 256;
905 cinergyt2
->demux
.feednum
= 256;
906 cinergyt2
->demux
.start_feed
= cinergyt2_start_feed
;
907 cinergyt2
->demux
.stop_feed
= cinergyt2_stop_feed
;
908 cinergyt2
->demux
.dmx
.capabilities
= DMX_TS_FILTERING
|
909 DMX_SECTION_FILTERING
|
910 DMX_MEMORY_BASED_FILTERING
;
912 if ((err
= dvb_dmx_init(&cinergyt2
->demux
)) < 0) {
913 dprintk(1, "dvb_dmx_init() failed (err = %d)\n", err
);
917 cinergyt2
->dmxdev
.filternum
= cinergyt2
->demux
.filternum
;
918 cinergyt2
->dmxdev
.demux
= &cinergyt2
->demux
.dmx
;
919 cinergyt2
->dmxdev
.capabilities
= 0;
921 if ((err
= dvb_dmxdev_init(&cinergyt2
->dmxdev
, &cinergyt2
->adapter
)) < 0) {
922 dprintk(1, "dvb_dmxdev_init() failed (err = %d)\n", err
);
926 if (dvb_net_init(&cinergyt2
->adapter
, &cinergyt2
->dvbnet
, &cinergyt2
->demux
.dmx
))
927 dprintk(1, "dvb_net_init() failed!\n");
929 dvb_register_device(&cinergyt2
->adapter
, &cinergyt2
->fedev
,
930 &cinergyt2_fe_template
, cinergyt2
,
931 DVB_DEVICE_FRONTEND
);
933 err
= cinergyt2_register_rc(cinergyt2
);
940 dvb_dmxdev_release(&cinergyt2
->dmxdev
);
941 dvb_dmx_release(&cinergyt2
->demux
);
942 dvb_unregister_adapter(&cinergyt2
->adapter
);
943 cinergyt2_free_stream_urbs(cinergyt2
);
948 static void cinergyt2_disconnect (struct usb_interface
*intf
)
950 struct cinergyt2
*cinergyt2
= usb_get_intfdata (intf
);
952 flush_scheduled_work();
954 cinergyt2_unregister_rc(cinergyt2
);
956 cancel_delayed_work(&cinergyt2
->query_work
);
957 wake_up_interruptible(&cinergyt2
->poll_wq
);
959 cinergyt2
->demux
.dmx
.close(&cinergyt2
->demux
.dmx
);
960 cinergyt2
->disconnect_pending
= 1;
962 if (!atomic_read(&cinergyt2
->inuse
))
963 cinergyt2_unregister(cinergyt2
);
966 static int cinergyt2_suspend (struct usb_interface
*intf
, pm_message_t state
)
968 struct cinergyt2
*cinergyt2
= usb_get_intfdata (intf
);
970 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
973 if (state
.event
> PM_EVENT_ON
) {
974 struct cinergyt2
*cinergyt2
= usb_get_intfdata (intf
);
976 cinergyt2_suspend_rc(cinergyt2
);
977 cancel_delayed_work(&cinergyt2
->query_work
);
978 if (cinergyt2
->streaming
)
979 cinergyt2_stop_stream_xfer(cinergyt2
);
980 flush_scheduled_work();
981 cinergyt2_sleep(cinergyt2
, 1);
988 static int cinergyt2_resume (struct usb_interface
*intf
)
990 struct cinergyt2
*cinergyt2
= usb_get_intfdata (intf
);
991 struct dvbt_set_parameters_msg
*param
= &cinergyt2
->param
;
993 if (cinergyt2
->disconnect_pending
|| down_interruptible(&cinergyt2
->sem
))
996 if (!cinergyt2
->sleeping
) {
997 cinergyt2_sleep(cinergyt2
, 0);
998 cinergyt2_command(cinergyt2
, (char *) param
, sizeof(*param
), NULL
, 0);
999 if (cinergyt2
->streaming
)
1000 cinergyt2_start_stream_xfer(cinergyt2
);
1001 schedule_delayed_work(&cinergyt2
->query_work
, HZ
/2);
1004 cinergyt2_resume_rc(cinergyt2
);
1006 up(&cinergyt2
->sem
);
1010 static const struct usb_device_id cinergyt2_table
[] __devinitdata
= {
1011 { USB_DEVICE(0x0ccd, 0x0038) },
1015 MODULE_DEVICE_TABLE(usb
, cinergyt2_table
);
1017 static struct usb_driver cinergyt2_driver
= {
1018 .name
= "cinergyT2",
1019 .probe
= cinergyt2_probe
,
1020 .disconnect
= cinergyt2_disconnect
,
1021 .suspend
= cinergyt2_suspend
,
1022 .resume
= cinergyt2_resume
,
1023 .id_table
= cinergyt2_table
1026 static int __init
cinergyt2_init (void)
1030 if ((err
= usb_register(&cinergyt2_driver
)) < 0)
1031 dprintk(1, "usb_register() failed! (err %i)\n", err
);
1036 static void __exit
cinergyt2_exit (void)
1038 usb_deregister(&cinergyt2_driver
);
1041 module_init (cinergyt2_init
);
1042 module_exit (cinergyt2_exit
);
1044 MODULE_LICENSE("GPL");
1045 MODULE_AUTHOR("Holger Waechtler, Daniel Mack");