#include "globals.h"

#ifdef WITH_CARDREADER

#include "module-led.h"

#include "oscam-chk.h"

#include "oscam-client.h"

#include "oscam-ecm.h"

#include "oscam-emm.h"

#include "oscam-net.h"

#include "oscam-time.h"

#include "oscam-work.h"

#include "oscam-reader.h"

#include "reader-common.h"

//#include "csctapi/atr.h"

#include "csctapi/icc_async.h"

extern struct s_cardsystem cardsystems[CS_MAX_MOD];

extern char *RDR_CD_TXT[];

extern char *stb_boxtype;

int32_t check_sct_len(const uchar *data, int32_t off)

{

int32_t len = SCT_LEN(data);

if(len + off > MAX_LEN)

{

cs_debug_mask(D_TRACE | D_READER, "check_sct_len(): smartcard section too long %d > %d", len, MAX_LEN - off);

len = -1;

}

return len;

}

static void reader_nullcard(struct s_reader *reader)

{

memset(&reader->csystem , 0 , sizeof(reader->csystem));

memset(reader->hexserial, 0 , sizeof(reader->hexserial));

memset(reader->prid , 0xFF, sizeof(reader->prid));

reader->caid = 0;

reader->nprov = 0;

cs_clear_entitlement(reader);

}

int32_t reader_cmd2icc(struct s_reader *reader, const uchar *buf, const int32_t l, uchar *cta_res, uint16_t *p_cta_lr)

{

int32_t rc;

*p_cta_lr = CTA_RES_LEN - 1; //FIXME not sure whether this one is necessary

rdr_ddump_mask(reader, D_READER, buf, l, "write to cardreader");

rc = ICC_Async_CardWrite(reader, (uchar *)buf, (uint16_t)l, cta_res, p_cta_lr);

return rc;

}

#define CMD_LEN 5

int32_t card_write(struct s_reader *reader, const uchar *cmd, const uchar *data, uchar *response, uint16_t *response_length)

{

uchar buf[260];

// always copy to be able to be able to use const buffer without changing all code

memcpy(buf, cmd, CMD_LEN);

if(data)

{

if(cmd[4]) { memcpy(buf + CMD_LEN, data, cmd[4]); }

return (reader_cmd2icc(reader, buf, CMD_LEN + cmd[4], response, response_length));

}

else

{ return (reader_cmd2icc(reader, buf, CMD_LEN, response, response_length)); }

}

static inline int reader_use_gpio(struct s_reader *reader)

{

return reader->use_gpio && reader->detect > 4;

}

static int32_t reader_card_inserted(struct s_reader *reader)

{

if(!reader_use_gpio(reader) && (reader->detect & 0x7f) > 3)

{ return 1; }

int32_t card;

if(ICC_Async_GetStatus(reader, &card))

{

rdr_log(reader, "Error getting card status.");

return 0; //corresponds with no card inside!!

}

return (card);

}

static int32_t reader_activate_card(struct s_reader *reader, ATR *atr, uint16_t deprecated)

{

int32_t i, ret;

if(reader->card_status != CARD_NEED_INIT)

{ return 0; }

/* Activate card */

for(i = 0; i < 3; i++)

{

ret = ICC_Async_Activate(reader, atr, deprecated);

if(!ret)

{ break; }

rdr_log(reader, "Error activating card.");

led_status_card_activation_error();

cs_sleepms(500);

}

if(ret) { return (0); }

// rdr_log("ATR: %s", cs_hexdump(1, atr, atr_size, tmp, sizeof(tmp)));//FIXME

cs_sleepms(1000);

return (1);

}

void cardreader_get_card_info(struct s_reader *reader)

{

if((reader->card_status == CARD_NEED_INIT) || (reader->card_status == CARD_INSERTED))

{

struct s_client *cl = reader->client;

if(cl)

{ cl->last = time((time_t *)0); }

if(reader->csystem.active && reader->csystem.card_info)

{

reader->csystem.card_info(reader);

}

}

}

static int32_t reader_get_cardsystem(struct s_reader *reader, ATR *atr)

