[3433] | 1 | #include "globals.h"
|
---|
[7101] | 2 |
|
---|
| 3 | #ifdef WITH_CARDREADER
|
---|
| 4 |
|
---|
[7534] | 5 | #include "module-led.h"
|
---|
[7688] | 6 | #include "oscam-chk.h"
|
---|
| 7 | #include "oscam-client.h"
|
---|
[8242] | 8 | #include "oscam-ecm.h"
|
---|
[8241] | 9 | #include "oscam-emm.h"
|
---|
[7688] | 10 | #include "oscam-net.h"
|
---|
[7644] | 11 | #include "oscam-time.h"
|
---|
[8258] | 12 | #include "oscam-work.h"
|
---|
[8449] | 13 | #include "oscam-reader.h"
|
---|
[8] | 14 | #include "reader-common.h"
|
---|
[7101] | 15 | #include "csctapi/atr.h"
|
---|
[6899] | 16 | #include "csctapi/icc_async.h"
|
---|
[6399] | 17 |
|
---|
[7610] | 18 | extern struct s_cardsystem cardsystems[CS_MAX_MOD];
|
---|
[8280] | 19 | extern char *RDR_CD_TXT[];
|
---|
[7610] | 20 |
|
---|
[8264] | 21 | int32_t check_sct_len(const uchar *data, int32_t off)
|
---|
| 22 | {
|
---|
| 23 | int32_t len = SCT_LEN(data);
|
---|
| 24 | if (len + off > MAX_LEN) {
|
---|
| 25 | cs_debug_mask(D_TRACE | D_READER, "check_sct_len(): smartcard section too long %d > %d", len, MAX_LEN - off);
|
---|
| 26 | len = -1;
|
---|
| 27 | }
|
---|
| 28 | return len;
|
---|
| 29 | }
|
---|
| 30 |
|
---|
[7101] | 31 | static void reader_nullcard(struct s_reader * reader)
|
---|
[8] | 32 | {
|
---|
[7075] | 33 | memset(&reader->csystem , 0 , sizeof(reader->csystem));
|
---|
[1926] | 34 | memset(reader->hexserial, 0 , sizeof(reader->hexserial));
|
---|
| 35 | memset(reader->prid , 0xFF, sizeof(reader->prid ));
|
---|
[4582] | 36 | reader->caid=0;
|
---|
[1926] | 37 | memset(reader->availkeys, 0 , sizeof(reader->availkeys));
|
---|
| 38 | reader->acs=0;
|
---|
| 39 | reader->nprov=0;
|
---|
[8377] | 40 | reader->reassemble_emm_len=0;
|
---|
| 41 | memset(reader->reassemble_emm, 0, sizeof(reader->reassemble_emm));
|
---|
[8449] | 42 | cs_clear_entitlement(reader);
|
---|
[8] | 43 | }
|
---|
| 44 |
|
---|
[4994] | 45 | int32_t reader_cmd2icc(struct s_reader * reader, const uchar *buf, const int32_t l, uchar * cta_res, uint16_t * p_cta_lr)
|
---|
[8] | 46 | {
|
---|
[4994] | 47 | int32_t rc;
|
---|
[7156] | 48 | *p_cta_lr=CTA_RES_LEN-1; //FIXME not sure whether this one is necessary
|
---|
[7144] | 49 | rdr_ddump_mask(reader, D_READER, buf, l, "write to cardreader");
|
---|
[4994] | 50 | rc=ICC_Async_CardWrite(reader, (uchar *)buf, (uint16_t)l, cta_res, p_cta_lr);
|
---|
[1381] | 51 | return rc;
|
---|
[8] | 52 | }
|
---|
| 53 |
|
---|
[473] | 54 | #define CMD_LEN 5
|
---|
| 55 |
|
---|
[4994] | 56 | int32_t card_write(struct s_reader * reader, const uchar *cmd, const uchar *data, uchar *response, uint16_t * response_length)
|
---|
[473] | 57 | {
|
---|
[2905] | 58 | uchar buf[260];
|
---|
[7156] | 59 | // always copy to be able to be able to use const buffer without changing all code
|
---|
| 60 | memcpy(buf, cmd, CMD_LEN);
|
---|
[2905] | 61 |
|
---|
[473] | 62 | if (data) {
|
---|
| 63 | if (cmd[4]) memcpy(buf+CMD_LEN, data, cmd[4]);
|
---|
[1951] | 64 | return(reader_cmd2icc(reader, buf, CMD_LEN+cmd[4], response, response_length));
|
---|
[473] | 65 | }
|
---|
| 66 | else
|
---|
[2905] | 67 | return(reader_cmd2icc(reader, buf, CMD_LEN, response, response_length));
|
---|
[473] | 68 | }
|
---|
| 69 |
|
---|
[7683] | 70 | static inline int reader_use_gpio(struct s_reader * reader) {
|
---|
| 71 | return reader->use_gpio && reader->detect > 4;
|
---|
| 72 | }
|
---|
| 73 |
|
---|
[4994] | 74 | static int32_t reader_card_inserted(struct s_reader * reader)
|
---|
[8] | 75 | {
|
---|
[7683] | 76 | if (!reader_use_gpio(reader) && (reader->detect & 0x7f) > 3)
|
---|
[2212] | 77 | return 1;
|
---|
[6855] | 78 |
|
---|
[4994] | 79 | int32_t card;
|
---|
[7801] | 80 | if (ICC_Async_GetStatus (reader, &card)) {
|
---|
[7773] | 81 | rdr_log(reader, "Error getting card status.");
|
---|
[1389] | 82 | return 0; //corresponds with no card inside!!
|
---|
| 83 | }
|
---|
| 84 | return (card);
|
---|
| 85 | }
|
---|
[1928] | 86 |
|
---|
[4994] | 87 | static int32_t reader_activate_card(struct s_reader * reader, ATR * atr, uint16_t deprecated)
|
---|
[1389] | 88 | {
|
---|
[5667] | 89 | int32_t i,ret;
|
---|
| 90 |
|
---|
| 91 | if (reader->card_status != CARD_NEED_INIT)
|
---|
[1389] | 92 | return 0;
|
---|
[776] | 93 |
|
---|
[8] | 94 | /* Activate card */
|
---|
[4179] | 95 | for (i=0; i<3; i++) {
|
---|
| 96 | ret = ICC_Async_Activate(reader, atr, deprecated);
|
---|
| 97 | if (!ret)
|
---|
[1389] | 98 | break;
|
---|
[7124] | 99 | rdr_log(reader, "Error activating card.");
|
---|
[7534] | 100 | led_status_card_activation_error();
|
---|
| 101 | cs_sleepms(500);
|
---|
[1389] | 102 | }
|
---|
[4179] | 103 | if (ret) return(0);
|
---|
[8] | 104 |
|
---|
[7124] | 105 | // rdr_log("ATR: %s", cs_hexdump(1, atr, atr_size, tmp, sizeof(tmp)));//FIXME
|
---|
[1584] | 106 | cs_sleepms(1000);
|
---|
[8] | 107 | return(1);
|
---|
| 108 | }
|
---|
| 109 |
|
---|
[7688] | 110 | void cardreader_get_card_info(struct s_reader *reader)
|
---|
[8] | 111 | {
|
---|
[5667] | 112 | if ((reader->card_status == CARD_NEED_INIT) || (reader->card_status == CARD_INSERTED)) {
|
---|
[6223] | 113 | struct s_client *cl = reader->client;
|
---|
| 114 | if (cl)
|
---|
| 115 | cl->last=time((time_t*)0);
|
---|
[3168] | 116 |
|
---|
[5667] | 117 | if (reader->csystem.active && reader->csystem.card_info) {
|
---|
| 118 | reader->csystem.card_info(reader);
|
---|
| 119 | }
|
---|
[3168] | 120 | }
|
---|
[8] | 121 | }
|
---|
| 122 |
|
---|
[6902] | 123 | static int32_t reader_get_cardsystem(struct s_reader * reader, ATR *atr)
|
---|
[8] | 124 | {
|
---|
[4994] | 125 | int32_t i;
|
---|
[3168] | 126 | for (i=0; i<CS_MAX_MOD; i++) {
|
---|
[7610] | 127 | if (cardsystems[i].card_init) {
|
---|
| 128 | if (cardsystems[i].card_init(reader, atr)) {
|
---|
| 129 | rdr_log(reader, "found card system %s", cardsystems[i].desc);
|
---|
| 130 | reader->csystem=cardsystems[i];
|
---|
[4626] | 131 | reader->csystem.active=1;
|
---|
[7534] | 132 | led_status_found_cardsystem();
|
---|
[3168] | 133 | break;
|
---|
| 134 | }
|
---|
| 135 | }
|
---|
| 136 | }
|
---|
[452] | 137 |
|
---|
[7156] | 138 | if (reader->csystem.active==0)
|
---|
[4280] | 139 | {
|
---|
[7124] | 140 | rdr_log(reader, "card system not supported");
|
---|
[7534] | 141 | led_status_unsupported_card_system();
|
---|
[4280] | 142 | }
|
---|
[3168] | 143 |
|
---|
[4693] | 144 | return(reader->csystem.active);
|
---|
[8] | 145 | }
|
---|
| 146 |
|
---|
[7688] | 147 | void cardreader_do_reset(struct s_reader *reader)
|
---|
[8] | 148 | {
|
---|
[2927] | 149 | reader_nullcard(reader);
|
---|
| 150 | ATR atr;
|
---|
[7879] | 151 | int32_t ret = 0;
|
---|
| 152 |
|
---|
| 153 | ret = ICC_Async_Reset(reader, &atr, reader_activate_card, reader_get_cardsystem);
|
---|
| 154 |
|
---|
| 155 | if (ret == -1)
|
---|
| 156 | return;
|
---|
| 157 |
|
---|
| 158 | if (ret == 0) {
|
---|
| 159 | uint16_t deprecated;
|
---|
| 160 | for (deprecated = reader->deprecated; deprecated < 2; deprecated++) {
|
---|
| 161 | if (!reader_activate_card(reader, &atr, deprecated)) break;
|
---|
| 162 | ret = reader_get_cardsystem(reader, &atr);
|
---|
| 163 | if (ret)
|
---|
| 164 | break;
|
---|
| 165 | if (!deprecated)
|
---|
| 166 | rdr_log(reader, "Normal mode failed, reverting to Deprecated Mode");
|
---|
| 167 | }
|
---|
[1419] | 168 | }
|
---|
[5667] | 169 |
|
---|
[7156] | 170 | if (!ret)
|
---|
[5667] | 171 | {
|
---|
| 172 | reader->card_status = CARD_FAILURE;
|
---|
[7124] | 173 | rdr_log(reader, "card initializing error");
|
---|
[7834] | 174 | ICC_Async_DisplayMsg(reader, "AER");
|
---|
[7534] | 175 | led_status_card_activation_error();
|
---|
[5667] | 176 | }
|
---|
| 177 | else
|
---|
| 178 | {
|
---|
[7688] | 179 | cardreader_get_card_info(reader);
|
---|
[5667] | 180 | reader->card_status = CARD_INSERTED;
|
---|
| 181 | do_emm_from_file(reader);
|
---|
[7834] | 182 | ICC_Async_DisplayMsg(reader, "AOK");
|
---|
[7878] | 183 | ICC_Set_Transmit_Timeout(reader);
|
---|
[5667] | 184 | }
|
---|
| 185 |
|
---|
[7688] | 186 | return;
|
---|
[8] | 187 | }
|
---|
| 188 |
|
---|
[7688] | 189 | static int32_t cardreader_device_init(struct s_reader *reader)
|
---|
[8] | 190 | {
|
---|
[4994] | 191 | int32_t rc = -1; //FIXME
|
---|
[1926] | 192 | if (ICC_Async_Device_Init(reader))
|
---|
[7124] | 193 | rdr_log(reader, "Cannot open device: %s", reader->device);
|
---|
[1389] | 194 | else
|
---|
| 195 | rc = OK;
|
---|
[4170] | 196 | return((rc!=OK) ? 2 : 0); //exit code 2 means keep retrying, exit code 0 means all OK
|
---|
[8] | 197 | }
|
---|
| 198 |
|
---|
[7692] | 199 | int32_t cardreader_do_checkhealth(struct s_reader * reader)
|
---|
[8] | 200 | {
|
---|
[6223] | 201 | struct s_client *cl = reader->client;
|
---|
[5667] | 202 | if (reader_card_inserted(reader)) {
|
---|
| 203 | if (reader->card_status == NO_CARD || reader->card_status == UNKNOWN) {
|
---|
[7142] | 204 | rdr_log(reader, "card detected");
|
---|
[7534] | 205 | led_status_card_detected();
|
---|
[5667] | 206 | reader->card_status = CARD_NEED_INIT;
|
---|
[6223] | 207 | add_job(cl, ACTION_READER_RESET, NULL, 0);
|
---|
[5667] | 208 | }
|
---|
| 209 | } else {
|
---|
[8060] | 210 | rdr_debug_mask(reader, D_READER, "%s: !reader_card_inserted", __func__);
|
---|
[6399] | 211 | if (reader->card_status == CARD_INSERTED || reader->card_status == CARD_NEED_INIT) {
|
---|
[7124] | 212 | rdr_log(reader, "card ejected");
|
---|
[5667] | 213 | reader_nullcard(reader);
|
---|
[6223] | 214 | if (cl) {
|
---|
| 215 | cl->lastemm = 0;
|
---|
| 216 | cl->lastecm = 0;
|
---|
[5667] | 217 | }
|
---|
[7534] | 218 | led_status_card_ejected();
|
---|
[5667] | 219 | }
|
---|
| 220 | reader->card_status = NO_CARD;
|
---|
| 221 | }
|
---|
[8060] | 222 | rdr_debug_mask(reader, D_READER, "%s: reader->card_status = %d, ret = %d", __func__,
|
---|
[7695] | 223 | reader->card_status, reader->card_status == CARD_INSERTED);
|
---|
[5667] | 224 | return reader->card_status == CARD_INSERTED;
|
---|
[8] | 225 | }
|
---|
| 226 |
|
---|
[7688] | 227 | // Check for card inserted or card removed on pysical reader
|
---|
| 228 | void cardreader_checkhealth(struct s_client *cl, struct s_reader *rdr) {
|
---|
[8066] | 229 | if (!rdr || !rdr->enable || !rdr->active)
|
---|
[7688] | 230 | return;
|
---|
| 231 | add_job(cl, ACTION_READER_CHECK_HEALTH, NULL, 0);
|
---|
| 232 | }
|
---|
| 233 |
|
---|
| 234 | void cardreader_reset(struct s_client *cl) {
|
---|
| 235 | add_job(cl, ACTION_READER_RESET, NULL, 0);
|
---|
| 236 | }
|
---|
| 237 |
|
---|
| 238 | void cardreader_init_locks(void) {
|
---|
| 239 | ICC_Async_Init_Locks();
|
---|
| 240 | }
|
---|
| 241 |
|
---|
| 242 | bool cardreader_init(struct s_reader *reader) {
|
---|
| 243 | struct s_client *client = reader->client;
|
---|
| 244 | client->typ = 'r';
|
---|
| 245 | set_localhost_ip(&client->ip);
|
---|
| 246 | while (cardreader_device_init(reader) == 2) {
|
---|
| 247 | int8_t i = 0;
|
---|
| 248 | do {
|
---|
| 249 | cs_sleepms(2000);
|
---|
| 250 | if (!ll_contains(configured_readers, reader) || !check_client(client) || reader->enable != 1)
|
---|
| 251 | return false;
|
---|
| 252 | i++;
|
---|
| 253 | } while (i < 30);
|
---|
| 254 | }
|
---|
| 255 | if (reader->mhz > 2000) {
|
---|
| 256 | rdr_log(reader, "Reader initialized (device=%s, detect=%s%s, pll max=%.2f Mhz, wanted cardmhz=%.2f Mhz",
|
---|
| 257 | reader->device,
|
---|
| 258 | reader->detect & 0x80 ? "!" : "",
|
---|
| 259 | RDR_CD_TXT[reader->detect & 0x7f],
|
---|
| 260 | (float)reader->mhz /100,
|
---|
| 261 | (float)reader->cardmhz / 100);
|
---|
| 262 | } else {
|
---|
| 263 | rdr_log(reader, "Reader initialized (device=%s, detect=%s%s, mhz=%d, cardmhz=%d)",
|
---|
| 264 | reader->device,
|
---|
| 265 | reader->detect & 0x80 ? "!" : "",
|
---|
| 266 | RDR_CD_TXT[reader->detect & 0x7f],
|
---|
| 267 | reader->mhz,
|
---|
| 268 | reader->cardmhz);
|
---|
| 269 | }
|
---|
| 270 | return true;
|
---|
| 271 | }
|
---|
| 272 |
|
---|
| 273 | void cardreader_close(struct s_reader *reader) {
|
---|
| 274 | ICC_Async_Close(reader);
|
---|
| 275 | }
|
---|
| 276 |
|
---|
[1926] | 277 | void reader_post_process(struct s_reader * reader)
|
---|
[800] | 278 | {
|
---|
| 279 | // some systems eg. nagra2/3 needs post process after receiving cw from card
|
---|
| 280 | // To save ECM/CW time we added this function after writing ecm answer
|
---|
[4626] | 281 | if (reader->csystem.active && reader->csystem.post_process) {
|
---|
| 282 | reader->csystem.post_process(reader);
|
---|
[3168] | 283 | }
|
---|
[800] | 284 | }
|
---|
| 285 |
|
---|
[7688] | 286 | int32_t cardreader_do_ecm(struct s_reader *reader, ECM_REQUEST *er, struct s_ecm_answer *ea)
|
---|
[8] | 287 | {
|
---|
[4994] | 288 | int32_t rc=-1;
|
---|
[7688] | 289 | if( (rc=cardreader_do_checkhealth(reader)) ) {
|
---|
[8060] | 290 | rdr_debug_mask(reader, D_READER, "%s: cardreader_do_checkhealth returned rc=%d", __func__, rc);
|
---|
[6223] | 291 | struct s_client *cl = reader->client;
|
---|
| 292 | if (cl) {
|
---|
| 293 | cl->last_srvid=er->srvid;
|
---|
| 294 | cl->last_caid=er->caid;
|
---|
| 295 | cl->last=time((time_t*)0);
|
---|
[5667] | 296 | }
|
---|
[3168] | 297 |
|
---|
[7695] | 298 | if (reader->csystem.active && reader->csystem.do_ecm) {
|
---|
[5739] | 299 | rc=reader->csystem.do_ecm(reader, er, ea);
|
---|
[8060] | 300 | rdr_debug_mask(reader, D_READER, "%s: after csystem.do_ecm rc=%d", __func__, rc);
|
---|
[7695] | 301 | } else
|
---|
[5667] | 302 | rc=0;
|
---|
| 303 | }
|
---|
[8060] | 304 | rdr_debug_mask(reader, D_READER, "%s: ret rc=%d", __func__, rc);
|
---|
[5667] | 305 | return(rc);
|
---|
[8] | 306 | }
|
---|
| 307 |
|
---|
[7688] | 308 | int32_t cardreader_do_emm(struct s_reader *reader, EMM_PACKET *ep)
|
---|
[8] | 309 | {
|
---|
[4994] | 310 | int32_t rc=-1;
|
---|
[1090] | 311 |
|
---|
[7688] | 312 | rc=cardreader_do_checkhealth(reader);
|
---|
[4989] | 313 | if (rc) {
|
---|
| 314 | if ((1<<(ep->emm[0] % 0x80)) & reader->b_nano)
|
---|
| 315 | return 3;
|
---|
[452] | 316 |
|
---|
[7156] | 317 | if (reader->csystem.active && reader->csystem.do_emm)
|
---|
[4626] | 318 | rc=reader->csystem.do_emm(reader, ep);
|
---|
[3168] | 319 | else
|
---|
| 320 | rc=0;
|
---|
[8] | 321 | }
|
---|
| 322 | return(rc);
|
---|
| 323 | }
|
---|
[7101] | 324 |
|
---|
[7688] | 325 | void cardreader_process_ecm(struct s_reader *reader, struct s_client *cl, ECM_REQUEST *er) {
|
---|
[7826] | 326 | if (ecm_ratelimit_check(reader, er, 1) != OK) {
|
---|
[8060] | 327 | rdr_debug_mask(reader, D_READER, "%s: ratelimit check failed.", __func__);
|
---|
[7826] | 328 | return; // reader_mode = 1: checkout ratelimiter in reader mode so srvid can be replaced
|
---|
[7692] | 329 | }
|
---|
[7933] | 330 | cs_ddump_mask(D_ATR, er->ecm, er->ecmlen, "ecm:");
|
---|
[7688] | 331 |
|
---|
| 332 | struct timeb tps, tpe;
|
---|
| 333 | cs_ftime(&tps);
|
---|
| 334 |
|
---|
| 335 | struct s_ecm_answer ea;
|
---|
| 336 | memset(&ea, 0, sizeof(struct s_ecm_answer));
|
---|
| 337 |
|
---|
| 338 | int32_t rc = cardreader_do_ecm(reader, er, &ea);
|
---|
[8060] | 339 | rdr_debug_mask(reader, D_READER, "%s: cardreader_do_ecm returned rc=%d (ERROR=%d)", __func__, rc, ERROR);
|
---|
[7688] | 340 |
|
---|
| 341 | ea.rc = E_FOUND; //default assume found
|
---|
| 342 | ea.rcEx = 0; //no special flag
|
---|
| 343 |
|
---|
| 344 | if (rc == ERROR) {
|
---|
| 345 | char buf[32];
|
---|
[8060] | 346 | rdr_debug_mask(reader, D_READER, "Error processing ecm for caid %04X, srvid %04X, servicename: %s",
|
---|
[7688] | 347 | er->caid, er->srvid, get_servicename(cl, er->srvid, er->caid, buf));
|
---|
| 348 | ea.rc = E_NOTFOUND;
|
---|
| 349 | ea.rcEx = 0;
|
---|
[7834] | 350 | ICC_Async_DisplayMsg(reader, "Eer");
|
---|
[7688] | 351 | }
|
---|
| 352 |
|
---|
| 353 | if (rc == E_CORRUPT) {
|
---|
| 354 | char buf[32];
|
---|
[8060] | 355 | rdr_debug_mask(reader, D_READER, "Error processing ecm for caid %04X, srvid %04X, servicename: %s",
|
---|
[7688] | 356 | er->caid, er->srvid, get_servicename(cl, er->srvid, er->caid, buf));
|
---|
| 357 | ea.rc = E_NOTFOUND;
|
---|
| 358 | ea.rcEx = E2_WRONG_CHKSUM; //flag it as wrong checksum
|
---|
| 359 | memcpy (ea.msglog,"Invalid ecm type for card",25);
|
---|
| 360 | }
|
---|
| 361 | cs_ftime(&tpe);
|
---|
| 362 | cl->lastecm=time((time_t*)0);
|
---|
[7943] | 363 | char ecmd5[17*3];
|
---|
| 364 | cs_hexdump(0, er->ecmd5, 16, ecmd5, sizeof(ecmd5));
|
---|
[7688] | 365 |
|
---|
[8060] | 366 | rdr_debug_mask(reader, D_READER, "ecm hash: %s real time: %ld ms",
|
---|
[7943] | 367 | ecmd5, 1000 * (tpe.time - tps.time) + tpe.millitm - tps.millitm);
|
---|
[7688] | 368 |
|
---|
| 369 | write_ecm_answer(reader, er, ea.rc, ea.rcEx, ea.cw, ea.msglog);
|
---|
[7826] | 370 |
|
---|
[7688] | 371 | reader_post_process(reader);
|
---|
| 372 | }
|
---|
| 373 |
|
---|
[6309] | 374 | #endif
|
---|