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 int put_checksum(u8
*check_string
, int length
)
74 u8 i
= 0, checksum
= 0;
76 dprintk(verbose
, DST_CA_DEBUG
, 1, " ========================= Checksum calculation ===========================");
77 dprintk(verbose
, DST_CA_DEBUG
, 1, " String Length=[0x%02x]", length
);
78 dprintk(verbose
, DST_CA_DEBUG
, 1, " String=[");
81 dprintk(verbose
, DST_CA_DEBUG
, 0, " %02x", check_string
[i
]);
82 checksum
+= check_string
[i
];
85 dprintk(verbose
, DST_CA_DEBUG
, 0, " ]\n");
86 dprintk(verbose
, DST_CA_DEBUG
, 1, "Sum=[%02x]\n", checksum
);
87 check_string
[length
] = ~checksum
+ 1;
88 dprintk(verbose
, DST_CA_DEBUG
, 1, " Checksum=[%02x]", check_string
[length
]);
89 dprintk(verbose
, DST_CA_DEBUG
, 1, " ==========================================================================");
94 static int dst_ci_command(struct dst_state
* state
, u8
* data
, u8
*ca_string
, u8 len
, int read
)
101 if (write_dst(state
, data
, len
)) {
102 dprintk(verbose
, DST_CA_INFO
, 1, " Write not successful, trying to recover");
103 dst_error_recovery(state
);
106 if ((dst_pio_disable(state
)) < 0) {
107 dprintk(verbose
, DST_CA_ERROR
, 1, " DST PIO disable failed.");
110 if (read_dst(state
, &reply
, GET_ACK
) < 0) {
111 dprintk(verbose
, DST_CA_INFO
, 1, " Read not successful, trying to recover");
112 dst_error_recovery(state
);
116 if (! dst_wait_dst_ready(state
, LONG_DELAY
)) {
117 dprintk(verbose
, DST_CA_NOTICE
, 1, " 8820 not ready");
120 if (read_dst(state
, ca_string
, 128) < 0) { /* Try to make this dynamic */
121 dprintk(verbose
, DST_CA_INFO
, 1, " Read not successful, trying to recover");
122 dst_error_recovery(state
);
131 static int dst_put_ci(struct dst_state
*state
, u8
*data
, int len
, u8
*ca_string
, int read
)
133 u8 dst_ca_comm_err
= 0;
135 while (dst_ca_comm_err
< RETRIES
) {
136 dst_comm_init(state
);
137 dprintk(verbose
, DST_CA_NOTICE
, 1, " Put Command");
138 if (dst_ci_command(state
, data
, ca_string
, len
, read
)) { // If error
139 dst_error_recovery(state
);
140 dst_ca_comm_err
++; // work required here.
150 static int ca_get_app_info(struct dst_state
*state
)
152 static u8 command
[8] = {0x07, 0x40, 0x01, 0x00, 0x01, 0x00, 0x00, 0xff};
154 put_checksum(&command
[0], command
[0]);
155 if ((dst_put_ci(state
, command
, sizeof(command
), state
->messages
, GET_REPLY
)) < 0) {
156 dprintk(verbose
, DST_CA_ERROR
, 1, " -->dst_put_ci FAILED !");
159 dprintk(verbose
, DST_CA_INFO
, 1, " -->dst_put_ci SUCCESS !");
160 dprintk(verbose
, DST_CA_INFO
, 1, " ================================ CI Module Application Info ======================================");
161 dprintk(verbose
, DST_CA_INFO
, 1, " Application Type=[%d], Application Vendor=[%d], Vendor Code=[%d]\n%s: Application info=[%s]",
162 state
->messages
[7], (state
->messages
[8] << 8) | state
->messages
[9],
163 (state
->messages
[10] << 8) | state
->messages
[11], __FUNCTION__
, (char *)(&state
->messages
[12]));
164 dprintk(verbose
, DST_CA_INFO
, 1, " ==================================================================================================");
169 static int ca_get_slot_caps(struct dst_state
*state
, struct ca_caps
*p_ca_caps
, void *arg
)
173 static u8 slot_command
[8] = {0x07, 0x40, 0x02, 0x00, 0x02, 0x00, 0x00, 0xff};
175 put_checksum(&slot_command
[0], slot_command
[0]);
176 if ((dst_put_ci(state
, slot_command
, sizeof (slot_command
), slot_cap
, GET_REPLY
)) < 0) {
177 dprintk(verbose
, DST_CA_ERROR
, 1, " -->dst_put_ci FAILED !");
180 dprintk(verbose
, DST_CA_NOTICE
, 1, " -->dst_put_ci SUCCESS !");
182 /* Will implement the rest soon */
184 dprintk(verbose
, DST_CA_INFO
, 1, " Slot cap = [%d]", slot_cap
[7]);
185 dprintk(verbose
, DST_CA_INFO
, 0, "===================================\n");
186 for (i
= 0; i
< 8; i
++)
187 dprintk(verbose
, DST_CA_INFO
, 0, " %d", slot_cap
[i
]);
188 dprintk(verbose
, DST_CA_INFO
, 0, "\n");
190 p_ca_caps
->slot_num
= 1;
191 p_ca_caps
->slot_type
= 1;
192 p_ca_caps
->descr_num
= slot_cap
[7];
193 p_ca_caps
->descr_type
= 1;
195 if (copy_to_user((struct ca_caps
*)arg
, p_ca_caps
, sizeof (struct ca_caps
)))
201 /* Need some more work */
202 static int ca_get_slot_descr(struct dst_state
*state
, struct ca_msg
*p_ca_message
, void *arg
)
208 static int ca_get_slot_info(struct dst_state
*state
, struct ca_slot_info
*p_ca_slot_info
, void *arg
)
211 static u8 slot_command
[8] = {0x00, 0x05, 0x00, 0x00, 0x00, 0x00, 0x00, 0xff};
213 u8
*slot_info
= state
->rxbuffer
;
215 put_checksum(&slot_command
[0], 7);
216 if ((dst_put_ci(state
, slot_command
, sizeof (slot_command
), slot_info
, GET_REPLY
)) < 0) {
217 dprintk(verbose
, DST_CA_ERROR
, 1, " -->dst_put_ci FAILED !");
220 dprintk(verbose
, DST_CA_INFO
, 1, " -->dst_put_ci SUCCESS !");
222 /* Will implement the rest soon */
224 dprintk(verbose
, DST_CA_INFO
, 1, " Slot info = [%d]", slot_info
[3]);
225 dprintk(verbose
, DST_CA_INFO
, 0, "===================================\n");
226 for (i
= 0; i
< 8; i
++)
227 dprintk(verbose
, DST_CA_INFO
, 0, " %d", slot_info
[i
]);
228 dprintk(verbose
, DST_CA_INFO
, 0, "\n");
230 if (slot_info
[4] & 0x80) {
231 p_ca_slot_info
->flags
= CA_CI_MODULE_PRESENT
;
232 p_ca_slot_info
->num
= 1;
233 p_ca_slot_info
->type
= CA_CI
;
234 } else if (slot_info
[4] & 0x40) {
235 p_ca_slot_info
->flags
= CA_CI_MODULE_READY
;
236 p_ca_slot_info
->num
= 1;
237 p_ca_slot_info
->type
= CA_CI
;
239 p_ca_slot_info
->flags
= 0;
241 if (copy_to_user((struct ca_slot_info
*)arg
, p_ca_slot_info
, sizeof (struct ca_slot_info
)))
248 static int ca_get_message(struct dst_state
*state
, struct ca_msg
*p_ca_message
, void *arg
)
253 if (copy_from_user(p_ca_message
, (void *)arg
, sizeof (struct ca_msg
)))
256 if (p_ca_message
->msg
) {
257 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]);
259 for (i
= 0; i
< 3; i
++) {
260 command
= command
| p_ca_message
->msg
[i
];
262 command
= command
<< 8;
264 dprintk(verbose
, DST_CA_NOTICE
, 1, " Command=[0x%x]", command
);
268 memcpy(p_ca_message
->msg
, state
->messages
, 128);
269 if (copy_to_user((void *)arg
, p_ca_message
, sizeof (struct ca_msg
)) )
278 static int handle_dst_tag(struct dst_state
*state
, struct ca_msg
*p_ca_message
, struct ca_msg
*hw_buffer
, u32 length
)
280 if (state
->dst_hw_cap
& DST_TYPE_HAS_SESSION
) {
281 hw_buffer
->msg
[2] = p_ca_message
->msg
[1]; /* MSB */
282 hw_buffer
->msg
[3] = p_ca_message
->msg
[2]; /* LSB */
285 dprintk(verbose
, DST_CA_ERROR
, 1, " Message too long ! *** Bailing Out *** !");
288 hw_buffer
->msg
[0] = (length
& 0xff) + 7;
289 hw_buffer
->msg
[1] = 0x40;
290 hw_buffer
->msg
[2] = 0x03;
291 hw_buffer
->msg
[3] = 0x00;
292 hw_buffer
->msg
[4] = 0x03;
293 hw_buffer
->msg
[5] = length
& 0xff;
294 hw_buffer
->msg
[6] = 0x00;
296 * Need to compute length for EN50221 section 8.3.2, for the time being
297 * assuming 8.3.2 is not applicable
299 memcpy(&hw_buffer
->msg
[7], &p_ca_message
->msg
[4], length
);
305 static int write_to_8820(struct dst_state
*state
, struct ca_msg
*hw_buffer
, u8 length
, u8 reply
)
307 if ((dst_put_ci(state
, hw_buffer
->msg
, length
, hw_buffer
->msg
, reply
)) < 0) {
308 dprintk(verbose
, DST_CA_ERROR
, 1, " DST-CI Command failed.");
309 dprintk(verbose
, DST_CA_NOTICE
, 1, " Resetting DST.");
310 rdc_reset_state(state
);
313 dprintk(verbose
, DST_CA_NOTICE
, 1, " DST-CI Command succes.");
318 u32
asn_1_decode(u8
*asn_1_array
)
320 u8 length_field
= 0, word_count
= 0, count
= 0;
323 length_field
= asn_1_array
[0];
324 dprintk(verbose
, DST_CA_DEBUG
, 1, " Length field=[%02x]", length_field
);
325 if (length_field
< 0x80) {
326 length
= length_field
& 0x7f;
327 dprintk(verbose
, DST_CA_DEBUG
, 1, " Length=[%02x]\n", length
);
329 word_count
= length_field
& 0x7f;
330 for (count
= 0; count
< word_count
; count
++) {
331 length
= (length
| asn_1_array
[count
+ 1]) << 8;
332 dprintk(verbose
, DST_CA_DEBUG
, 1, " Length=[%04x]", length
);
338 static int debug_string(u8
*msg
, u32 length
, u32 offset
)
342 dprintk(verbose
, DST_CA_DEBUG
, 0, " String=[ ");
343 for (i
= offset
; i
< length
; i
++)
344 dprintk(verbose
, DST_CA_DEBUG
, 0, "%02x ", msg
[i
]);
345 dprintk(verbose
, DST_CA_DEBUG
, 0, "]\n");
350 static int ca_set_pmt(struct dst_state
*state
, struct ca_msg
*p_ca_message
, struct ca_msg
*hw_buffer
, u8 reply
, u8 query
)
355 length
= asn_1_decode(&p_ca_message
->msg
[3]);
356 dprintk(verbose
, DST_CA_DEBUG
, 1, " CA Message length=[%d]", length
);
357 debug_string(&p_ca_message
->msg
[4], length
, 0); /* length is excluding tag & length */
359 memset(hw_buffer
->msg
, '\0', length
);
360 handle_dst_tag(state
, p_ca_message
, hw_buffer
, length
);
361 put_checksum(hw_buffer
->msg
, hw_buffer
->msg
[0]);
363 debug_string(hw_buffer
->msg
, (length
+ tag_length
), 0); /* tags too */
364 write_to_8820(state
, hw_buffer
, (length
+ tag_length
), reply
);
370 /* Board supports CA PMT reply ? */
371 static int dst_check_ca_pmt(struct dst_state
*state
, struct ca_msg
*p_ca_message
, struct ca_msg
*hw_buffer
)
373 int ca_pmt_reply_test
= 0;
376 /* Not there yet but soon */
378 /* CA PMT Reply capable */
379 if (ca_pmt_reply_test
) {
380 if ((ca_set_pmt(state
, p_ca_message
, hw_buffer
, 1, GET_REPLY
)) < 0) {
381 dprintk(verbose
, DST_CA_ERROR
, 1, " ca_set_pmt.. failed !");
385 /* Process CA PMT Reply */
386 /* will implement soon */
387 dprintk(verbose
, DST_CA_ERROR
, 1, " Not there yet");
389 /* CA PMT Reply not capable */
390 if (!ca_pmt_reply_test
) {
391 if ((ca_set_pmt(state
, p_ca_message
, hw_buffer
, 0, NO_REPLY
)) < 0) {
392 dprintk(verbose
, DST_CA_ERROR
, 1, " ca_set_pmt.. failed !");
395 dprintk(verbose
, DST_CA_NOTICE
, 1, " ca_set_pmt.. success !");
396 /* put a dummy message */
402 static int ca_send_message(struct dst_state
*state
, struct ca_msg
*p_ca_message
, void *arg
)
405 unsigned int ca_message_header_len
;
408 struct ca_msg
*hw_buffer
;
410 if ((hw_buffer
= (struct ca_msg
*) kmalloc(sizeof (struct ca_msg
), GFP_KERNEL
)) == NULL
) {
411 dprintk(verbose
, DST_CA_ERROR
, 1, " Memory allocation failure");
414 dprintk(verbose
, DST_CA_DEBUG
, 1, " ");
416 if (copy_from_user(p_ca_message
, (void *)arg
, sizeof (struct ca_msg
)))
419 if (p_ca_message
->msg
) {
420 ca_message_header_len
= p_ca_message
->length
; /* Restore it back when you are done */
424 for (i
= 0; i
< 3; i
++) {
425 command
= command
| p_ca_message
->msg
[i
];
427 command
= command
<< 8;
429 dprintk(verbose
, DST_CA_DEBUG
, 1, " Command=[0x%x]\n", command
);
433 dprintk(verbose
, DST_CA_DEBUG
, 1, "Command = SEND_CA_PMT");
434 if ((ca_set_pmt(state
, p_ca_message
, hw_buffer
, 0, 0)) < 0) { // code simplification started
435 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_PMT Failed !");
438 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_PMT Success !");
441 dprintk(verbose
, DST_CA_INFO
, 1, "Command = CA_PMT_REPLY");
442 /* Have to handle the 2 basic types of cards here */
443 if ((dst_check_ca_pmt(state
, p_ca_message
, hw_buffer
)) < 0) {
444 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_PMT_REPLY Failed !");
447 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_PMT_REPLY Success !");
449 case CA_APP_INFO_ENQUIRY
: // only for debugging
450 dprintk(verbose
, DST_CA_INFO
, 1, " Getting Cam Application information");
452 if ((ca_get_app_info(state
)) < 0) {
453 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_APP_INFO_ENQUIRY Failed !");
456 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_APP_INFO_ENQUIRY Success !");
463 static int dst_ca_ioctl(struct inode
*inode
, struct file
*file
, unsigned int cmd
, void *arg
)
465 struct dvb_device
* dvbdev
= (struct dvb_device
*) file
->private_data
;
466 struct dst_state
* state
= (struct dst_state
*) dvbdev
->priv
;
467 struct ca_slot_info
*p_ca_slot_info
;
468 struct ca_caps
*p_ca_caps
;
469 struct ca_msg
*p_ca_message
;
471 if ((p_ca_message
= (struct ca_msg
*) kmalloc(sizeof (struct ca_msg
), GFP_KERNEL
)) == NULL
) {
472 dprintk(verbose
, DST_CA_ERROR
, 1, " Memory allocation failure");
475 if ((p_ca_slot_info
= (struct ca_slot_info
*) kmalloc(sizeof (struct ca_slot_info
), GFP_KERNEL
)) == NULL
) {
476 dprintk(verbose
, DST_CA_ERROR
, 1, " Memory allocation failure");
479 if ((p_ca_caps
= (struct ca_caps
*) kmalloc(sizeof (struct ca_caps
), GFP_KERNEL
)) == NULL
) {
480 dprintk(verbose
, DST_CA_ERROR
, 1, " Memory allocation failure");
483 /* We have now only the standard ioctl's, the driver is upposed to handle internals. */
486 dprintk(verbose
, DST_CA_INFO
, 1, " Sending message");
487 if ((ca_send_message(state
, p_ca_message
, arg
)) < 0) {
488 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_SEND_MSG Failed !");
493 dprintk(verbose
, DST_CA_INFO
, 1, " Getting message");
494 if ((ca_get_message(state
, p_ca_message
, arg
)) < 0) {
495 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_GET_MSG Failed !");
498 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_GET_MSG Success !");
501 dprintk(verbose
, DST_CA_ERROR
, 1, " Resetting DST");
502 dst_error_bailout(state
);
505 case CA_GET_SLOT_INFO
:
506 dprintk(verbose
, DST_CA_INFO
, 1, " Getting Slot info");
507 if ((ca_get_slot_info(state
, p_ca_slot_info
, arg
)) < 0) {
508 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_GET_SLOT_INFO Failed !");
511 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_GET_SLOT_INFO Success !");
514 dprintk(verbose
, DST_CA_INFO
, 1, " Getting Slot capabilities");
515 if ((ca_get_slot_caps(state
, p_ca_caps
, arg
)) < 0) {
516 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_GET_CAP Failed !");
519 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_GET_CAP Success !");
521 case CA_GET_DESCR_INFO
:
522 dprintk(verbose
, DST_CA_INFO
, 1, " Getting descrambler description");
523 if ((ca_get_slot_descr(state
, p_ca_message
, arg
)) < 0) {
524 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_GET_DESCR_INFO Failed !");
527 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_GET_DESCR_INFO Success !");
530 dprintk(verbose
, DST_CA_INFO
, 1, " Setting descrambler");
531 if ((ca_set_slot_descr()) < 0) {
532 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_SET_DESCR Failed !");
535 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_SET_DESCR Success !");
538 dprintk(verbose
, DST_CA_INFO
, 1, " Setting PID");
539 if ((ca_set_pid()) < 0) {
540 dprintk(verbose
, DST_CA_ERROR
, 1, " -->CA_SET_PID Failed !");
543 dprintk(verbose
, DST_CA_INFO
, 1, " -->CA_SET_PID Success !");
551 static int dst_ca_open(struct inode
*inode
, struct file
*file
)
553 dprintk(verbose
, DST_CA_DEBUG
, 1, " Device opened [%p] ", file
);
554 try_module_get(THIS_MODULE
);
559 static int dst_ca_release(struct inode
*inode
, struct file
*file
)
561 dprintk(verbose
, DST_CA_DEBUG
, 1, " Device closed.");
562 module_put(THIS_MODULE
);
567 static int dst_ca_read(struct file
*file
, char __user
*buffer
, size_t length
, loff_t
*offset
)
571 dprintk(verbose
, DST_CA_DEBUG
, 1, " Device read.");
576 static int dst_ca_write(struct file
*file
, const char __user
*buffer
, size_t length
, loff_t
*offset
)
578 dprintk(verbose
, DST_CA_DEBUG
, 1, " Device write.");
583 static struct file_operations dst_ca_fops
= {
584 .owner
= THIS_MODULE
,
585 .ioctl
= (void *)dst_ca_ioctl
,
587 .release
= dst_ca_release
,
589 .write
= dst_ca_write
592 static struct dvb_device dvbdev_ca
= {
600 int dst_ca_attach(struct dst_state
*dst
, struct dvb_adapter
*dvb_adapter
)
602 struct dvb_device
*dvbdev
;
603 dprintk(verbose
, DST_CA_ERROR
, 1, "registering DST-CA device");
604 dvb_register_device(dvb_adapter
, &dvbdev
, &dvbdev_ca
, dst
, DVB_DEVICE_CA
);
608 EXPORT_SYMBOL(dst_ca_attach
);
610 MODULE_DESCRIPTION("DST DVB-S/T/C Combo CA driver");
611 MODULE_AUTHOR("Manu Abraham");
612 MODULE_LICENSE("GPL");