{

int32_t i;

for(i = 0; i < CS_MAX_MOD; i++)

{

if(cardsystems[i].card_init)

{

NULLFREE(reader->csystem_data);

if(cardsystems[i].card_init(reader, atr))

{

rdr_log(reader, "found card system %s", cardsystems[i].desc);

reader->csystem = cardsystems[i];

reader->csystem.active = 1;

led_status_found_cardsystem();

break;

}

else

{

// On error free allocated card system data if any

NULLFREE(reader->csystem_data);

}

}

}

if(reader->csystem.active == 0)

{

rdr_log(reader, "card system not supported");

led_status_unsupported_card_system();

}

return (reader->csystem.active);

}

void cardreader_do_reset(struct s_reader *reader)

{

reader_nullcard(reader);

ATR atr;

int32_t ret = 0;

int16_t i = 0;

int16_t j = 0;

if (reader->typ == R_SMART && reader->smartdev_found >= 4) j = 1; else j = 1; // back to a single start

for (i= 0; i < j; i++) {

ret = ICC_Async_Reset(reader, &atr, reader_activate_card, reader_get_cardsystem);

if(ret == -1)

{ return; }

if(ret == 0)

{

uint16_t y;

uint16_t deprecated;

if (reader->typ == R_SMART && reader->smartdev_found >= 4) y = 2; else y= 2;

// rdr_log(reader, "the restart atempts in deprecated is %u", y);

for(deprecated = reader->deprecated; deprecated < y; deprecated++)

{

if(!reader_activate_card(reader, &atr, deprecated)) { break; }

ret = reader_get_cardsystem(reader, &atr);

if(ret)

{ break; }

if(!deprecated)

{ rdr_log(reader, "Normal mode failed, reverting to Deprecated Mode"); }

}

}

if (ret){

rdr_log(reader,"THIS WAS A SUCCESSFUL START ATTEMPT No %u out of max alloted of %u", (i+1), j);

break;

}

else {

rdr_log(reader, "THIS WAS A FAILED START ATTEMPT No %u out of max alloted of %u", (i+1), j);

}

}

if(!ret)

{

reader->card_status = CARD_FAILURE;

rdr_log(reader, "card initializing error");

ICC_Async_DisplayMsg(reader, "AER");

led_status_card_activation_error();

}

else

{

cardreader_get_card_info(reader);

reader->card_status = CARD_INSERTED;

do_emm_from_file(reader);

ICC_Async_DisplayMsg(reader, "AOK");

}

return;

}

static int32_t cardreader_device_init(struct s_reader *reader)

{

int32_t rc = -1; //FIXME

if(ICC_Async_Device_Init(reader))

{ rdr_log(reader, "Cannot open device: %s", reader->device); }

else

{ rc = OK; }

return ((rc != OK) ? 2 : 0); //exit code 2 means keep retrying, exit code 0 means all OK

}

int32_t cardreader_do_checkhealth(struct s_reader *reader)

{

struct s_client *cl = reader->client;

if(reader_card_inserted(reader))

{

if(reader->card_status == NO_CARD || reader->card_status == UNKNOWN)

{

rdr_log(reader, "card detected");

led_status_card_detected();

reader->card_status = CARD_NEED_INIT;

add_job(cl, ACTION_READER_RESET, NULL, 0);

}

}

else

{

rdr_debug_mask(reader, D_READER, "%s: !reader_card_inserted", __func__);

if(reader->card_status == CARD_INSERTED || reader->card_status == CARD_NEED_INIT)

{

rdr_log(reader, "card ejected");

reader_nullcard(reader);

NULLFREE(reader->csystem_data);

if(cl)

{

cl->lastemm = 0;

cl->lastecm = 0;

}

led_status_card_ejected();

}

reader->card_status = NO_CARD;

}

rdr_debug_mask(reader, D_READER, "%s: reader->card_status = %d, ret = %d", __func__,

reader->card_status, reader->card_status == CARD_INSERTED);

return reader->card_status == CARD_INSERTED;

}

// Check for card inserted or card removed on pysical reader

void cardreader_checkhealth(struct s_client *cl, struct s_reader *rdr)

{

if(!rdr || !rdr->enable || !rdr->active)

{ return; }

add_job(cl, ACTION_READER_CHECK_HEALTH, NULL, 0);

}

void cardreader_reset(struct s_client *cl)

