1 | #include "globals.h"
|
---|
2 | #include "reader-common.h"
|
---|
3 | #include "defines.h"
|
---|
4 | #include "atr.h"
|
---|
5 | #include "icc_async_exports.h"
|
---|
6 | #include "csctapi/ifd_sc8in1.h"
|
---|
7 | #ifdef HAVE_PCSC
|
---|
8 | #include "csctapi/ifd_pcsc.h"
|
---|
9 | #endif
|
---|
10 | #ifdef AZBOX
|
---|
11 | #include "csctapi/ifd_azbox.h"
|
---|
12 | #endif
|
---|
13 |
|
---|
14 | #if defined(TUXBOX) && defined(PPC) //dbox2 only
|
---|
15 | #include "csctapi/mc_global.h"
|
---|
16 | static int reader_device_type(struct s_reader * reader)
|
---|
17 | {
|
---|
18 | int rc=reader->typ;
|
---|
19 | struct stat sb;
|
---|
20 | if (reader->typ == R_MOUSE)
|
---|
21 | {
|
---|
22 | if (!stat(reader->device, &sb))
|
---|
23 | {
|
---|
24 | if (S_ISCHR(sb.st_mode))
|
---|
25 | {
|
---|
26 | int dev_major, dev_minor;
|
---|
27 | dev_major=major(sb.st_rdev);
|
---|
28 | dev_minor=minor(sb.st_rdev);
|
---|
29 | if (((dev_major==4) || (dev_major==5)))
|
---|
30 | switch(dev_minor & 0x3F)
|
---|
31 | {
|
---|
32 | case 0: rc=R_DB2COM1; break;
|
---|
33 | case 1: rc=R_DB2COM2; break;
|
---|
34 | }
|
---|
35 | cs_debug("device is major: %d, minor: %d, typ=%d", dev_major, dev_minor, rc);
|
---|
36 | }
|
---|
37 | }
|
---|
38 | }
|
---|
39 | reader->typ = rc;
|
---|
40 | return(rc);
|
---|
41 | }
|
---|
42 | #endif
|
---|
43 |
|
---|
44 | static void reader_nullcard(struct s_reader * reader)
|
---|
45 | {
|
---|
46 | reader->card_system=0;
|
---|
47 | memset(reader->hexserial, 0 , sizeof(reader->hexserial));
|
---|
48 | memset(reader->prid , 0xFF, sizeof(reader->prid ));
|
---|
49 | memset(reader->caid , 0 , sizeof(reader->caid ));
|
---|
50 | memset(reader->availkeys, 0 , sizeof(reader->availkeys));
|
---|
51 | reader->acs=0;
|
---|
52 | reader->nprov=0;
|
---|
53 | }
|
---|
54 |
|
---|
55 | int reader_cmd2icc(struct s_reader * reader, const uchar *buf, const int l, uchar * cta_res, ushort * p_cta_lr)
|
---|
56 | {
|
---|
57 | int rc;
|
---|
58 | #ifdef HAVE_PCSC
|
---|
59 | if (reader->typ == R_PCSC) {
|
---|
60 | return (pcsc_reader_do_api(reader, buf, cta_res, p_cta_lr,l));
|
---|
61 | }
|
---|
62 |
|
---|
63 | #endif
|
---|
64 |
|
---|
65 | *p_cta_lr=CTA_RES_LEN-1; //FIXME not sure whether this one is necessary
|
---|
66 | int cs_ptyp_orig=client[cs_idx].cs_ptyp;
|
---|
67 | client[cs_idx].cs_ptyp=D_DEVICE;
|
---|
68 | if (reader->typ == R_SC8in1) {
|
---|
69 | pthread_mutex_lock(&sc8in1);
|
---|
70 | cs_debug("SC8in1: locked for CardWrite of slot %i", reader->slot);
|
---|
71 | Sc8in1_Selectslot(reader, reader->slot);
|
---|
72 | }
|
---|
73 | cs_ddump(buf, l, "write to cardreader %s:",reader->label);
|
---|
74 | rc=ICC_Async_CardWrite(reader, (uchar *)buf, (unsigned short)l, cta_res, p_cta_lr);
|
---|
75 | cs_ddump(cta_res, *p_cta_lr, "answer from cardreader %s:", reader->label);
|
---|
76 | if (reader->typ == R_SC8in1) {
|
---|
77 | cs_debug("SC8in1: unlocked for CardWrite of slot %i", reader->slot);
|
---|
78 | pthread_mutex_unlock(&sc8in1);
|
---|
79 | }
|
---|
80 | client[cs_idx].cs_ptyp=cs_ptyp_orig;
|
---|
81 | return rc;
|
---|
82 | }
|
---|
83 |
|
---|
84 | #define CMD_LEN 5
|
---|
85 |
|
---|
86 | int card_write(struct s_reader * reader, const uchar *cmd, const uchar *data, uchar *response, ushort * response_length)
|
---|
87 | {
|
---|
88 | uchar buf[260];
|
---|
89 | // always copy to be able to be able to use const buffer without changing all code
|
---|
90 | memcpy(buf, cmd, CMD_LEN);
|
---|
91 |
|
---|
92 | if (data) {
|
---|
93 | if (cmd[4]) memcpy(buf+CMD_LEN, data, cmd[4]);
|
---|
94 | return(reader_cmd2icc(reader, buf, CMD_LEN+cmd[4], response, response_length));
|
---|
95 | }
|
---|
96 | else
|
---|
97 | return(reader_cmd2icc(reader, buf, CMD_LEN, response, response_length));
|
---|
98 | }
|
---|
99 |
|
---|
100 | int check_sct_len(const uchar *data, int off)
|
---|
101 | {
|
---|
102 | int l = SCT_LEN(data);
|
---|
103 | if (l+off > MAX_LEN) {
|
---|
104 | cs_debug("check_sct_len(): smartcard section too long %d > %d", l, MAX_LEN-off);
|
---|
105 | l = -1;
|
---|
106 | }
|
---|
107 | return(l);
|
---|
108 | }
|
---|
109 |
|
---|
110 |
|
---|
111 | static int reader_card_inserted(struct s_reader * reader)
|
---|
112 | {
|
---|
113 | #ifndef USE_GPIO
|
---|
114 | if ((reader->detect&0x7f) > 3)
|
---|
115 | return 1;
|
---|
116 | #endif
|
---|
117 | #ifdef HAVE_PCSC
|
---|
118 | if (reader->typ == R_PCSC) {
|
---|
119 | return(pcsc_check_card_inserted(reader));
|
---|
120 | }
|
---|
121 | #endif
|
---|
122 | int card;
|
---|
123 | int cs_ptyp_orig=client[cs_idx].cs_ptyp;
|
---|
124 | client[cs_idx].cs_ptyp=D_IFD;
|
---|
125 | if (ICC_Async_GetStatus (reader, &card)) {
|
---|
126 | cs_log("Error getting status of terminal.");
|
---|
127 | return 0; //corresponds with no card inside!!
|
---|
128 | }
|
---|
129 | client[cs_idx].cs_ptyp=cs_ptyp_orig;
|
---|
130 | return (card);
|
---|
131 | }
|
---|
132 |
|
---|
133 | static int reader_activate_card(struct s_reader * reader, ATR * atr, unsigned short deprecated)
|
---|
134 | {
|
---|
135 | int i;
|
---|
136 | #ifdef HAVE_PCSC
|
---|
137 | unsigned char atrarr[64];
|
---|
138 | ushort atr_size = 0;
|
---|
139 | if (reader->typ == R_PCSC) {
|
---|
140 | if (pcsc_activate_card(reader, atrarr, &atr_size))
|
---|
141 | return (ATR_InitFromArray (atr, atrarr, atr_size) == ATR_OK);
|
---|
142 | else
|
---|
143 | return 0;
|
---|
144 | }
|
---|
145 | #endif
|
---|
146 | if (!reader_card_inserted(reader))
|
---|
147 | return 0;
|
---|
148 |
|
---|
149 | /* Activate card */
|
---|
150 | int cs_ptyp_orig=client[cs_idx].cs_ptyp;
|
---|
151 | client[cs_idx].cs_ptyp=D_DEVICE;
|
---|
152 | if (reader->typ == R_SC8in1) {
|
---|
153 | pthread_mutex_lock(&sc8in1);
|
---|
154 | cs_debug_mask(D_ATR, "SC8in1: locked for Activation of slot %i", reader->slot);
|
---|
155 | Sc8in1_Selectslot(reader, reader->slot);
|
---|
156 | }
|
---|
157 | for (i=0; i<5; i++) {
|
---|
158 | if (!ICC_Async_Activate(reader, atr, deprecated)) {
|
---|
159 | i = 100;
|
---|
160 | break;
|
---|
161 | }
|
---|
162 | cs_log("Error activating card.");
|
---|
163 | cs_sleepms(500);
|
---|
164 | }
|
---|
165 | if (reader->typ == R_SC8in1) {
|
---|
166 | cs_debug_mask(D_ATR, "SC8in1: unlocked for Activation of slot %i", reader->slot);
|
---|
167 | pthread_mutex_unlock(&sc8in1);
|
---|
168 | }
|
---|
169 | client[cs_idx].cs_ptyp=cs_ptyp_orig;
|
---|
170 | if (i<100) return(0);
|
---|
171 |
|
---|
172 | reader->init_history_pos=0;
|
---|
173 |
|
---|
174 | // cs_ri_log("ATR: %s", cs_hexdump(1, atr, atr_size));//FIXME
|
---|
175 | cs_sleepms(1000);
|
---|
176 | return(1);
|
---|
177 | }
|
---|
178 |
|
---|
179 | void do_emm_from_file(struct s_reader * reader)
|
---|
180 | {
|
---|
181 | //now here check whether we have EMM's on file to load and write to card:
|
---|
182 | if (reader->emmfile != NULL) {//readnano has something filled in
|
---|
183 |
|
---|
184 | //handling emmfile
|
---|
185 | char token[256];
|
---|
186 | FILE *fp;
|
---|
187 | size_t result;
|
---|
188 | if ((reader->emmfile[0] == '/'))
|
---|
189 | sprintf (token, "%s", reader->emmfile); //pathname included
|
---|
190 | else
|
---|
191 | sprintf (token, "%s%s", cs_confdir, reader->emmfile); //only file specified, look in confdir for this file
|
---|
192 |
|
---|
193 | if (!(fp = fopen (token, "rb")))
|
---|
194 | cs_log ("ERROR: Cannot open EMM file '%s' (errno=%d)\n", token, errno);
|
---|
195 | else {
|
---|
196 | EMM_PACKET *eptmp;
|
---|
197 | eptmp = malloc (sizeof(EMM_PACKET));
|
---|
198 | result = fread (eptmp, sizeof(EMM_PACKET), 1, fp);
|
---|
199 | fclose (fp);
|
---|
200 |
|
---|
201 | uchar old_b_nano = reader->b_nano[eptmp->emm[0]]; //save old b_nano value
|
---|
202 | reader->b_nano[eptmp->emm[0]] &= 0xfc; //clear lsb and lsb+1, so no blocking, and no saving for this nano
|
---|
203 |
|
---|
204 | //if (!reader_do_emm (eptmp))
|
---|
205 | if (!reader_emm (reader, eptmp))
|
---|
206 | cs_log ("ERROR: EMM read from file %s NOT processed correctly!", token);
|
---|
207 |
|
---|
208 | reader->b_nano[eptmp->emm[0]] = old_b_nano; //restore old block/save settings
|
---|
209 | free (reader->emmfile);
|
---|
210 | reader->emmfile = NULL; //clear emmfile, so no reading anymore
|
---|
211 |
|
---|
212 | free(eptmp);
|
---|
213 | eptmp = NULL;
|
---|
214 | }
|
---|
215 | }
|
---|
216 | }
|
---|
217 |
|
---|
218 | void reader_card_info(struct s_reader * reader)
|
---|
219 | {
|
---|
220 | if ((reader->card_status == CARD_NEED_INIT) || (reader->card_status == CARD_INSERTED))
|
---|
221 | {
|
---|
222 | client[cs_idx].last=time((time_t)0);
|
---|
223 | cs_ri_brk(reader, 0);
|
---|
224 | do_emm_from_file(reader);
|
---|
225 |
|
---|
226 | if (cardsystem[reader->card_system-1].card_info) {
|
---|
227 | cardsystem[reader->card_system-1].card_info(reader);
|
---|
228 | }
|
---|
229 | }
|
---|
230 | }
|
---|
231 |
|
---|
232 | static int reader_get_cardsystem(struct s_reader * reader, ATR atr)
|
---|
233 | {
|
---|
234 | int i;
|
---|
235 | for (i=0; i<CS_MAX_MOD; i++) {
|
---|
236 | if (cardsystem[i].card_init) {
|
---|
237 | if (cardsystem[i].card_init(reader, atr)) {
|
---|
238 | reader->card_system=i+1;
|
---|
239 | cs_log("found cardsystem");
|
---|
240 | break;
|
---|
241 | }
|
---|
242 | }
|
---|
243 | }
|
---|
244 |
|
---|
245 | if (reader->card_system==0)
|
---|
246 | cs_ri_log(reader, "card system not supported");
|
---|
247 |
|
---|
248 | cs_ri_brk(reader, 1);
|
---|
249 |
|
---|
250 | return(reader->card_system);
|
---|
251 | }
|
---|
252 |
|
---|
253 | static int reader_reset(struct s_reader * reader)
|
---|
254 | {
|
---|
255 | reader_nullcard(reader);
|
---|
256 | ATR atr;
|
---|
257 | unsigned short int ret = 0;
|
---|
258 | #ifdef AZBOX
|
---|
259 | int i;
|
---|
260 | if (reader->typ == R_INTERNAL) {
|
---|
261 | if (reader->mode != -1) {
|
---|
262 | Azbox_SetMode(reader->mode);
|
---|
263 | if (!reader_activate_card(reader, &atr, 0)) return(0);
|
---|
264 | ret = reader_get_cardsystem(reader, atr);
|
---|
265 | } else {
|
---|
266 | for (i = 0; i < AZBOX_MODES; i++) {
|
---|
267 | Azbox_SetMode(i);
|
---|
268 | if (!reader_activate_card(reader, &atr, 0)) return(0);
|
---|
269 | ret = reader_get_cardsystem(reader, atr);
|
---|
270 | if (ret)
|
---|
271 | break;
|
---|
272 | }
|
---|
273 | }
|
---|
274 | } else {
|
---|
275 | #endif
|
---|
276 | int i;
|
---|
277 | unsigned short int deprecated;
|
---|
278 | for (i = 0; i < 4; i++) {
|
---|
279 | cs_log("Card activation attempt %d...", i+1);
|
---|
280 | for (deprecated = reader->deprecated; deprecated < 2; deprecated++) {
|
---|
281 | if (!reader_activate_card(reader, &atr, deprecated)) return(0);
|
---|
282 | ret = reader_get_cardsystem(reader, atr);
|
---|
283 | if (ret)
|
---|
284 | break;
|
---|
285 | if (!deprecated)
|
---|
286 | cs_log("Normal mode failed, reverting to Deprecated Mode");
|
---|
287 | }
|
---|
288 | if (ret)
|
---|
289 | break;
|
---|
290 | }
|
---|
291 | #ifdef AZBOX
|
---|
292 | }
|
---|
293 | #endif
|
---|
294 | return(ret);
|
---|
295 | }
|
---|
296 |
|
---|
297 | int reader_device_init(struct s_reader * reader)
|
---|
298 | {
|
---|
299 | #ifdef HAVE_PCSC
|
---|
300 | if (reader->typ == R_PCSC) {
|
---|
301 | return (pcsc_reader_init(reader, reader->device));
|
---|
302 | }
|
---|
303 | #endif
|
---|
304 |
|
---|
305 | int rc = -1; //FIXME
|
---|
306 | int cs_ptyp_orig=client[cs_idx].cs_ptyp;
|
---|
307 | client[cs_idx].cs_ptyp=D_DEVICE;
|
---|
308 | #if defined(TUXBOX) && defined(PPC)
|
---|
309 | struct stat st;
|
---|
310 | if (!stat(DEV_MULTICAM, &st))
|
---|
311 | reader->typ = reader_device_type(reader);
|
---|
312 | #endif
|
---|
313 | if (ICC_Async_Device_Init(reader))
|
---|
314 | cs_log("Cannot open device: %s", reader->device);
|
---|
315 | else
|
---|
316 | rc = OK;
|
---|
317 | cs_debug("ct_init on %s: %d", reader->device, rc);
|
---|
318 | client[cs_idx].cs_ptyp=cs_ptyp_orig;
|
---|
319 | return((rc!=OK) ? 2 : 0);
|
---|
320 | }
|
---|
321 |
|
---|
322 | int reader_checkhealth(struct s_reader * reader)
|
---|
323 | {
|
---|
324 | if (reader_card_inserted(reader))
|
---|
325 | {
|
---|
326 | if (reader->card_status == NO_CARD)
|
---|
327 | {
|
---|
328 | cs_log("card detected");
|
---|
329 | reader->card_status = CARD_NEED_INIT;
|
---|
330 | if (!reader_reset(reader))
|
---|
331 | {
|
---|
332 | reader->card_status = CARD_FAILURE;
|
---|
333 | cs_log("card initializing error");
|
---|
334 | }
|
---|
335 | else
|
---|
336 | {
|
---|
337 | client[cs_idx].au = client[cs_idx].ridx;
|
---|
338 | reader_card_info(reader);
|
---|
339 | reader->card_status = CARD_INSERTED;
|
---|
340 | }
|
---|
341 |
|
---|
342 | int i;
|
---|
343 | for( i=1; i<CS_MAXPID; i++ ) {
|
---|
344 | if( client[i].pid && client[i].typ=='c' && client[i].usr[0] && ph[client[i].ctyp].type & MOD_CONN_NET) {
|
---|
345 | //kill(client[i].pid, SIGQUIT);
|
---|
346 | }
|
---|
347 | }
|
---|
348 | }
|
---|
349 | }
|
---|
350 | else
|
---|
351 | {
|
---|
352 | if (reader->card_status == CARD_INSERTED)
|
---|
353 | {
|
---|
354 | reader_nullcard(reader);
|
---|
355 | client[cs_idx].lastemm = 0;
|
---|
356 | client[cs_idx].lastecm = 0;
|
---|
357 | client[cs_idx].au = -1;
|
---|
358 | cs_log("card ejected slot = %i", reader->slot);
|
---|
359 | }
|
---|
360 | reader->card_status = NO_CARD;
|
---|
361 | }
|
---|
362 | return reader->card_status == CARD_INSERTED;
|
---|
363 | }
|
---|
364 |
|
---|
365 | void reader_post_process(struct s_reader * reader)
|
---|
366 | {
|
---|
367 | // some systems eg. nagra2/3 needs post process after receiving cw from card
|
---|
368 | // To save ECM/CW time we added this function after writing ecm answer
|
---|
369 |
|
---|
370 | if (cardsystem[reader->card_system-1].post_process) {
|
---|
371 | cardsystem[reader->card_system-1].post_process(reader);
|
---|
372 | }
|
---|
373 | }
|
---|
374 |
|
---|
375 | int reader_ecm(struct s_reader * reader, ECM_REQUEST *er)
|
---|
376 | {
|
---|
377 | int rc=-1;
|
---|
378 | if( (rc=reader_checkhealth(reader)) )
|
---|
379 | {
|
---|
380 | if((reader->caid[0] >> 8) == ((er->caid >> 8) & 0xFF))
|
---|
381 | {
|
---|
382 | client[cs_idx].last_srvid=er->srvid;
|
---|
383 | client[cs_idx].last_caid=er->caid;
|
---|
384 | client[cs_idx].last=time((time_t)0);
|
---|
385 |
|
---|
386 | if (cardsystem[reader->card_system-1].do_ecm)
|
---|
387 | rc=cardsystem[reader->card_system-1].do_ecm(reader, er);
|
---|
388 | else
|
---|
389 | rc=0;
|
---|
390 |
|
---|
391 | }
|
---|
392 | else
|
---|
393 | rc=0;
|
---|
394 | }
|
---|
395 | return(rc);
|
---|
396 | }
|
---|
397 |
|
---|
398 | int reader_get_emm_type(EMM_PACKET *ep, struct s_reader * rdr) //rdr differs from calling reader!
|
---|
399 | {
|
---|
400 | cs_debug_mask(D_EMM,"Entered reader_get_emm_type cardsystem %i",rdr->card_system);
|
---|
401 | int rc;
|
---|
402 |
|
---|
403 | if (rdr->card_system<1)
|
---|
404 | return 0;
|
---|
405 |
|
---|
406 | if (cardsystem[rdr->card_system-1].get_emm_type)
|
---|
407 | rc=cardsystem[rdr->card_system-1].get_emm_type(ep, rdr);
|
---|
408 | else
|
---|
409 | rc=0;
|
---|
410 |
|
---|
411 | return rc;
|
---|
412 | }
|
---|
413 |
|
---|
414 | int get_cardsystem(ushort caid) {
|
---|
415 | int i,j;
|
---|
416 | for (i=0; i<CS_MAX_MOD; i++) {
|
---|
417 | if (cardsystem[i].caids) {
|
---|
418 | for (j=0;j<2;j++) {
|
---|
419 | if ((cardsystem[i].caids[j]==caid >> 8)) {
|
---|
420 | return i+1;
|
---|
421 | }
|
---|
422 | }
|
---|
423 | }
|
---|
424 | }
|
---|
425 | return 0;
|
---|
426 | }
|
---|
427 |
|
---|
428 | void get_emm_filter(struct s_reader * rdr, uchar *filter) {
|
---|
429 | filter[0]=0xFF;
|
---|
430 | filter[1]=0;
|
---|
431 |
|
---|
432 | if (cardsystem[rdr->card_system-1].get_emm_filter) {
|
---|
433 | cardsystem[rdr->card_system-1].get_emm_filter(rdr, filter);
|
---|
434 | }
|
---|
435 |
|
---|
436 | return;
|
---|
437 | }
|
---|
438 |
|
---|
439 | int reader_emm(struct s_reader * reader, EMM_PACKET *ep)
|
---|
440 | {
|
---|
441 | int rc=-1;
|
---|
442 |
|
---|
443 | rc=reader_checkhealth(reader);
|
---|
444 | if (rc)
|
---|
445 | {
|
---|
446 | if (reader->b_nano[ep->emm[0]] & 0x01) //should this nano be blcoked?
|
---|
447 | return 3;
|
---|
448 |
|
---|
449 | if (cardsystem[reader->card_system-1].do_emm)
|
---|
450 | rc=cardsystem[reader->card_system-1].do_emm(reader, ep);
|
---|
451 | else
|
---|
452 | rc=0;
|
---|
453 | }
|
---|
454 | return(rc);
|
---|
455 | }
|
---|
456 |
|
---|
457 | int check_emm_cardsystem(struct s_reader * rdr, EMM_PACKET *ep)
|
---|
458 | {
|
---|
459 | return (rdr->fd && (rdr->caid[0] == b2i(2,ep->caid) || rdr->typ == R_CCCAM));
|
---|
460 | }
|
---|
461 |
|
---|
462 | void reader_device_close(struct s_reader * reader)
|
---|
463 | {
|
---|
464 | #ifdef HAVE_PCSC
|
---|
465 | if (reader->typ == R_PCSC)
|
---|
466 | pcsc_close(reader);
|
---|
467 | else
|
---|
468 | #endif
|
---|
469 | ICC_Async_Close(reader);
|
---|
470 | }
|
---|