2 CA-driver for TwinHan DST Frontend/Card
4 Copyright (C) 2004, 2005 Manu Abraham (manu@kromtek.com)
6 This program is free software; you can redistribute it and/or modify
7 it under the terms of the GNU General Public License as published by
8 the Free Software Foundation; either version 2 of the License, or
9 (at your option) any later version.
11 This program is distributed in the hope that it will be useful,
12 but WITHOUT ANY WARRANTY; without even the implied warranty of
13 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 GNU General Public License for more details.
16 You should have received a copy of the GNU General Public License
17 along with this program; if not, write to the Free Software
18 Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
21 #include <linux/kernel.h>
22 #include <linux/module.h>
23 #include <linux/init.h>
24 #include <linux/string.h>
25 #include <linux/dvb/ca.h>
27 #include "dvb_frontend.h"
29 #include "dst_common.h"
31 #define DST_CA_ERROR 0
32 #define DST_CA_NOTICE 1
34 #define DST_CA_DEBUG 3
36 #define dprintk(x, y, z, format, arg...) do { \
38 if ((x > DST_CA_ERROR) && (x > y)) \
39 printk(KERN_ERR "%s: " format "\n", __FUNCTION__ , ##arg); \
40 else if ((x > DST_CA_NOTICE) && (x > y)) \
41 printk(KERN_NOTICE "%s: " format "\n", __FUNCTION__ , ##arg); \
42 else if ((x > DST_CA_INFO) && (x > y)) \
43 printk(KERN_INFO "%s: " format "\n", __FUNCTION__ , ##arg); \
44 else if ((x > DST_CA_DEBUG) && (x > y)) \
45 printk(KERN_DEBUG "%s: " format "\n", __FUNCTION__ , ##arg); \
48 printk(format, ## arg); \
53 static unsigned int verbose
= 5;
54 module_param(verbose
, int, 0644);
55 MODULE_PARM_DESC(verbose
, "verbose startup messages, default is 1 (yes)");
57 /* Need some more work */
58 static int ca_set_slot_descr(void)
60 /* We could make this more graceful ? */
64 /* Need some more work */
65 static int ca_set_pid(void)
67 /* We could make this more graceful ? */
72 static void put_checksum(u8
*check_string
, int length
)
74 dprintk(verbose
, DST_CA_DEBUG
, 1, " Computing string checksum.");
75 dprintk(verbose
, DST_CA_DEBUG
, 1, " -> string length : 0x%02x", length
);
76 check_string
[length
] = dst_check_sum (check_string
, length
);
77 dprintk(verbose
, DST_CA_DEBUG
, 1, " -> checksum : 0x%02x", check_string
[length
]);
80 static int dst_ci_command(struct dst_state
* state
, u8
* data
, u8
*ca_string
, u8 len
, int read
)
84 down(&state
->dst_mutex
);
88 if (write_dst(state
, data
, len
)) {
89 dprintk(verbose
, DST_CA_INFO
, 1, " Write not successful, trying to recover");
90 dst_error_recovery(state
);
93 if ((dst_pio_disable(state
)) < 0) {
94 dprintk(verbose
, DST_CA_ERROR
, 1, " DST PIO disable failed.");
97 if (read_dst(state
, &reply
, GET_ACK
) < 0) {
98 dprintk(verbose
, DST_CA_INFO
, 1, " Read not successful, trying to recover");
99 dst_error_recovery(state
);
103 if (! dst_wait_dst_ready(state
, LONG_DELAY
)) {
104 dprintk(verbose
, DST_CA_NOTICE
, 1, " 8820 not ready");
107 if (read_dst(state
, ca_string
, 128) < 0) { /* Try to make this dynamic */
108 dprintk(verbose
, DST_CA_INFO
, 1, " Read not successful, trying to recover");
109 dst_error_recovery(state
);
113 up(&state
->dst_mutex
);
117 up(&state
->dst_mutex
);
122 static int dst_put_ci(struct dst_state
*state
, u8
*data
, int len
, u8
*ca_string
, int read
)
124 u8 dst_ca_comm_err
= 0;
126 while (dst_ca_comm_err
< RETRIES
) {
127 dst_comm_init(state
);
128 dprintk(verbose
, DST_CA_NOTICE
, 1, " Put Command");
129 if (dst_ci_command(state
, data
, ca_string
, len
, read
)) { // If error
130 dst_error_recovery(state
);
131 dst_ca_comm_err
++; // work required here.
141 static int ca_get_app_info(struct dst_state
*state
)
143 static u8 command
[8] = {0x07, 0x40, 0x01, 0x00, 0x01, 0x00, 0x00, 0xff};
145 put_checksum(&command
[0], command
[0]);
146 if ((dst_put_ci(state
, command
, sizeof(command
), state
->messages
, GET_REPLY
)) < 0) {
147 dprintk(verbose
, DST_CA_ERROR
, 1, " -->dst_put_ci FAILED !");
150 dprintk(verbose
, DST_CA_INFO
, 1, " -->dst_put_ci SUCCESS !");
151 dprintk(verbose
, DST_CA_INFO
, 1, " ================================ CI Module Application Info ======================================");
152 dprintk(verbose
, DST_CA_INFO
, 1, " Application Type=[%d], Application Vendor=[%d], Vendor Code=[%d]\n%s: Application info=[%s]",
153 state
->messages
[7], (state
->messages
[8] << 8) | state
->messages
[9],
154 (state
->messages
[10] << 8) | state
->messages
[11], __FUNCTION__
, (char *)(&state
->messages
[12]));
155 dprintk(verbose
, DST_CA_INFO
, 1, " ==================================================================================================");
160 static int ca_get_slot_caps(struct dst_state
*state
, struct ca_caps
*p_ca_caps
, void __user
*arg
)
164 static u8 slot_command
[8] = {0x07, 0x40, 0x02, 0x00, 0x02, 0x00, 0x00, 0xff};
166 put_checksum(&slot_command
[0], slot_command
[0]);
167 if ((dst_put_ci(state
, slot_command
, sizeof (slot_command
), slot_cap
, GET_REPLY
)) < 0) {
168 dprintk(verbose
, DST_CA_ERROR
, 1, " -->dst_put_ci FAILED !");
171 dprintk(verbose
, DST_CA_NOTICE
, 1, " -->dst_put_ci SUCCESS !");
173 /* Will implement the rest soon */
175 dprintk(verbose
, DST_CA_INFO
, 1, " Slot cap = [%d]", slot_cap
[7]);
176 dprintk(verbose
, DST_CA_INFO
, 0, "===================================\n");
177 for (i
= 0; i
< 8; i
++)
178 dprintk(verbose
, DST_CA_INFO
, 0, " %d", slot_cap
[i
]);
179 dprintk(verbose
, DST_CA_INFO
, 0, "\n");
181 p_ca_caps
->slot_num
= 1;
182 p_ca_caps
->slot_type
= 1;
183 p_ca_caps
->descr_num
= slot_cap
[7];
184 p_ca_caps
->descr_type
= 1;
186 if (copy_to_user(arg
, p_ca_caps
, sizeof (struct ca_caps
)))
192 /* Need some more work */
193 static int ca_get_slot_descr(struct dst_state
*state
, struct ca_msg
*p_ca_message
, void __user
*arg
)
199 static int ca_get_slot_info(struct dst_state
*state
, struct ca_slot_info
*p_ca_slot_info
, void __user
*arg
)
202 static u8 slot_command
[8] = {0x00, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff};
204 u8
*slot_info
= state
->messages
;
206 put_checksum(&slot_command
[0], 7);
207 if ((dst_put_ci(state
, slot_command
, sizeof (slot_command
), slot_info
, GET_REPLY
)) < 0) {
208 dprintk(verbose
, DST_CA_ERROR
, 1, " -->dst_put_ci FAILED !");
211 dprintk(verbose
, DST_CA_INFO
, 1, " -->dst_put_ci SUCCESS !");
213 /* Will implement the rest soon */
215 dprintk(verbose
, DST_CA_INFO
, 1, " Slot info = [%d]", slot_info
[3]);
216 dprintk(verbose
, DST_CA_INFO
, 0, "===================================\n");
217 for (i
= 0; i
< 8; i
++)
218 dprintk(verbose
, DST_CA_INFO
, 0, " %d", slot_info
[i
]);
219 dprintk(verbose
, DST_CA_INFO
, 0, "\n");
221 if (slot_info
[4] & 0x80) {
222 p_ca_slot_info
->flags
= CA_CI_MODULE_PRESENT
;
223 p_ca_slot_info
->num
= 1;
224 p_ca_slot_info
->type
= CA_CI
;
225 } else if (slot_info
[4] & 0x40) {
226 p_ca_slot_info
->flags
= CA_CI_MODULE_READY
;
227 p_ca_slot_info
->num
= 1;
228 p_ca_slot_info
->type
= CA_CI
;
230 p_ca_slot_info
->flags
= 0;
232 if (copy_to_user(arg
, p_ca_slot_info
, sizeof (struct ca_slot_info
)))
239 static int ca_get_message(struct dst_state
*state
, struct ca_msg
*p_ca_message
, void __user
*arg
)
244 if (copy_from_user(p_ca_message
, arg
, sizeof (struct ca_msg
)))
247 if (p_ca_message
->msg
) {
248 dprintk(verbose
, DST_CA_NOTICE
, 1, " Message = [%02x %02x %02x]", p_ca_message
->msg
[0], p_ca_message
->msg
[1], p_ca_message
->msg
[2]);
250 for (i
= 0; i
< 3; i
++) {
251 command
= command
| p_ca_message
->msg
[i
];
253 command
= command
<< 8;
255 dprintk(verbose
, DST_CA_NOTICE
, 1, " Command=[0x%x]", command
);
259 memcpy(p_ca_message
->msg
, state
->messages
, 128);
260 if (copy_to_user(arg
, p_ca_message
, sizeof (struct ca_msg
)) )
269 static int handle_dst_tag(struct dst_state
*state
, struct ca_msg
*p_ca_message
, struct ca_msg
*hw_buffer
, u32 length
)
271 if (state
->dst_hw_cap
& DST_TYPE_HAS_SESSION
) {
272 hw_buffer
->msg
[2] = p_ca_message
->msg
[1]; /* MSB */
273 hw_buffer
->msg
[3] = p_ca_message
->msg
[2]; /* LSB */
276 dprintk(verbose
, DST_CA_ERROR
, 1, " Message too long ! *** Bailing Out *** !");
279 hw_buffer
->msg
[0] = (length
& 0xff) + 7;
280 hw_buffer
->msg
[1] = 0x40;
281 hw_buffer
->msg
[2] = 0x03;
282 hw_buffer
->msg
[3] = 0x00;
283 hw_buffer
->msg
[4] = 0x03;
284 hw_buffer
->msg
[5] = length
& 0xff;
285 hw_buffer
->msg
[6] = 0x00;
288 * Need to compute length for EN50221 section 8.3.2, for the time being
289 * assuming 8.3.2 is not applicable
291 memcpy(&hw_buffer
->msg
[7], &p_ca_message
->msg
[4], length
);
297 static int write_to_8820(struct dst_state
*state
, struct ca_msg
*hw_buffer
, u8 length
, u8 reply
)
299 if ((dst_put_ci(state
, hw_buffer
->msg
, length
, hw_buffer
->msg
, reply
)) < 0) {
300 dprintk(verbose
, DST_CA_ERROR
, 1, " DST-CI Command failed.");
301 dprintk(verbose
, DST_CA_NOTICE
, 1, " Resetting DST.");
302 rdc_reset_state(state
);
305 dprintk(verbose
, DST_CA_NOTICE
, 1, " DST-CI Command succes.");
310 static u32
asn_1_decode(u8
*asn_1_array
)
312 u8 length_field
= 0, word_count
= 0, count
= 0;
315 length_field
= asn_1_array
[0];
316 dprintk(verbose
, DST_CA_DEBUG
, 1, " Length field=[%02x]", length_field
);
317 if (length_field
< 0x80) {
318 length
= length_field
& 0x7f;
319 dprintk(verbose
, DST_CA_DEBUG
, 1, " Length=[%02x]\n", length
);
321 word_count
= length_field
& 0x7f;
322 for (count
= 0; count
< word_count
; count
++) {
323 length
= length
<< 8;
324 length
+= asn_1_array
[count
+ 1];
325 dprintk(verbose
, DST_CA_DEBUG
, 1, " Length=[%04x]", length
);
331 static int debug_string(u8
*msg
, u32 length
, u32 offset
)
335 dprintk(verbose
, DST_CA_DEBUG
, 0, " String=[ ");
336 for (i
= offset
; i
< length
; i
++)
337 dprintk(verbose
, DST_CA_DEBUG
, 0, "%02x ", msg
[i
]);
338 dprintk(verbose
, DST_CA_DEBUG
, 0, "]\n");
343 static int ca_set_pmt(struct dst_state
*state
, struct ca_msg
*p_ca_message
, struct ca_msg
*hw_buffer
, u8 reply
, u8 query
)
348 length
= asn_1_decode(&p_ca_message
->msg
[3]);
349 dprintk(verbose
, DST_CA_DEBUG
, 1, " CA Message length=[%d]", length
);
350 debug_string(&p_ca_message
->msg
[4], length
, 0); /* length is excluding tag & length */
352 memset(hw_buffer
->msg
, '\0', length
);
353 handle_dst_tag(state
, p_ca_message
, hw_buffer
, length
);
354 put_checksum(hw_buffer
->msg
, hw_buffer
->msg
[0]);
356 debug_string(hw_buffer
->msg
, (length
+ tag_length
), 0); /* tags too */
357 write_to_8820(state
, hw_buffer
, (length
+ tag_length
), reply
);
363 /* Board supports CA PMT reply ? */
364 static int dst_check_ca_pmt(struct dst_state
*state
, struct ca_msg
*p_ca_message
, struct ca_msg
*hw_buffer
)
366 int ca_pmt_reply_test
= 0;
369 /* Not there yet but soon */
371 /* CA PMT Reply capable */
372 if (ca_pmt_reply_test
) {
373 if ((ca_set_pmt(state
, p_ca_message
, hw_buffer
, 1, GET_REPLY
)) < 0) {
374 dprintk(verbose
, DST_CA_ERROR
, 1, " ca_set_pmt.. failed !");
378 /* Process CA PMT Reply */
379 /* will implement soon */
380 dprintk(verbose
, DST_CA_ERROR
, 1, " Not there yet");
382 /* CA PMT Reply not capable */
383 if (!ca_pmt_reply_test
) {
384 if ((ca_set_pmt(state
, p_ca_message
, hw_buffer
, 0, NO_REPLY
)) < 0) {
385 dprintk(verbose
, DST_CA_ERROR
, 1, " ca_set_pmt.. failed !");
388 dprintk(verbose
, DST_CA_NOTICE
, 1, " ca_set_pmt.. success !");
389 /* put a dummy message */
395 static int ca_send_message(struct dst_state
*state
, struct ca_msg
*p_ca_message
, void __user
*arg
)
398 unsigned int ca_message_header_len
;
401 struct ca_msg
*hw_buffer
;
404 if ((hw_buffer
= (struct ca_msg
*) kmalloc(sizeof (struct ca_msg
), GFP_KERNEL
)) == NULL
) {
405 dprintk(verbose
, DST_CA_ERROR
, 1, " Memory allocation failure");
408 dprintk(verbose
, DST_CA_DEBUG
, 1, " ");
410 if (copy_from_user(p_ca_message
, arg
, sizeof (struct ca_msg
))) {
412 goto free_mem_and_exit
;
416 if (p_ca_message
->msg
) {
417 ca_message_header_len
= p_ca_message
->length
; /* Restore it back when you are done */
421 for (i
= 0; i
< 3; i
++) {
422 command
= command
| p_ca_message
->msg
[i
];
424 command
= command
<< 8;
426 dprintk(verbose
, DST_CA_DEBUG
, 1, " Command=[0x%x]\n", command
);
430 dprintk(verbose
, DST_CA_DEBUG
, 1, "Command = SEND_CA_PMT");
431 if ((ca_set_pmt(state
, p_ca_message
, hw_buffer
, 0, 0)) < 0) { // code simplification started
432 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_PMT Failed !");
434 goto free_mem_and_exit
;
436 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_PMT Success !");
439 dprintk(verbose
, DST_CA_INFO
, 1, "Command = CA_PMT_REPLY");
440 /* Have to handle the 2 basic types of cards here */
441 if ((dst_check_ca_pmt(state
, p_ca_message
, hw_buffer
)) < 0) {
442 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_PMT_REPLY Failed !");
444 goto free_mem_and_exit
;
446 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_PMT_REPLY Success !");
448 case CA_APP_INFO_ENQUIRY
: // only for debugging
449 dprintk(verbose
, DST_CA_INFO
, 1, " Getting Cam Application information");
451 if ((ca_get_app_info(state
)) < 0) {
452 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_APP_INFO_ENQUIRY Failed !");
454 goto free_mem_and_exit
;
456 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_APP_INFO_ENQUIRY Success !");
466 static int dst_ca_ioctl(struct inode
*inode
, struct file
*file
, unsigned int cmd
, unsigned long ioctl_arg
)
468 struct dvb_device
* dvbdev
= (struct dvb_device
*) file
->private_data
;
469 struct dst_state
* state
= (struct dst_state
*) dvbdev
->priv
;
470 struct ca_slot_info
*p_ca_slot_info
;
471 struct ca_caps
*p_ca_caps
;
472 struct ca_msg
*p_ca_message
;
473 void __user
*arg
= (void __user
*)ioctl_arg
;
476 if ((p_ca_message
= (struct ca_msg
*) kmalloc(sizeof (struct ca_msg
), GFP_KERNEL
)) == NULL
) {
477 dprintk(verbose
, DST_CA_ERROR
, 1, " Memory allocation failure");
480 if ((p_ca_slot_info
= (struct ca_slot_info
*) kmalloc(sizeof (struct ca_slot_info
), GFP_KERNEL
)) == NULL
) {
481 dprintk(verbose
, DST_CA_ERROR
, 1, " Memory allocation failure");
484 if ((p_ca_caps
= (struct ca_caps
*) kmalloc(sizeof (struct ca_caps
), GFP_KERNEL
)) == NULL
) {
485 dprintk(verbose
, DST_CA_ERROR
, 1, " Memory allocation failure");
488 /* We have now only the standard ioctl's, the driver is upposed to handle internals. */
491 dprintk(verbose
, DST_CA_INFO
, 1, " Sending message");
492 if ((ca_send_message(state
, p_ca_message
, arg
)) < 0) {
493 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_SEND_MSG Failed !");
495 goto free_mem_and_exit
;
499 dprintk(verbose
, DST_CA_INFO
, 1, " Getting message");
500 if ((ca_get_message(state
, p_ca_message
, arg
)) < 0) {
501 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_GET_MSG Failed !");
503 goto free_mem_and_exit
;
505 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_GET_MSG Success !");
508 dprintk(verbose
, DST_CA_ERROR
, 1, " Resetting DST");
509 dst_error_bailout(state
);
512 case CA_GET_SLOT_INFO
:
513 dprintk(verbose
, DST_CA_INFO
, 1, " Getting Slot info");
514 if ((ca_get_slot_info(state
, p_ca_slot_info
, arg
)) < 0) {
515 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_GET_SLOT_INFO Failed !");
517 goto free_mem_and_exit
;
519 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_GET_SLOT_INFO Success !");
522 dprintk(verbose
, DST_CA_INFO
, 1, " Getting Slot capabilities");
523 if ((ca_get_slot_caps(state
, p_ca_caps
, arg
)) < 0) {
524 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_GET_CAP Failed !");
526 goto free_mem_and_exit
;
528 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_GET_CAP Success !");
530 case CA_GET_DESCR_INFO
:
531 dprintk(verbose
, DST_CA_INFO
, 1, " Getting descrambler description");
532 if ((ca_get_slot_descr(state
, p_ca_message
, arg
)) < 0) {
533 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_GET_DESCR_INFO Failed !");
535 goto free_mem_and_exit
;
537 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_GET_DESCR_INFO Success !");
540 dprintk(verbose
, DST_CA_INFO
, 1, " Setting descrambler");
541 if ((ca_set_slot_descr()) < 0) {
542 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_SET_DESCR Failed !");
544 goto free_mem_and_exit
;
546 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_SET_DESCR Success !");
549 dprintk(verbose
, DST_CA_INFO
, 1, " Setting PID");
550 if ((ca_set_pid()) < 0) {
551 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_SET_PID Failed !");
553 goto free_mem_and_exit
;
555 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_SET_PID Success !");
557 result
= -EOPNOTSUPP
;
560 kfree (p_ca_message
);
561 kfree (p_ca_slot_info
);
567 static int dst_ca_open(struct inode
*inode
, struct file
*file
)
569 dprintk(verbose
, DST_CA_DEBUG
, 1, " Device opened [%p] ", file
);
570 try_module_get(THIS_MODULE
);
575 static int dst_ca_release(struct inode
*inode
, struct file
*file
)
577 dprintk(verbose
, DST_CA_DEBUG
, 1, " Device closed.");
578 module_put(THIS_MODULE
);
583 static ssize_t
dst_ca_read(struct file
*file
, char __user
*buffer
, size_t length
, loff_t
*offset
)
587 dprintk(verbose
, DST_CA_DEBUG
, 1, " Device read.");
592 static ssize_t
dst_ca_write(struct file
*file
, const char __user
*buffer
, size_t length
, loff_t
*offset
)
594 dprintk(verbose
, DST_CA_DEBUG
, 1, " Device write.");
599 static struct file_operations dst_ca_fops
= {
600 .owner
= THIS_MODULE
,
601 .ioctl
= dst_ca_ioctl
,
603 .release
= dst_ca_release
,
605 .write
= dst_ca_write
608 static struct dvb_device dvbdev_ca
= {
616 int dst_ca_attach(struct dst_state
*dst
, struct dvb_adapter
*dvb_adapter
)
618 struct dvb_device
*dvbdev
;
619 dprintk(verbose
, DST_CA_ERROR
, 1, "registering DST-CA device");
620 dvb_register_device(dvb_adapter
, &dvbdev
, &dvbdev_ca
, dst
, DVB_DEVICE_CA
);
624 EXPORT_SYMBOL(dst_ca_attach
);
626 MODULE_DESCRIPTION("DST DVB-S/T/C Combo CA driver");
627 MODULE_AUTHOR("Manu Abraham");
628 MODULE_LICENSE("GPL");