{

add_job(cl, ACTION_READER_RESET, NULL, 0);

}

void cardreader_init_locks(void)

{

ICC_Async_Init_Locks();

}

bool cardreader_init(struct s_reader *reader)

{

struct s_client *client = reader->client;

client->typ = 'r';

int8_t i = 0;

set_localhost_ip(&client->ip);

while((cardreader_device_init(reader) == 2) && i < 10)

{

cs_sleepms(2000);

if(!ll_contains(configured_readers, reader) || !is_valid_client(client) || reader->enable != 1)

{ return false; }

i++;

}

if (i >= 10)

{

reader->card_status = READER_DEVICE_ERROR;

cardreader_close(reader);

reader->enable = 0;

return false;

}

else

{

if((reader->cardmhz > 2000) && (reader->typ != R_SMART))

{

rdr_log(reader, "Reader initialized (device=%s, detect=%s%s, pll max=%.2f MHz, wanted mhz=%.2f MHz)",

reader->device,

reader->detect & 0x80 ? "!" : "",

RDR_CD_TXT[reader->detect & 0x7f],

(float)reader->cardmhz / 100,

(float)reader->mhz / 100);

rdr_log(reader,"Reader sci internal, detected box type: %s", stb_boxtype ? stb_boxtype : "generic");

}

else

{

if ((reader->typ == R_SMART) || (!strcasecmp(reader->crdr.desc, "smargo")) ){

rdr_debug_mask(reader, D_IFD, "clocking for smartreader with smartreader or smargo protocol");

if (reader->cardmhz >= 2000) reader->cardmhz = 369; else

if (reader->cardmhz >= 1600) reader->cardmhz = 1600; else

if (reader->cardmhz >= 1200) reader->cardmhz = 1200; else

if (reader->cardmhz >= 961) reader->cardmhz = 961; else

if (reader->cardmhz >= 800) reader->cardmhz = 800; else

if (reader->cardmhz >= 686) reader->cardmhz = 686; else

if (reader->cardmhz >= 600) reader->cardmhz = 600; else

if (reader->cardmhz >= 534) reader->cardmhz = 534; else

if (reader->cardmhz >= 480) reader->cardmhz = 480; else

if (reader->cardmhz >= 436) reader->cardmhz = 436; else

if (reader->cardmhz >= 400) reader->cardmhz = 400; else

if (reader->cardmhz >= 369) reader->cardmhz = 369; else

if (reader->cardmhz == 357) reader->cardmhz = 369; else // 357 not a default smartreader setting

if (reader->cardmhz >= 343) reader->cardmhz = 343; else

reader->cardmhz = 320;

if (reader->mhz >= 1600) reader->mhz = 1600; else

if (reader->mhz >= 1200) reader->mhz = 1200; else

if (reader->mhz >= 961) reader->mhz = 961; else

if (reader->mhz >= 900) reader->mhz = 900; else

if (reader->mhz >= 800) reader->mhz = 800; else

if (reader->mhz >= 686) reader->mhz = 686; else

if (reader->mhz >= 600) reader->mhz = 600; else

if (reader->mhz >= 534) reader->mhz = 534; else

if (reader->mhz >= 480) reader->mhz = 480; else

if (reader->mhz >= 436) reader->mhz = 436; else

if (reader->mhz >= 400) reader->mhz = 369; else

if (reader->mhz >= 369) reader->mhz = 369; else

if (reader->mhz == 357) reader->mhz = 369; else // 357 not a default smartreader setting

if (reader->mhz >= 343) reader->mhz = 343; else

reader->mhz = 320;

}

if (((reader->typ == R_SMART) && (reader->autospeed == 1)) || ((!strcasecmp(reader->crdr.desc, "smargo")) && (reader->autospeed == 1))) {

rdr_log(reader, "Reader initialized (device=%s, detect=%s%s, mhz= AUTO, cardmhz=%d)",

reader->device,

reader->detect & 0x80 ? "!" : "",

RDR_CD_TXT[reader->detect & 0x7f],

reader->cardmhz);

} else {

rdr_log(reader, "Reader initialized (device=%s, detect=%s%s, mhz=%d, cardmhz=%d)",

reader->device,

reader->detect & 0x80 ? "!" : "",

RDR_CD_TXT[reader->detect & 0x7f],

reader->mhz,

reader->cardmhz);

}

}

return true;

}

}

