1 | #include "globals.h"
|
---|
2 | #include "reader-common.h"
|
---|
3 | #include "defines.h"
|
---|
4 | #include "atr.h"
|
---|
5 |
|
---|
6 | uchar cta_res[CTA_RES_LEN];
|
---|
7 | ushort cta_lr;
|
---|
8 | static int cs_ptyp_orig; //reinit=1,
|
---|
9 | extern int ICC_Async_Device_Init ();
|
---|
10 | extern int ICC_Async_CardWrite (unsigned char *cmd, unsigned short lc, unsigned char *rsp, unsigned short *lr);
|
---|
11 | extern int ICC_Async_Activate (ATR * atr, unsigned short deprecated);
|
---|
12 | extern int ICC_Async_GetStatus (int * card);
|
---|
13 | #define SC_IRDETO 1
|
---|
14 | #define SC_CRYPTOWORKS 2
|
---|
15 | #define SC_VIACCESS 3
|
---|
16 | #define SC_CONAX 4
|
---|
17 | #define SC_SECA 5
|
---|
18 | #define SC_VIDEOGUARD2 6
|
---|
19 | #define SC_DRE 7
|
---|
20 | #define SC_NAGRA 8
|
---|
21 |
|
---|
22 | #ifdef TUXBOX
|
---|
23 | static int reader_device_type(char *device)
|
---|
24 | {
|
---|
25 | int rc=reader[ridx].typ;
|
---|
26 | struct stat sb;
|
---|
27 | if (reader[ridx].typ == R_MOUSE)
|
---|
28 | {
|
---|
29 | if (!stat(device, &sb))
|
---|
30 | {
|
---|
31 | if (S_ISCHR(sb.st_mode))
|
---|
32 | {
|
---|
33 | int dev_major, dev_minor;
|
---|
34 | dev_major=major(sb.st_rdev);
|
---|
35 | dev_minor=minor(sb.st_rdev);
|
---|
36 | if ((cs_hw==CS_HW_DBOX2) && ((dev_major==4) || (dev_major==5)))
|
---|
37 | switch(dev_minor & 0x3F)
|
---|
38 | {
|
---|
39 | case 0: rc=R_DB2COM1; break;
|
---|
40 | case 1: rc=R_DB2COM2; break;
|
---|
41 | }
|
---|
42 | cs_debug("device is major: %d, minor: %d, typ=%d", dev_major, dev_minor, rc);
|
---|
43 | }
|
---|
44 | }
|
---|
45 | }
|
---|
46 | reader[ridx].typ = rc;
|
---|
47 | return(rc);
|
---|
48 | }
|
---|
49 | #endif
|
---|
50 |
|
---|
51 | static void reader_nullcard(void)
|
---|
52 | {
|
---|
53 | reader[ridx].card_system=0;
|
---|
54 | memset(reader[ridx].hexserial, 0 , sizeof(reader[ridx].hexserial));
|
---|
55 | memset(reader[ridx].prid , 0xFF, sizeof(reader[ridx].prid ));
|
---|
56 | memset(reader[ridx].caid , 0 , sizeof(reader[ridx].caid ));
|
---|
57 | memset(reader[ridx].availkeys, 0 , sizeof(reader[ridx].availkeys));
|
---|
58 | reader[ridx].acs=0;
|
---|
59 | reader[ridx].nprov=0;
|
---|
60 | }
|
---|
61 |
|
---|
62 | int reader_cmd2icc(uchar *buf, int l)
|
---|
63 | {
|
---|
64 | int rc;
|
---|
65 | #ifdef HAVE_PCSC
|
---|
66 | if (reader[ridx].typ == R_PCSC) {
|
---|
67 | return (pcsc_reader_do_api(&reader[ridx], buf, cta_res, &cta_lr,l));
|
---|
68 | }
|
---|
69 |
|
---|
70 | #endif
|
---|
71 |
|
---|
72 | cs_ddump(buf, l, "write to cardreader %s:",reader[ridx].label);
|
---|
73 | cta_lr=sizeof(cta_res)-1;
|
---|
74 | cs_ptyp_orig=cs_ptyp;
|
---|
75 | cs_ptyp=D_DEVICE;
|
---|
76 | rc=ICC_Async_CardWrite(buf, l, cta_res, &cta_lr);
|
---|
77 | cs_ptyp=cs_ptyp_orig;
|
---|
78 | cs_ddump(cta_res, cta_lr, "answer from cardreader %s:", reader[ridx].label);
|
---|
79 | return rc;
|
---|
80 | }
|
---|
81 |
|
---|
82 | #define CMD_LEN 5
|
---|
83 |
|
---|
84 | int card_write(uchar *cmd, uchar *data)
|
---|
85 | {
|
---|
86 | if (data) {
|
---|
87 | uchar buf[256]; //only allocate buffer when its needed
|
---|
88 | memcpy(buf, cmd, CMD_LEN);
|
---|
89 | if (cmd[4]) memcpy(buf+CMD_LEN, data, cmd[4]);
|
---|
90 | return(reader_cmd2icc(buf, CMD_LEN+cmd[4]));
|
---|
91 | }
|
---|
92 | else
|
---|
93 | return(reader_cmd2icc(cmd, CMD_LEN));
|
---|
94 | }
|
---|
95 |
|
---|
96 | static int reader_card_inserted(void)
|
---|
97 | {
|
---|
98 | #ifdef HAVE_PCSC
|
---|
99 | if (reader[ridx].typ == R_PCSC) {
|
---|
100 | return(pcsc_check_card_inserted(&reader[ridx]));
|
---|
101 | }
|
---|
102 | #endif
|
---|
103 | int card;
|
---|
104 | cs_ptyp_orig=cs_ptyp;
|
---|
105 | cs_ptyp=D_IFD;
|
---|
106 | if (ICC_Async_GetStatus (&card)) {
|
---|
107 | cs_log("Error getting status of terminal.");
|
---|
108 | return 0; //corresponds with no card inside!!
|
---|
109 | }
|
---|
110 | cs_ptyp=cs_ptyp_orig;
|
---|
111 | return (card);
|
---|
112 | }
|
---|
113 |
|
---|
114 | static int reader_activate_card(ATR * atr, unsigned short deprecated)
|
---|
115 | {
|
---|
116 | int i;
|
---|
117 | #ifdef HAVE_PCSC
|
---|
118 | unsigned char atrarr[64];
|
---|
119 | ushort atr_size = 0;
|
---|
120 | if (reader[ridx].typ == R_PCSC) {
|
---|
121 | if (pcsc_activate_card(&reader[ridx], atrarr, &atr_size))
|
---|
122 | return (ATR_InitFromArray (atr, atrarr, atr_size) == ATR_OK);
|
---|
123 | else
|
---|
124 | return 0;
|
---|
125 | }
|
---|
126 | #endif
|
---|
127 | if (!reader_card_inserted())
|
---|
128 | return 0;
|
---|
129 |
|
---|
130 | /* Activate card */
|
---|
131 | cs_ptyp_orig=cs_ptyp;
|
---|
132 | cs_ptyp=D_DEVICE;
|
---|
133 | for (i=0; i<5; i++) {
|
---|
134 | if (!ICC_Async_Activate(atr, deprecated)) {
|
---|
135 | i = 100;
|
---|
136 | break;
|
---|
137 | }
|
---|
138 | cs_log("Error activating card.");
|
---|
139 | cs_sleepms(500);
|
---|
140 | }
|
---|
141 | cs_ptyp=cs_ptyp_orig;
|
---|
142 | if (i<100) return(0);
|
---|
143 |
|
---|
144 | #ifdef CS_RDR_INIT_HIST
|
---|
145 | reader[ridx].init_history_pos=0;
|
---|
146 | memset(reader[ridx].init_history, 0, sizeof(reader[ridx].init_history));
|
---|
147 | #endif
|
---|
148 | // cs_ri_log("ATR: %s", cs_hexdump(1, atr, atr_size));//FIXME
|
---|
149 | cs_sleepms(1000);
|
---|
150 | return(1);
|
---|
151 | }
|
---|
152 |
|
---|
153 | void do_emm_from_file(void)
|
---|
154 | {
|
---|
155 | //now here check whether we have EMM's on file to load and write to card:
|
---|
156 | if (reader[ridx].emmfile != NULL) {//readnano has something filled in
|
---|
157 |
|
---|
158 | //handling emmfile
|
---|
159 | char token[256];
|
---|
160 | FILE *fp;
|
---|
161 | size_t result;
|
---|
162 | if ((reader[ridx].emmfile[0] == '/'))
|
---|
163 | sprintf (token, "%s", reader[ridx].emmfile); //pathname included
|
---|
164 | else
|
---|
165 | sprintf (token, "%s%s", cs_confdir, reader[ridx].emmfile); //only file specified, look in confdir for this file
|
---|
166 |
|
---|
167 | if (!(fp = fopen (token, "rb")))
|
---|
168 | cs_log ("ERROR: Cannot open EMM file '%s' (errno=%d)\n", token, errno);
|
---|
169 | else {
|
---|
170 | EMM_PACKET *eptmp;
|
---|
171 | eptmp = malloc (sizeof(EMM_PACKET));
|
---|
172 | result = fread (eptmp, sizeof(EMM_PACKET), 1, fp);
|
---|
173 | fclose (fp);
|
---|
174 |
|
---|
175 | uchar old_b_nano = reader[ridx].b_nano[eptmp->emm[0]]; //save old b_nano value
|
---|
176 | reader[ridx].b_nano[eptmp->emm[0]] &= 0xfc; //clear lsb and lsb+1, so no blocking, and no saving for this nano
|
---|
177 |
|
---|
178 | //if (!reader_do_emm (eptmp))
|
---|
179 | if (!reader_emm (eptmp))
|
---|
180 | cs_log ("ERROR: EMM read from file %s NOT processed correctly!", token);
|
---|
181 |
|
---|
182 | reader[ridx].b_nano[eptmp->emm[0]] = old_b_nano; //restore old block/save settings
|
---|
183 | free (reader[ridx].emmfile);
|
---|
184 | reader[ridx].emmfile = NULL; //clear emmfile, so no reading anymore
|
---|
185 |
|
---|
186 | free(eptmp);
|
---|
187 | eptmp = NULL;
|
---|
188 | }
|
---|
189 | }
|
---|
190 | }
|
---|
191 |
|
---|
192 | void reader_card_info()
|
---|
193 | {
|
---|
194 | // int rc=-1;
|
---|
195 | if (reader_checkhealth())
|
---|
196 | //if (rc=reader_checkhealth())
|
---|
197 | {
|
---|
198 | client[cs_idx].last=time((time_t)0);
|
---|
199 | cs_ri_brk(0);
|
---|
200 | do_emm_from_file();
|
---|
201 | switch(reader[ridx].card_system)
|
---|
202 | {
|
---|
203 | case SC_NAGRA:
|
---|
204 | nagra2_card_info(); break;
|
---|
205 | case SC_IRDETO:
|
---|
206 | irdeto_card_info(); break;
|
---|
207 | case SC_CRYPTOWORKS:
|
---|
208 | cryptoworks_card_info(); break;
|
---|
209 | case SC_VIACCESS:
|
---|
210 | viaccess_card_info(); break;
|
---|
211 | case SC_CONAX:
|
---|
212 | conax_card_info(); break;
|
---|
213 | case SC_VIDEOGUARD2:
|
---|
214 | videoguard_card_info(); break;
|
---|
215 | case SC_SECA:
|
---|
216 | seca_card_info(); break;
|
---|
217 | case SC_DRE:
|
---|
218 | dre_card_info(); break;
|
---|
219 | }
|
---|
220 | }
|
---|
221 | }
|
---|
222 |
|
---|
223 | static int reader_get_cardsystem(ATR atr)
|
---|
224 | {
|
---|
225 | if (nagra2_card_init(atr)) reader[ridx].card_system=SC_NAGRA; else
|
---|
226 | if (irdeto_card_init(atr)) reader[ridx].card_system=SC_IRDETO; else
|
---|
227 | if (conax_card_init(atr)) reader[ridx].card_system=SC_CONAX; else
|
---|
228 | if (cryptoworks_card_init(atr)) reader[ridx].card_system=SC_CRYPTOWORKS; else
|
---|
229 | if (seca_card_init(atr)) reader[ridx].card_system=SC_SECA; else
|
---|
230 | if (viaccess_card_init(atr)) reader[ridx].card_system=SC_VIACCESS; else
|
---|
231 | if (videoguard_card_init(atr)) reader[ridx].card_system=SC_VIDEOGUARD2; else
|
---|
232 | if (dre_card_init(atr)) reader[ridx].card_system=SC_DRE; else
|
---|
233 | cs_ri_log("card system not supported");
|
---|
234 | cs_ri_brk(1);
|
---|
235 |
|
---|
236 | return(reader[ridx].card_system);
|
---|
237 | }
|
---|
238 |
|
---|
239 | static int reader_reset(void)
|
---|
240 | {
|
---|
241 | reader_nullcard();
|
---|
242 | ATR atr;
|
---|
243 | unsigned short int deprecated, ret = ERROR;
|
---|
244 | for (deprecated = reader[ridx].deprecated; deprecated < 2; deprecated++) {
|
---|
245 | if (!reader_activate_card(&atr, deprecated)) return(0);
|
---|
246 | ret =reader_get_cardsystem(atr);
|
---|
247 | if (ret)
|
---|
248 | break;
|
---|
249 | if (!deprecated)
|
---|
250 | cs_log("Normal mode failed, reverting to Deprecated Mode");
|
---|
251 | }
|
---|
252 | return(ret);
|
---|
253 | }
|
---|
254 |
|
---|
255 | int reader_device_init(char *device)
|
---|
256 | {
|
---|
257 | #ifdef HAVE_PCSC
|
---|
258 | if (reader[ridx].typ == R_PCSC) {
|
---|
259 | return (pcsc_reader_init(&reader[ridx], device));
|
---|
260 | }
|
---|
261 | #endif
|
---|
262 |
|
---|
263 | int rc = -1; //FIXME
|
---|
264 | cs_ptyp_orig=cs_ptyp;
|
---|
265 | cs_ptyp=D_DEVICE;
|
---|
266 | #ifdef TUXBOX
|
---|
267 | reader[ridx].typ = reader_device_type(device);
|
---|
268 | #endif
|
---|
269 | if (ICC_Async_Device_Init())
|
---|
270 | cs_log("Cannot open device: %s", device);
|
---|
271 | else
|
---|
272 | rc = OK;
|
---|
273 | cs_debug("ct_init on %s: %d", device, rc);
|
---|
274 | cs_ptyp=cs_ptyp_orig;
|
---|
275 | return((rc!=OK) ? 2 : 0);
|
---|
276 | }
|
---|
277 |
|
---|
278 | int reader_checkhealth(void)
|
---|
279 | {
|
---|
280 | if (reader_card_inserted())
|
---|
281 | {
|
---|
282 | if (reader[ridx].card_status == NO_CARD)
|
---|
283 | {
|
---|
284 | cs_log("card detected");
|
---|
285 | reader[ridx].card_status = CARD_NEED_INIT;
|
---|
286 | reader[ridx].card_status = (reader_reset() ? CARD_INSERTED : CARD_FAILURE);
|
---|
287 | if (reader[ridx].card_status == CARD_FAILURE)
|
---|
288 | {
|
---|
289 | cs_log("card initializing error");
|
---|
290 | }
|
---|
291 | else
|
---|
292 | {
|
---|
293 | client[cs_idx].au=ridx;
|
---|
294 | reader_card_info();
|
---|
295 | }
|
---|
296 |
|
---|
297 | int i;
|
---|
298 | for( i=1; i<CS_MAXPID; i++ ) {
|
---|
299 | if( client[i].pid && client[i].typ=='c' && client[i].usr[0] ) {
|
---|
300 | kill(client[i].pid, SIGQUIT);
|
---|
301 | }
|
---|
302 | }
|
---|
303 | }
|
---|
304 | }
|
---|
305 | else
|
---|
306 | {
|
---|
307 | if (reader[ridx].card_status == CARD_INSERTED)
|
---|
308 | {
|
---|
309 | reader_nullcard();
|
---|
310 | client[cs_idx].lastemm=0;
|
---|
311 | client[cs_idx].lastecm=0;
|
---|
312 | client[cs_idx].au=-1;
|
---|
313 | extern int io_serial_need_dummy_char;
|
---|
314 | io_serial_need_dummy_char=0;
|
---|
315 | cs_log("card ejected");
|
---|
316 | }
|
---|
317 | reader[ridx].card_status=NO_CARD;
|
---|
318 | }
|
---|
319 | return reader[ridx].card_status==CARD_INSERTED;
|
---|
320 | }
|
---|
321 |
|
---|
322 | void reader_post_process(void)
|
---|
323 | {
|
---|
324 | // some systems eg. nagra2/3 needs post process after receiving cw from card
|
---|
325 | // To save ECM/CW time we added this function after writing ecm answer
|
---|
326 | switch(reader[ridx].card_system)
|
---|
327 | {
|
---|
328 | case SC_NAGRA:
|
---|
329 | nagra2_post_process(); break;
|
---|
330 | default: break;
|
---|
331 | }
|
---|
332 | }
|
---|
333 |
|
---|
334 | int reader_ecm(ECM_REQUEST *er)
|
---|
335 | {
|
---|
336 | int rc=-1, r, m=0;
|
---|
337 | static int loadbalanced_idx = 1;
|
---|
338 | if( (rc=reader_checkhealth()) )
|
---|
339 | {
|
---|
340 | //cs_log("OUT: ridx = %d (0x%x), client = 0x%x, lb_idx = %d", ridx, &reader[ridx], &client[cs_idx], loadbalanced_idx);
|
---|
341 | if(((reader[ridx].caid[0]>>8)==((er->caid>>8)&0xFF)) && (((reader[ridx].loadbalanced) && (loadbalanced_idx == ridx)) || !reader[ridx].loadbalanced))
|
---|
342 | {
|
---|
343 | //cs_log("IN: ridx = %d (0x%x), client = 0x%x, lb_idx = %d", ridx, &reader[ridx], &client[cs_idx], loadbalanced_idx);
|
---|
344 | client[cs_idx].last_srvid=er->srvid;
|
---|
345 | client[cs_idx].last_caid=er->caid;
|
---|
346 | client[cs_idx].last=time((time_t)0);
|
---|
347 | switch(reader[ridx].card_system)
|
---|
348 | {
|
---|
349 | case SC_NAGRA:
|
---|
350 | rc=(nagra2_do_ecm(er)) ? 1 : 0; break;
|
---|
351 | case SC_IRDETO:
|
---|
352 | rc=(irdeto_do_ecm(er)) ? 1 : 0; break;
|
---|
353 | case SC_CRYPTOWORKS:
|
---|
354 | rc=(cryptoworks_do_ecm(er)) ? 1 : 0; break;
|
---|
355 | case SC_VIACCESS:
|
---|
356 | rc=(viaccess_do_ecm(er)) ? 1 : 0; break;
|
---|
357 | case SC_CONAX:
|
---|
358 | rc=(conax_do_ecm(er)) ? 1 : 0; break;
|
---|
359 | case SC_SECA:
|
---|
360 | rc=(seca_do_ecm(er)) ? 1 : 0; break;
|
---|
361 | case SC_VIDEOGUARD2:
|
---|
362 | rc=(videoguard_do_ecm(er)) ? 1 : 0; break;
|
---|
363 | case SC_DRE:
|
---|
364 | rc=(dre_do_ecm(er)) ? 1: 0; break;
|
---|
365 | default: rc=0;
|
---|
366 | }
|
---|
367 | }
|
---|
368 | else
|
---|
369 | rc=0;
|
---|
370 | }
|
---|
371 | for (r=0;r<CS_MAXREADER;r++)
|
---|
372 | if (reader[r].caid[0]) m++;
|
---|
373 | if (loadbalanced_idx++ >= m) loadbalanced_idx = 1;
|
---|
374 | return(rc);
|
---|
375 | }
|
---|
376 |
|
---|
377 | int reader_emm(EMM_PACKET *ep)
|
---|
378 | {
|
---|
379 | int rc=-1;
|
---|
380 |
|
---|
381 | rc=reader_checkhealth();
|
---|
382 | if (rc)
|
---|
383 | {
|
---|
384 | client[cs_idx].last=time((time_t)0);
|
---|
385 | if (reader[ridx].b_nano[ep->emm[0]] & 0x02) //should this nano be saved?
|
---|
386 | {
|
---|
387 | char token[256];
|
---|
388 | FILE *fp;
|
---|
389 |
|
---|
390 | time_t rawtime;
|
---|
391 | time (&rawtime);
|
---|
392 | struct tm *timeinfo;
|
---|
393 | timeinfo = localtime (&rawtime); /* to access LOCAL date/time info */
|
---|
394 | char buf[80];
|
---|
395 | strftime (buf, 80, "%Y%m%d_%H_%M_%S", timeinfo);
|
---|
396 |
|
---|
397 | sprintf (token, "%swrite_%s_%s.%s", cs_confdir, (ep->emm[0] == 0x82) ? "UNIQ" : "SHARED", buf, "txt");
|
---|
398 | if (!(fp = fopen (token, "w")))
|
---|
399 | {
|
---|
400 | cs_log ("ERROR: Cannot open EMM.txt file '%s' (errno=%d)\n", token, errno);
|
---|
401 | }
|
---|
402 | else
|
---|
403 | {
|
---|
404 | cs_log ("Succesfully written text EMM to %s.", token);
|
---|
405 | int emm_length = ((ep->emm[1] & 0x0f) << 8) | ep->emm[2];
|
---|
406 | fprintf (fp, "%s", cs_hexdump (0, ep->emm, emm_length + 3));
|
---|
407 | fclose (fp);
|
---|
408 | }
|
---|
409 |
|
---|
410 | //sprintf (token, "%s%s.%s", cs_confdir, buf,"emm");
|
---|
411 | sprintf (token, "%swrite_%s_%s.%s", cs_confdir, (ep->emm[0] == 0x82) ? "UNIQ" : "SHARED", buf, "emm");
|
---|
412 | if (!(fp = fopen (token, "wb")))
|
---|
413 | {
|
---|
414 | cs_log ("ERROR: Cannot open EMM.emm file '%s' (errno=%d)\n", token, errno);
|
---|
415 | }
|
---|
416 | else
|
---|
417 | {
|
---|
418 | if (fwrite(ep, sizeof (*ep), 1, fp) == 1)
|
---|
419 | {
|
---|
420 | cs_log ("Succesfully written binary EMM to %s.", token);
|
---|
421 | }
|
---|
422 | else
|
---|
423 | {
|
---|
424 | cs_log ("ERROR: Cannot write binary EMM to %s (errno=%d)\n", token, errno);
|
---|
425 | }
|
---|
426 | fclose (fp);
|
---|
427 | }
|
---|
428 | }
|
---|
429 |
|
---|
430 | if (reader[ridx].b_nano[ep->emm[0]] & 0x01) //should this nano be blcoked?
|
---|
431 | return 3;
|
---|
432 |
|
---|
433 | switch(reader[ridx].card_system)
|
---|
434 | {
|
---|
435 | case SC_NAGRA:
|
---|
436 | rc=nagra2_do_emm(ep); break;
|
---|
437 | case SC_IRDETO:
|
---|
438 | rc=irdeto_do_emm(ep); break;
|
---|
439 | case SC_CRYPTOWORKS:
|
---|
440 | rc=cryptoworks_do_emm(ep); break;
|
---|
441 | case SC_VIACCESS:
|
---|
442 | rc=viaccess_do_emm(ep); break;
|
---|
443 | case SC_CONAX:
|
---|
444 | rc=conax_do_emm(ep); break;
|
---|
445 | case SC_SECA:
|
---|
446 | rc=seca_do_emm(ep); break;
|
---|
447 | case SC_VIDEOGUARD2:
|
---|
448 | rc=videoguard_do_emm(ep); break;
|
---|
449 | case SC_DRE:
|
---|
450 | rc=dre_do_emm(ep); break;
|
---|
451 | default: rc=0;
|
---|
452 | }
|
---|
453 | }
|
---|
454 | return(rc);
|
---|
455 | }
|
---|