void cardreader_close(struct s_reader *reader)

{

ICC_Async_Close(reader);

}

void reader_post_process(struct s_reader *reader)

{

// some systems eg. nagra2/3 needs post process after receiving cw from card

// To save ECM/CW time we added this function after writing ecm answer

if(reader->csystem.active && reader->csystem.post_process)

{

reader->csystem.post_process(reader);

}

}

int32_t cardreader_do_ecm(struct s_reader *reader, ECM_REQUEST *er, struct s_ecm_answer *ea)

{

int32_t rc = -1;

if((rc = cardreader_do_checkhealth(reader)))

{

rdr_debug_mask(reader, D_READER, "%s: cardreader_do_checkhealth returned rc=%d", __func__, rc);

struct s_client *cl = reader->client;

if(cl)

{

cl->last_srvid = er->srvid;

cl->last_caid = er->caid;

cl->last = time((time_t *)0);

}

if(reader->csystem.active && reader->csystem.do_ecm)

{

rc = reader->csystem.do_ecm(reader, er, ea);

rdr_debug_mask(reader, D_READER, "%s: after csystem.do_ecm rc=%d", __func__, rc);

}

else

{ rc = 0; }

}

rdr_debug_mask(reader, D_READER, "%s: ret rc=%d", __func__, rc);

return (rc);

}

int32_t cardreader_do_emm(struct s_reader *reader, EMM_PACKET *ep)

{

int32_t rc;

if (reader->typ == R_SMART ) { // check health does not work with new card status check but is actually not needed for emm.

rc = 1;

} else {

rc = -1;

rc = cardreader_do_checkhealth(reader);

}

if(rc)

{

if((1 << (ep->emm[0] % 0x80)) & reader->b_nano)

{ return 3; }

if(reader->csystem.active && reader->csystem.do_emm)

{ rc = reader->csystem.do_emm(reader, ep); }

else

{ rc = 0; }

}

if(rc > 0) { cs_ftime(&reader->emm_last); } // last time emm written is now!

return (rc);

}

void cardreader_process_ecm(struct s_reader *reader, struct s_client *cl, ECM_REQUEST *er)

{

cs_ddump_mask(D_ATR, er->ecm, er->ecmlen, "ecm:");

struct timeb tps, tpe;

struct s_ecm_answer ea;

memset(&ea, 0, sizeof(struct s_ecm_answer));

cs_ftime(&tps);

int32_t rc = cardreader_do_ecm(reader, er, &ea);

cs_ftime(&tpe);

rdr_debug_mask(reader, D_READER, "%s: cardreader_do_ecm returned rc=%d (ERROR=%d)", __func__, rc, ERROR);

ea.rc = E_FOUND; //default assume found

ea.rcEx = 0; //no special flag

if(rc == ERROR)

{

char buf[32];

rdr_debug_mask(reader, D_READER, "Error processing ecm for caid %04X, srvid %04X, servicename: %s",

er->caid, er->srvid, get_servicename(cl, er->srvid, er->caid, buf));

ea.rc = E_NOTFOUND;

ea.rcEx = 0;

ICC_Async_DisplayMsg(reader, "Eer");

}

if(rc == E_CORRUPT)

{

char buf[32];

rdr_debug_mask(reader, D_READER, "Error processing ecm for caid %04X, srvid %04X, servicename: %s",

er->caid, er->srvid, get_servicename(cl, er->srvid, er->caid, buf));

ea.rc = E_NOTFOUND;

ea.rcEx = E2_WRONG_CHKSUM; //flag it as wrong checksum

memcpy(ea.msglog, "Invalid ecm type for card", 25);

}

write_ecm_answer(reader, er, ea.rc, ea.rcEx, ea.cw, ea.msglog);

cl->lastecm = time((time_t *)0);

char ecmd5[17 * 3];

cs_hexdump(0, er->ecmd5, 16, ecmd5, sizeof(ecmd5));

rdr_debug_mask(reader, D_READER, "ecm hash: %s real time: %"PRId64" ms", ecmd5, comp_timeb(&tpe, &tps));

reader_post_process(reader);

}

#endif