smartcard.c

Go to the documentation of this file.

/*
 * Softcam plugin to VDR (C++)
 *
 * This code is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License
 * as published by the Free Software Foundation; either version 2
 * of the License, or (at your option) any later version.
 *
 * This code is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
 * Or, point your browser to http://www.gnu.org/copyleft/gpl.html
 */

#include <stdlib.h>
#include <string.h>
#include <errno.h>
#include <fcntl.h>
#include <sys/ioctl.h>
#include <sys/poll.h>
#include <unistd.h>
#include <termios.h>
#include <linux/serial.h>
#include <ctype.h>

#include <vdr/tools.h>
#include <vdr/thread.h>

#include "smartcard.h"
#include "global.h"
#include "misc.h"
#include "log-core.h"

#define ISO_FREQ 3571200 // Hz
#define ISO_BAUD 9600

//#define CARD_EMU     // include smartcard emulation code
//#define NO_PTS_PROTO // disable PTS protocol (baudrate changes)

// -- cSmartCardSlot -----------------------------------------------------------

class cSmartCardSlot : private cThread, public cStructItem {
private:
  cSmartCard *card;
  int usecount, cardid;
  bool firstRun, needsReset, dead;
  cMutex mutex;
  cCondVar cond;
  //
  void SetCard(cSmartCard *c, int cid=0);
  bool CardReset(void);
protected:
  virtual bool DeviceOpen(const char *cfg)=0;
  virtual void DeviceClose(void) {}
  virtual bool DeviceSetMode(int mode, int baud)=0;
  virtual int DeviceRead(unsigned char *mem, int len, int timeout, int initialTimeout=0)=0;
  virtual int DeviceWrite(const unsigned char *mem, int len, int delay=0)=0;
  virtual void DeviceToggleReset(void)=0;
  virtual bool DevicePTS(void)=0;
  virtual bool DeviceIsInserted(void)=0;
  virtual int DeviceCurrentMode(void) { return currMode; }
  //
  virtual void Action(void);
  //
  int Procedure(unsigned char ins, int restLen);
  int Read(unsigned char *data, int len, int to=0);
  int Write(const unsigned char *data, int len);
  bool Test(bool res);
  void Invert(unsigned char *data, int n);
  virtual bool Reset(void);
  bool ParseAtr(void);
  //
  int slotnum, clock;
  const struct CardConfig *cfg;
  unsigned char sb[SB_LEN];
  struct Atr atr;
  bool localecho, singlereset;
  //
  char devName[256];
  int currMode;
public:
  cSmartCardSlot(void);
  virtual ~cSmartCardSlot();
  bool Setup(int num, const char *cfg);
  void SetCardConfig(const struct CardConfig *Cfg) { cfg=Cfg; }
  void TriggerReset(void) { needsReset=true; }
  bool HaveCard(int id);
  cSmartCard *LockCard(int id);
  void ReleaseCard(cSmartCard *sc);
  void GetCardIdStr(char *str, int len);
  bool GetCardInfoStr(char *str, int len);
  int SlotNum(void) { return slotnum; }
  //
  virtual bool IsoRead(const unsigned char *cmd, unsigned char *data);
  virtual bool IsoWrite(const unsigned char *cmd, const unsigned char *data);
  virtual int RawRead(unsigned char *data, int len, int to=0);
  virtual int RawWrite(const unsigned char *data, int len);
  };

static const char *serModes[] = { 0,"8e2","8o2","8n2" };

cSmartCardSlot::cSmartCardSlot(void)
{
  card=0; cfg=0; usecount=0; slotnum=-1; currMode=SM_NONE; clock=ISO_FREQ;
  firstRun=true; needsReset=false; dead=false;
  localecho=true; singlereset=false;
}

cSmartCardSlot::~cSmartCardSlot()
{
  Cancel(3);
  SetCard(0);
  DeviceClose();
}

bool cSmartCardSlot::Setup(int num, const char *cfg)
{
  slotnum=num;
  SetDescription("CardSlot %d watcher",slotnum);
  if(DeviceOpen(cfg)) {
    firstRun=true;
    Start();
    return true;
    }
  return false;
}

bool cSmartCardSlot::HaveCard(int id)
{
  cMutexLock lock(&mutex);
  while(Running() && firstRun) cond.Wait(mutex);
  return card && cardid==id;
}

cSmartCard *cSmartCardSlot::LockCard(int id)
{
  mutex.Lock();
  while(Running() && firstRun) cond.Wait(mutex);
  if(card && cardid==id) {
    usecount++;
    mutex.Unlock();
    card->Lock();
    if(DeviceIsInserted() && card->CardUp() && !needsReset) return card;
    // if failed, unlock the card and decrement UseCount
    card->Unlock();
    mutex.Lock();
    usecount--;
    cond.Broadcast();
    }
  mutex.Unlock();
  return 0;
}

void cSmartCardSlot::ReleaseCard(cSmartCard *sc)
{
  if(card==sc) {
    card->Unlock();
    mutex.Lock();
    usecount--;
    cond.Broadcast();
    mutex.Unlock();
    }
}

void cSmartCardSlot::GetCardIdStr(char *str, int len)
{
  mutex.Lock();
  if(card && !card->GetCardIdStr(str,len)) {
    for(cSmartCardLink *scl=smartcards.First(); scl; smartcards.Next(scl)) {
      if(scl->Id()==cardid) {
        strn0cpy(str,scl->Name(),len);
        break;
        }
      }
    }
  mutex.Unlock();
}

bool cSmartCardSlot::GetCardInfoStr(char *str, int len)
{
  mutex.Lock();
  bool res=false;
  if(card) res=card->GetCardInfoStr(str,len);
  mutex.Unlock();
  return res;
}

void cSmartCardSlot::SetCard(cSmartCard *c, int cid)
{
  mutex.Lock();
  while(usecount) cond.Wait(mutex);
  delete card;
  card=c; cardid=cid; needsReset=dead=false;
  mutex.Unlock();
}

void cSmartCardSlot::Action(void)
{
  while(Running()) {
    if(card) {
      card->Lock();
      if(!DeviceIsInserted()) {
        card->Unlock();
        PRINTF(L_CORE_SC,"%d: card removed (usecount=%d)",slotnum,usecount);
        SetCard(0);
        }
      else if(needsReset) {
        PRINTF(L_CORE_SC,"%d: card reset requested",slotnum);
        int mode=DeviceCurrentMode()&SM_MASK;
        if(!DeviceSetMode(mode,ISO_BAUD)
            || !CardReset()
            || !card->Setup(this,mode,&atr,sb)) {
          card->Unlock();
          PRINTF(L_CORE_SC,"%d: card re-init failed",slotnum);
          SetCard(0); dead=true;
          }
        }
      if(card) card->Unlock();
      }
    else if(DeviceIsInserted()) {
      if(!dead) {
        PRINTF(L_CORE_SC,"%d: new card inserted",slotnum);
        bool resetdone=false;
        for(int mode=SM_NONE+1 ; mode<SM_MAX ; mode++) {
          if(DeviceSetMode(mode,ISO_BAUD)) {
            if((singlereset && resetdone) || (resetdone=CardReset())) {
              for(cSmartCardLink *scl=smartcards.First(); scl; scl=smartcards.Next(scl)) {
                if(!Running()) goto done;
                PRINTF(L_CORE_SC,"%d: checking for %s card",slotnum,scl->Name());
                cSmartCard *sc=scl->Create();
                if(sc && sc->Setup(this,mode,&atr,sb)) {
                  SetCard(sc,scl->Id());
                  goto done; // ugly, any better solution?
                  }
                delete sc;
                }
              PRINTF(L_CORE_SC,"%d: no card handler found",slotnum);
              }
            else PRINTF(L_CORE_SC,"%d: reset/atr error",slotnum);
            }
          else PRINTF(L_CORE_SC,"%d: failed to set serial mode %s",slotnum,serModes[mode]);
          }
        dead=true;
        PRINTF(L_CORE_SC,"%d: can't initialise new card, ignoring port until card reinserted",slotnum);
        }
      }
    else {
      if(dead) PRINTF(L_CORE_SC,"%d: card removed, port reactivated",slotnum);
      dead=false;
      }
done:
    if(firstRun) {
      mutex.Lock();
      cond.Broadcast();
      firstRun=false;
      mutex.Unlock();
      }
    cCondWait::SleepMs(300);
    }
}

bool cSmartCardSlot::Reset(void)
{
  PRINTF(L_CORE_SC,"%d: reseting card (sermode %s)",slotnum,serModes[DeviceCurrentMode()]);
  DeviceToggleReset();
  cCondWait::SleepMs(100);
  DeviceToggleReset();
  int r=DeviceRead(atr.atr,-MAX_ATR_LEN,800,2000);
  atr.atrLen=r;
  if(r>0) LDUMP(L_CORE_SC,atr.atr,r,"%d: <- ATR len=%d:",slotnum,r);
  return r>=2;
}

bool cSmartCardSlot::CardReset(void)
{
  if(!Reset() || !ParseAtr()) return false;
  if((atr.F!=372 || atr.D!=1.0) && !DevicePTS()) {
    // reset card again and continue without PTS
    if(!Reset() || !ParseAtr()) return false;
    }
  return true;
}

void cSmartCardSlot::Invert(unsigned char *data, int n)
{
  static const unsigned char swaptab[] =  { 15,7,11,3,13,5,9,1,14,6,10,2,12,4,8,0 };
  for(int i=n-1; i>=0; i--)
    data[i]=(swaptab[data[i]&0x0f]<<4) | swaptab[data[i]>>4];
}

int cSmartCardSlot::Read(unsigned char *data, int len, int to)
{
  int r=DeviceRead(data,len,cfg->serTO,to);
  if(atr.convention==SM_INDIRECT && r>0) Invert(data,r);
  return r;
}

int cSmartCardSlot::Write(const unsigned char *data, int len)
{
  unsigned char *tmp=AUTOMEM(len);
  if(atr.convention==SM_INDIRECT) {
    memcpy(tmp,data,len);
    Invert(tmp,len);
    data=tmp;
    }
  int r=DeviceWrite(data,len,cfg->serDL);
  if(r>0 && localecho) {
    unsigned char *buff=AUTOMEM(r);
    int rr=DeviceRead(buff,r,cfg->serTO);
    if(rr<0) r=rr;
    }
  return r;
}

int cSmartCardSlot::Procedure(unsigned char ins, int restLen)
{
  int r;
  unsigned char buff;
  LBSTARTF(L_CORE_SC);
  LBPUT("%d: <- PROC: ",slotnum);
  do {
    do {
      if(Read(&buff,1,cfg->workTO)<=0) return -1;
      LBPUT("%02x ",buff);
      } while(buff==0x60);

    if((buff&0xF0)==0x60 || (buff&0xF0)==0x90) { // SW1/SW2
      sb[0]=buff;
      if(Read(&buff,1)<=0) return -1;
      LBPUT("%02x",buff);
      sb[1]=buff;
      return 0;
      }
    else {
      if((buff&0xFE)==(ins&0xFE)) r=restLen;
      else if((~buff&0xFE)==(ins&0xFE)) r=1;
      else {
        LBPUT("cannot handle procedure %02x (ins=%02x)",buff,ins);
        return -1;
        }
      if(r>restLen) {
        LBPUT("data overrun r=%d restLen=%d",r,restLen);
        return -1;
        }
      }
    } while(r==0);
  LBEND();
  return r;
}

bool cSmartCardSlot::Test(bool res)
{
 if(!res) {
   TriggerReset();
   PRINTF(L_CORE_SC,"%d: reset triggered",slotnum);
   }
 return res;
}

bool cSmartCardSlot::IsoRead(const unsigned char *cmd, unsigned char *data)
{
  LDUMP(L_CORE_SC,cmd,CMD_LEN,"%d: -> INS:",slotnum);
  if(Write(cmd,CMD_LEN)<0) return Test(false);
  int tr=cmd[LEN_IDX] ? cmd[LEN_IDX] : 256;
  int len=0;
  while(1) {
    int r=Procedure(cmd[INS_IDX],tr-len);
    if(r<=0) return Test(r==0);
    if(Read(data+len,r)<0) return Test(false);
    LDUMP(L_CORE_SC,data+len,r,"%d: <- DATA:",slotnum);
    len+=r;
    }
}

bool cSmartCardSlot::IsoWrite(const unsigned char *cmd, const unsigned char *data)
{
  LDUMP(L_CORE_SC,cmd,CMD_LEN,"%d: -> INS:",slotnum);
  if(Write(cmd,CMD_LEN)<0) return Test(false);
  int len=0;
  while(1) {
    int r=Procedure(cmd[INS_IDX],cmd[LEN_IDX]-len);
    if(r<=0) return Test(r==0);
    if(Write(data+len,r)<0) return Test(false);
    LDUMP(L_CORE_SC,data+len,r,"%d: -> DATA:",slotnum);
    len+=r;
    }
}

int cSmartCardSlot::RawRead(unsigned char *data, int len, int to)
{
  int r=Read(data,len,to);
  if(r<0) Test(false);
  return r;
}

int cSmartCardSlot::RawWrite(const unsigned char *data, int len)
{
  int r=Write(data,len);
  if(r<0) Test(false);
  return r;
}

#define NEED(x) { if(len+(x)>atr.atrLen) { LBPUT("SHORT ATR"); return false; } }

bool cSmartCardSlot::ParseAtr(void)
{
  // default values
  atr.histLen=0; atr.T=0; atr.F=372; atr.fs=clock; atr.D=1.0; atr.N=0; atr.WI=10;
  atr.BWI=4; atr.CWI=0; atr.Tspec=-1;

  static const int Ftable[16] = {
    372,372,558,744,1116,1488,1860,0,0,512,768,1024,1536,2048,0,0
    };
  static const int fstable[16] = {
    3571200,5000000,6000000, 8000000,12000000,16000000,20000000,0,
          0,5000000,7500000,10000000,15000000,20000000,       0,0
    };
  static const float Dtable[16] = {
    0.0,1.0,2.0,4.0,8.0,16.0,0.0,0.0,
    0.0,0.0,0.5,0.25,0.125,0.0625,0.03125,0.015625
    };

  const unsigned char *rawatr=atr.atr;
  if(rawatr[0]==0x03) {
    PRINTF(L_CORE_SC,"%d: indirect convention detected",slotnum);
    Invert(atr.atr,atr.atrLen);
    atr.convention=SM_INDIRECT;
    }
  else if(rawatr[0]==0x3B) {
    PRINTF(L_CORE_SC,"%d: direct convention detected",slotnum);
    atr.convention=SM_DIRECT;
    }
  else if(rawatr[0]==0x3F) {
    PRINTF(L_CORE_SC,"%d: inverted indirect convention detected",slotnum);
    atr.convention=SM_INDIRECT_INV;
    }
  else {
    PRINTF(L_CORE_SC,"%d: byte mode not supported 0x%02x",slotnum,rawatr[0]);
    return false;
    }

  // TS TO
  atr.histLen=rawatr[1]&0x0F;
  int Y=rawatr[1]&0xF0, i=1, len=2;
  LBSTARTF(L_CORE_SC);
  LBPUT("%d: atr decoding TS=%02x hist=%d Y%d=%02x ",slotnum,rawatr[0],atr.histLen,i,Y);
  do {
    if(Y&0x10) { // TAi
      NEED(1);
      LBPUT("TA%d=%02x ",i,rawatr[len]);
      if(i==1) {
        atr.TA1=rawatr[len];
        int i=(rawatr[len]>>4)&0x0F;
        atr.F=Ftable[i]; atr.fs=fstable[i];
        atr.D=Dtable[rawatr[len]&0x0F];
        LBPUT("F=%d fs=%.4f D=%f ",atr.F,atr.fs/1000000.0,atr.D);
        }
      else if(i==2) {
        atr.Tspec=rawatr[len]&0x0F;
        LBPUT("Tspec=%d ",atr.Tspec);
        }
      else if(i==3) {
        LBPUT("IFSC=%d ",rawatr[len]);
        }
      len++;
      }
    if(Y&0x20) { // TBi
      NEED(1);
      LBPUT("TB%d=%02x ",i,rawatr[len]);
      if(i==3) {
        atr.BWI=(rawatr[len]>>4)&0x0F;
        atr.CWI=rawatr[len]&0x0F;
        LBPUT("BWI=%d CWI=%d ",atr.BWI,atr.CWI);
        }
      len++;
      }
    if(Y&0x40) { // TCi
      NEED(1);
      LBPUT("TC%d=%02x ",i,rawatr[len]);
      if(i==1) {
        atr.N=rawatr[len];
        LBPUT("N=%d ",atr.N);
        }
      else if(i==2) {
        atr.WI=rawatr[len];
        LBPUT("WI=%d ",atr.WI);
        }
      else if(i==3) {
        LBPUT("CHK=%s ",rawatr[len]&1 ? "CRC16":"LRC");
        }
      len++;
      }
    if(Y&0x80) { // TDi
      NEED(1);
      LBPUT("TD%d=%02x ",i,rawatr[len]);
      if(i==1) {
        atr.T=rawatr[len]&0x0F;
        LBPUT("T=%d ",atr.T);
        }
      else {
        LBPUT("Tn=%d ",rawatr[len]&0x0F);
        }
      Y=rawatr[len]&0xF0;
      len++;
      }
    else Y=0;
    i++;
    LBPUT("Y%d=%02x ",i,Y);
    } while(Y);
  NEED(atr.histLen);
  LBEND();

  LBSTART(L_CORE_SC);
  LBPUT("%d: historical:",slotnum);
  for(int i=0; i<atr.histLen; i++) LBPUT(" %02x",rawatr[len+i]);
  LBFLUSH();
  LBPUT("%d: historical: '",slotnum);
  for(int i=0; i<atr.histLen; i++) LBPUT("%c",isprint(rawatr[len+i]) ? rawatr[len+i] : '.');
  LBEND();

  memcpy(atr.hist,&rawatr[len],atr.histLen);
  len+=atr.histLen;

  // TCK
  if(atr.T!=0 && len+1<=atr.atrLen) {
    len++;
    unsigned char cs=XorSum(rawatr+1,len-1);
    // according to the ISO the initial TS byte isn't checksumed, but
    // some cards do so. In this case the checksum is equal TS.
    if(cs==0) PRINTF(L_CORE_SC,"%d: atr checksum ok",slotnum);
    else if(cs==rawatr[0]) PRINTF(L_CORE_SC,"iso: %d: atr checksum is TS (not ISO compliant)",slotnum);
    else {
      PRINTF(L_CORE_SC,"%d: atr checksum FAILED (cs:%02x)",slotnum,cs);
      return false;
      }
    }
  else PRINTF(L_CORE_SC,"%d: atr checksum not given/not required",slotnum);

  if(atr.atrLen>len) PRINTF(L_CORE_SC,"%d: long atr read=%d len=%d",slotnum,atr.atrLen,len);
  atr.wwt=960*atr.WI*atr.F/(clock/1000);
  atr.bwt=(int)(960*(float)(1<<atr.BWI)*372/(clock/1000));
  PRINTF(L_CORE_SC,"%d: indicated wwt(T0)=%d ms, bwt(T1)=%d ms (at %.4f MHz)",slotnum,atr.wwt,atr.bwt,(float)clock/1000000);
  return true;
}

#undef NEED

// -- cSmartCardSlots / cSmartCardSlotLink -------------------------------------

class cSmartCardSlotLink {
public:
  cSmartCardSlotLink *next;
  const char *name;
public:
  cSmartCardSlotLink(const char *Name);
  virtual ~cSmartCardSlotLink() {}
  virtual cSmartCardSlot *Create(void)=0;
  };

template<class LL> class cSmartCardSlotLinkReg : public cSmartCardSlotLink {
public:
  cSmartCardSlotLinkReg(const char *Name):cSmartCardSlotLink(Name) {}
  virtual cSmartCardSlot *Create(void) { return new LL; }
  };

class cSmartCardSlots : public cStructListPlain<cSmartCardSlot> {
friend class cSmartCardSlotLink;
private:
  static cSmartCardSlotLink *first;
  //
  static void Register(cSmartCardSlotLink *scl);
protected:
  virtual bool ParseLinePlain(const char *line);
public:
  cSmartCardSlots(void);
  cSmartCardSlot *GetSlot(int num);
  cSmartCardSlot *FirstSlot(void);
  void Release(void);
  };

cSmartCardSlotLink *cSmartCardSlots::first=0;

static cSmartCardSlots cardslots;

cSmartCardSlotLink::cSmartCardSlotLink(const char *Name)
{
  name=Name;
  cSmartCardSlots::Register(this);
}

cSmartCardSlots::cSmartCardSlots(void)
:cStructListPlain<cSmartCardSlot>("cardslot config","cardslot.conf",SL_MISSINGOK|SL_VERBOSE|SL_NOPURGE)
{}

void cSmartCardSlots::Register(cSmartCardSlotLink *scl)
{
  PRINTF(L_CORE_DYN,"registering cardslot type %s",scl->name);
  scl->next=first;
  first=scl;
}

cSmartCardSlot *cSmartCardSlots::GetSlot(int num)
{
  ListLock(false);
  for(cSmartCardSlot *slot=First(); slot; slot=Next(slot))
    if(slot->SlotNum()==num) return slot;
  return 0;
}

cSmartCardSlot *cSmartCardSlots::FirstSlot(void)
{
  ListLock(false);
  return First();
}

void cSmartCardSlots::Release(void)
{
  ListUnlock();
}

bool cSmartCardSlots::ParseLinePlain(const char *line)
{
  char type[32];
  int num;
  if(sscanf(line,"%31[^:]:%n",type,&num)==1) {
    for(cSmartCardSlotLink *scs=first; scs; scs=scs->next) {
      if(!strcasecmp(type,scs->name)) {
        cSmartCardSlot *slot=scs->Create();
        if(slot) {
          if(slot->Setup(Count(),&line[num])) {
            Add(slot);
            return true;
            }
          delete slot;
          }
        else PRINTF(L_GEN_ERROR,"failed to create cardslot");
        return false;
        }
      }
    PRINTF(L_GEN_ERROR,"unknown cardslot type '%s'",type);
    }
  return false;
}

// -- cSmartCardSlotSerial -----------------------------------------------------

class cSmartCardSlotSerial : public cSmartCardSlot {
private:
  int statInv, invRST;
  bool custombaud;
  //
  speed_t FindBaud(int baud);
protected:
  int fd;
  //
  void Flush(void);
  void SetDtrRts(void);
  //
  virtual bool DeviceOpen(const char *cfg);
  virtual void DeviceClose(void);
  virtual bool DeviceSetMode(int mode, int baud);
  virtual int DeviceRead(unsigned char *mem, int len, int timeout, int initialTimeout=0);
  virtual int DeviceWrite(const unsigned char *mem, int len, int delay=0);
  virtual void DeviceToggleReset(void);
  virtual bool DevicePTS(void);
  virtual bool DeviceIsInserted(void);
public:
  cSmartCardSlotSerial(void);
  };

static cSmartCardSlotLinkReg<cSmartCardSlotSerial> __scs_serial("serial");

cSmartCardSlotSerial::cSmartCardSlotSerial(void)
{
  fd=-1; statInv=0; invRST=false; custombaud=false;
}

bool cSmartCardSlotSerial::DeviceOpen(const char *cfg)
{
  int invCD=0;
  if(sscanf(cfg,"%255[^:]:%d:%d:%d",devName,&invCD,&invRST,&clock)>=3) {
    if(clock<=0) clock=ISO_FREQ;
    statInv=invCD ? TIOCM_CAR:0;
    PRINTF(L_CORE_SERIAL,"%s: open serial port",devName);
    fd=open(devName,O_RDWR|O_NONBLOCK|O_NOCTTY);
    if(fd>=0) {
      SetDtrRts();
      PRINTF(L_CORE_SERIAL,"%s: init done",devName);
      PRINTF(L_CORE_LOAD,"cardslot: added serial port %s as port %d (%s CD, %s RESET, CLOCK %d)",
                devName,slotnum,invCD?"inverse":"normal",invRST?"inverse":"normal",clock);
      return true;
      }
    else PRINTF(L_GEN_ERROR,"%s: open failed: %s",devName,strerror(errno));
    }
  else PRINTF(L_GEN_ERROR,"bad parameter for cardslot type 'serial'");
  return false;
}

void cSmartCardSlotSerial::SetDtrRts(void)
{
  PRINTF(L_CORE_SERIAL,"%s: set DTR/RTS",devName);
  unsigned int modembits;
  modembits=TIOCM_DTR; CHECK(ioctl(fd, TIOCMBIS, &modembits));
  modembits=TIOCM_RTS; CHECK(ioctl(fd, invRST?TIOCMBIS:TIOCMBIC, &modembits));
}

void cSmartCardSlotSerial::DeviceClose(void)
{
  if(fd>=0) {
    PRINTF(L_CORE_SERIAL,"%s: shutting down",devName);
    Flush();
    unsigned int modembits=0;
    CHECK(ioctl(fd,TIOCMSET,&modembits));
    close(fd); fd=-1;
    PRINTF(L_CORE_SERIAL,"%s: shutdown done",devName);
    }
}

void cSmartCardSlotSerial::Flush(void)
{
  if(fd>=0) CHECK(tcflush(fd,TCIOFLUSH));
}

speed_t cSmartCardSlotSerial::FindBaud(int baud)
{
  static const struct BaudRates { int real; speed_t apival; } BaudRateTab[] = {
    {   9600, B9600   }, {  19200, B19200  }, {  38400, B38400  },
    {  57600, B57600  }, { 115200, B115200 }, { 230400, B230400 }
    };

  for(int i=0; i<(int)(sizeof(BaudRateTab)/sizeof(struct BaudRates)); i++) {
    int b=BaudRateTab[i].real;
    int d=((b-baud)*10000)/b;
    if(abs(d)<=300) {
      PRINTF(L_CORE_SERIAL,"%s: requested baudrate %d -> %d (%+.2f%%)",devName,baud,b,(float)d/100.0);
      return BaudRateTab[i].apival;
      }
    }
  PRINTF(L_CORE_SERIAL,"%s: requested baudrate %d -> custom",devName,baud);
  return B0;
}

bool cSmartCardSlotSerial::DeviceSetMode(int mode, int baud)
{
  if(fd>=0) {
    speed_t bconst=FindBaud(baud);
    bool custom=false;
    if(bconst==B0) { custom=true; bconst=B38400; }

    struct termios tio;
    memset(&tio,0,sizeof(tio));
    LBSTARTF(L_CORE_SERIAL);
    LBPUT("%s: set serial options: %d,",devName,baud);
    tio.c_cflag = (CS8 | CREAD | HUPCL | CLOCAL);
    if(!(mode&SM_1SB)) tio.c_cflag |= CSTOPB;
    tio.c_iflag = (INPCK | IGNBRK);
    tio.c_cc[VMIN] = 1;
    cfsetispeed(&tio,bconst);
    cfsetospeed(&tio,bconst);
    switch(mode&SM_MASK) {
      case SM_8E2:
        LBPUT("8e%d",(mode&SM_1SB)?1:2);
        tio.c_cflag |= PARENB; break;
      case SM_8N2:
        LBPUT("8n%d",(mode&SM_1SB)?1:2);
        break;
      case SM_8O2:
        LBPUT("8o%d",(mode&SM_1SB)?1:2);
        tio.c_cflag |= (PARENB | PARODD); break;
      default:
        LBPUT("BAD MODE");
        return false;
      }
    LBEND();

    struct serial_struct s;
    if(ioctl(fd,TIOCGSERIAL,&s)<0) {
      if(custom || custombaud) {
        PRINTF(L_GEN_ERROR,"%s: get serial failed: %s",devName,strerror(errno));
        return false;
        }
      PRINTF(L_CORE_SERIAL,"%s: get serial failed: %s",devName,strerror(errno));
      PRINTF(L_CORE_SERIAL,"%s: custombaud not used, try to continue...",devName);
      }
    else if(!custom && ((s.flags&ASYNC_SPD_MASK)==ASYNC_SPD_CUST || s.custom_divisor!=0)) {
      s.custom_divisor=0;
      s.flags &= ~ASYNC_SPD_MASK;
      if(ioctl(fd,TIOCSSERIAL,&s)<0) {
        PRINTF(L_GEN_ERROR,"%s: set serial failed: %s",devName,strerror(errno));
        return false;
        }
      custombaud=false;
      }
    if(!tcsetattr(fd,TCSANOW,&tio)) {
      if(custom) {
        s.custom_divisor=(s.baud_base+(baud/2))/baud;
        s.flags=(s.flags&~ASYNC_SPD_MASK) | ASYNC_SPD_CUST;
        PRINTF(L_CORE_SERIAL,"%s: custom: baud_base=%d baud=%d devisor=%d -> effective baudrate %d (%+.2f%% off)",devName,s.baud_base,baud,s.custom_divisor,s.baud_base/s.custom_divisor,(float)(s.baud_base/s.custom_divisor-baud)/(float)baud);
        if(ioctl(fd,TIOCSSERIAL,&s)<0) {
          PRINTF(L_GEN_ERROR,"%s: set serial failed: %s",devName,strerror(errno));
          return false;
          }
        custombaud=true;
        }
      currMode=mode; Flush();
      return true;
      }
    else PRINTF(L_GEN_ERROR,"%s: tcsetattr failed: %s",devName,strerror(errno));
    }
  return false;
}

int cSmartCardSlotSerial::DeviceRead(unsigned char *mem, int len, int timeout, int initialTimeout)
{
  PRINTF(L_CORE_SERIAL,"%s: read len=%d timeout=%d:%d",devName,len,timeout,initialTimeout);
  bool incomplete=false;
  if(len<0) { len=-len; incomplete=true; }
  int to=initialTimeout>0 ? initialTimeout : timeout;
  int n=0;
  while(n<len) {
    int r=read(fd,mem+n,len-n);
    if(r<=0) {
      if(r==0) PRINTF(L_CORE_SERIAL,"%s: read bogus eof",devName);
      if(errno==EAGAIN) {
        struct pollfd u;
        u.fd=fd; u.events=POLLIN;
        r=poll(&u,1,to);
        if(r<0) {
          PRINTF(L_GEN_ERROR,"%s: read poll failed: %s",devName,strerror(errno));
          return -1;
          }
        else if(r==0) { // timeout
          PRINTF(L_CORE_SERIAL,"%s: read timeout (%d ms)",devName,to);
          if(n>0 && incomplete) break; // return bytes read so far
          return -2;
          }
        continue;
        }
      else {
        PRINTF(L_GEN_ERROR,"%s: read failed: %s",devName,strerror(errno));
        return -1;
        }
      }
    n+=r; to=timeout;
    }
  HEXDUMP(L_CORE_SERIAL,mem,n,"%s: read data",devName);
  return n;
}

int cSmartCardSlotSerial::DeviceWrite(const unsigned char *mem, int len, int delay)
{
  PRINTF(L_CORE_SERIAL,"%s: write len=%d delay=%d",devName,len,delay);
  HEXDUMP(L_CORE_SERIAL,mem,len,"%s: write data",devName);
  Flush();
  int n=0;
  while(n<len) {
    struct pollfd u;
    u.fd=fd; u.events=POLLOUT;
    int r;
    do {
      r=poll(&u,1,500);
      if(r<0) {
        PRINTF(L_GEN_ERROR,"%s: write poll failed: %s",devName,strerror(errno));
        return -1;
        }
      else if(r==0) { // timeout
        PRINTF(L_CORE_SERIAL,"%s: write timeout",devName);
        return -2;
        }
      } while(r<1);
    r=write(fd,mem+n,delay>0?1:len-n);
    if(r<0 && errno!=EAGAIN) {
      PRINTF(L_GEN_ERROR,"%s: write failed: %s",devName,strerror(errno));
      return -1;
      }
    if(r>0) n+=r;
    if(delay>0) cCondWait::SleepMs(delay);
    }
  return n;
}

void cSmartCardSlotSerial::DeviceToggleReset(void)
{
  int mask=0;
  if(ioctl(fd,TIOCMGET,&mask)<0) { LOG_ERROR; return; }
  if(mask&TIOCM_RTS) { mask&=~TIOCM_RTS; PRINTF(L_CORE_SERIAL,"%s: toggle RTS, now off",devName); }
  else               { mask|= TIOCM_RTS; PRINTF(L_CORE_SERIAL,"%s: toggle RTS, now on",devName); }
  CHECK(ioctl(fd,TIOCMSET,&mask));
  Flush();
}

bool cSmartCardSlotSerial::DevicePTS(void)
{
  int baud=(int)((float)clock*atr.D/atr.F);
  PRINTF(L_CORE_SC,"%d: PTS cycle: calculated baudrate %d",slotnum,baud);

  if(atr.Tspec<0) {
    PRINTF(L_CORE_SC,"%d: negotiable mode",slotnum);
#ifdef NO_PTS_PROTO
    PRINTF(L_CORE_SC,"%d: PTS disabled at compile time!!!",slotnum);
    return true;
#else
    unsigned char req[4], conf[16];
    req[0]=0xFF;
    req[1]=0x10 | atr.T;
    req[2]=atr.TA1;
    req[3]=XorSum(req,3);
    LDUMP(L_CORE_SC,req,4,"%d: PTS request:",slotnum);
    if(DeviceWrite(req,4)!=4) {
      PRINTF(L_CORE_SC,"%d: PTS request, write failed",slotnum);
      return false;
      }
    if(DeviceRead(conf,4,100,100)!=4) {
      PRINTF(L_CORE_SC,"%d: PTS request, echo readback failed",slotnum);
      return false;
      }
    int n=DeviceRead(conf,-16,200,1000);
    if(n>0) LDUMP(L_CORE_SC,conf,n,"%d: PTS confirm:",slotnum);
    if(n<1 || conf[0]!=0xFF || XorSum(conf,n)!=0) {
      PRINTF(L_CORE_SC,"%d: PTS confirm, bad format",slotnum);
      return false;
      }
    if(n<4 || conf[1]!=req[1] || conf[2]!=req[2]) {
      PRINTF(L_CORE_SC,"%d: PTS not confirmed",slotnum);
      return false;
      }
#endif // NO_PTS_PROTO
    }
  else
    PRINTF(L_CORE_SC,"%d: specific mode Tspec=%d",slotnum,atr.Tspec);

  int mode=DeviceCurrentMode();
  if(atr.N==255) mode|=SM_1SB;
  if(!DeviceSetMode(mode,baud)) {
    PRINTF(L_CORE_SC,"%d: setting baudrate %d failed",slotnum,baud);
    return false;
    }
  return true;
}

bool cSmartCardSlotSerial::DeviceIsInserted(void)
{
  int status=0;
  if(ioctl(fd,TIOCMGET,&status)<0) { LOG_ERROR; return false; }
  PRINTF(L_CORE_SERIAL,"%s: CAR is %sactive (lines:%s%s%s%s%s%s%s%s%s)",
     devName,(status&TIOCM_CAR)?"in":"",
     (status&TIOCM_LE)?" LE":"",  (status&TIOCM_DTR)?" DTR":"",
     (status&TIOCM_RTS)?" RTS":"",(status&TIOCM_ST)?" ST":"",
     (status&TIOCM_SR)?" SR":"",  (status&TIOCM_CTS)?" CTS":"",
     (status&TIOCM_CAR)?" CAR":"",(status&TIOCM_RNG)?" RNG":"",
     (status&TIOCM_DSR)?" DSR":"" );
  status^=statInv; // invert status for broken cardreaders
  return !(status & TIOCM_CAR);
}

// -- cSmartCardSlotSRPlus -----------------------------------------------------

class cSmartCardSlotSRPlus : public cSmartCardSlotSerial {
private:
  bool SRConfig(int F, float D, int fs, int N, int T, int inv);
protected:
  virtual bool DeviceOpen(const char *cfg);
  virtual bool DeviceSetMode(int mode, int baud);
  virtual bool DevicePTS(void);
public:
  cSmartCardSlotSRPlus(void);
  };

static cSmartCardSlotLinkReg<cSmartCardSlotSRPlus> __scs_srplus("srplus");

cSmartCardSlotSRPlus::cSmartCardSlotSRPlus(void)
{
  localecho=false;
}

bool cSmartCardSlotSRPlus::DeviceOpen(const char *cfg)
{
  if(sscanf(cfg,"%255[^:]:%d",devName,&clock)>=1) {
    if(clock<=0) clock=ISO_FREQ;
    PRINTF(L_CORE_SERIAL,"%s: open serial port",devName);
    fd=open(devName,O_RDWR|O_NONBLOCK|O_NOCTTY);
    if(fd>=0) {
      SetDtrRts();
      PRINTF(L_CORE_SERIAL,"%s: init done",devName);
      PRINTF(L_CORE_LOAD,"cardslot: added smartreader+ port %s as port %d (CLOCK %d)",
                devName,slotnum,clock);
      return true;
      }
    else PRINTF(L_GEN_ERROR,"%s: open failed: %s",devName,strerror(errno));
    }
  else PRINTF(L_GEN_ERROR,"bad parameter for cardslot type 'srplus'");
  return false;
}

bool cSmartCardSlotSRPlus::DeviceSetMode(int mode, int baud)
{
  // Configure SmartReader+ with initial settings, ref ISO 7816 3.1.
  return baud==ISO_BAUD &&
         cSmartCardSlotSerial::DeviceSetMode(mode,ISO_BAUD) &&
         SRConfig(372,1.0,clock,0,0,0);
}

bool cSmartCardSlotSRPlus::DevicePTS(void)
{
  // Configure SmartReader+ with work settings, ref ISO 7816 3.1.
  int inv=0;
  if(atr.convention==SM_INDIRECT) atr.convention=SM_INDIRECT_INV;
  if(atr.convention==SM_INDIRECT_INV) inv=1;
  // Use ISO work clock frequency unless a fixed frequency is specified.
  int cl=(clock==ISO_FREQ) ? atr.fs:clock;
  if(!SRConfig(atr.F,atr.D,cl,atr.N,atr.T,inv)) return false;
  PRINTF(L_CORE_SERIAL,"%s: SmartReader+ mode %.4f MHz",devName,cl/1000000.0);
  return true;
}

bool cSmartCardSlotSRPlus::SRConfig(int F, float D, int fs, int N, int T, int inv)
{
  fs/=1000; // convert to kHz.
  PRINTF(L_CORE_SERIAL,"%s: SR+ options F=%d D=%f fs=%d N=%d T=%d inv=%d",devName,F,D,fs,N,T,inv);
  // Set SmartReader+ in CMD mode.
  struct termios term;
  if(tcgetattr(fd,&term)==-1) {
    PRINTF(L_GEN_ERROR,"%s: tcgetattr failed: %s",devName,strerror(errno));
    return false;
    }
  term.c_cflag&=~CSIZE;
  term.c_cflag|=CS5;
  if(tcsetattr(fd,TCSADRAIN,&term)==-1) {
    PRINTF(L_GEN_ERROR,"%s: tcsetattr failed: %s",devName,strerror(errno));
    return false;
    }
  // Write SmartReader+ configuration commands.
  unsigned char cmd[16];
  //XXX how is (int)D supposed to work for fractional values e.g. 0.125 ??
  cmd[0]=1; cmd[1]=F>>8; cmd[2]=F; cmd[3]=(int)D;
  if(DeviceWrite(cmd,4)!=4) return false;
  cmd[0]=2; cmd[1]=fs>>8; cmd[2]=fs;
  if(DeviceWrite(cmd,3)!=3) return false;
  cmd[0]=3; cmd[1]=N;
  if(DeviceWrite(cmd,2)!=2) return false;
  cmd[0]=4; cmd[1]=T;
  if(DeviceWrite(cmd,2)!=2) return false;
  cmd[0]=5; cmd[1]=inv;
  if(DeviceWrite(cmd,2)!=2) return false;
  // Send zero bits for 0.25 - 0.5 seconds.
  if(tcsendbreak(fd,0)==-1) {
    PRINTF(L_GEN_ERROR,"%s: tcsendbreak failed: %s",devName,strerror(errno));
    return false;
    }
  // We're entering SmartReader+ mode; speed up serial communication.
  // B3000000 is the highest setting that sticks.
  cfsetispeed(&term,B3000000);
  cfsetospeed(&term,B3000000);
  // Set SmartReader+ in DATA mode.
  term.c_cflag&=~CSIZE;
  term.c_cflag|=CS8;
  if(tcsetattr(fd,TCSADRAIN,&term)==-1) {
    PRINTF(L_GEN_ERROR,"%s: tcsetattr failed: %s",devName,strerror(errno));
    return false;
    }
  return true;
}

// -- cSmartCardSlotCCID -------------------------------------------------------

#ifdef WITH_PCSC
#include <winscard.h>

class cSmartCardSlotCCID : public cSmartCardSlot {
private:
  SCARDCONTEXT hContext;
  SCARDHANDLE hCard;
  DWORD dwProtocol;
  bool needsReOpen;
  //
  int Transmit(const unsigned char *request, int requestlen, unsigned char *answer, int answerlen);
protected:
  virtual bool DeviceOpen(const char *cfg);
  virtual void DeviceClose(void);
  virtual bool DeviceSetMode(int mode, int baud);
  virtual int DeviceRead(unsigned char *mem, int len, int timeout, int initialTimeout=0) { return -1; }
  virtual int DeviceWrite(const unsigned char *mem, int len, int delay=0) { return -1; }
  virtual void DeviceToggleReset(void) {}
  virtual bool DevicePTS(void) { return true; }
  virtual bool DeviceIsInserted(void);
  //
  virtual bool Reset(void);
public:
  cSmartCardSlotCCID(void);
  virtual bool IsoRead(const unsigned char *cmd, unsigned char *data);
  virtual bool IsoWrite(const unsigned char *cmd, const unsigned char *data);
  virtual int RawRead(unsigned char *data, int len, int to=0) { return -1; }
  virtual int RawWrite(const unsigned char *data, int len) { return -1; }
  };

static cSmartCardSlotLinkReg<cSmartCardSlotCCID> __scs_ccid("ccid");

cSmartCardSlotCCID::cSmartCardSlotCCID(void)
{
  singlereset=true;
}

bool cSmartCardSlotCCID::DeviceOpen(const char *cfg)
{
  if(!cfg || sscanf(cfg,"%255[^:]",devName)==1) {
    LONG rv=SCardEstablishContext(SCARD_SCOPE_SYSTEM,NULL,NULL,&hContext);
    PRINTF(L_CORE_SC,"%d: establish context: %lx:%s",slotnum,rv,pcsc_stringify_error(rv));
    if(rv==SCARD_S_SUCCESS) {
      DWORD protocol=SCARD_PROTOCOL_T0|SCARD_PROTOCOL_T1;
      rv=SCardConnect(hContext,devName,SCARD_SHARE_SHARED,protocol,&hCard,&dwProtocol);
      PRINTF(L_CORE_SC,"%d: connect '%s': %lx:%s",slotnum,devName,rv,pcsc_stringify_error(rv));
      if(rv==SCARD_S_SUCCESS) {
        needsReOpen=false;
        return true;
        }
      }
    }
  else PRINTF(L_GEN_ERROR,"bad parameter for cardslot type 'ccid'");
  return false;
}

void cSmartCardSlotCCID::DeviceClose(void)
{
  SCardDisconnect(hCard,SCARD_RESET_CARD);
  SCardReleaseContext(hContext);
}

bool cSmartCardSlotCCID::DeviceSetMode(int mode, int baud)
{
  currMode=mode;
  return true;
}

bool cSmartCardSlotCCID::DeviceIsInserted(void)
{
  BYTE pbAtr[MAX_ATR_SIZE];
  DWORD dwState, dwReaderLen=0, dwAtrLen=sizeof(pbAtr);
  LONG rv=SCardStatus(hCard,NULL,&dwReaderLen,&dwState,&dwProtocol,pbAtr,&dwAtrLen);
  if(rv==SCARD_S_SUCCESS && (dwState&SCARD_NEGOTIABLE)) return true;
  needsReOpen=true;
  return false;
}

bool cSmartCardSlotCCID::Reset(void)
{
  PRINTF(L_CORE_SC,"%d: reseting card (sermode %s)",slotnum,serModes[DeviceCurrentMode()]);
  if(needsReOpen) { DeviceClose(); DeviceOpen(0); }
  DWORD protocol=dwProtocol;
  LONG rv=SCardReconnect(hCard,SCARD_SHARE_EXCLUSIVE,protocol,SCARD_RESET_CARD,&dwProtocol);
  if(rv!=SCARD_S_SUCCESS) {
    PRINTF(L_CORE_SC,"%d: reset failed: %lx:%sn",slotnum,rv,pcsc_stringify_error(rv));
    return false;
    }
  DWORD dwState, dwReaderLen=0, dwAtrLen=sizeof(atr.atr);
  rv=SCardStatus(hCard,NULL,&dwReaderLen,&dwState,&dwProtocol,atr.atr,&dwAtrLen);
  if(rv==SCARD_S_SUCCESS) {
    atr.atrLen=dwAtrLen;
    LDUMP(L_CORE_SC,atr.atr,dwAtrLen,"%d: <- ATR len=%ld:",slotnum,dwAtrLen);
    return true;
    }
  return false;
}

int cSmartCardSlotCCID::Transmit(const unsigned char *request, int requestlen, unsigned char *answer, int answerlen)
{
  SCARD_IO_REQUEST pioRecvPci, pioSendPci;
  switch(dwProtocol) {
    case SCARD_PROTOCOL_T0:
    case SCARD_PROTOCOL_T1:
        pioSendPci.dwProtocol=dwProtocol;
        pioSendPci.cbPciLength=sizeof(pioSendPci);
        pioRecvPci.dwProtocol=dwProtocol;
        pioRecvPci.cbPciLength=sizeof(pioRecvPci);
        break;
    default:
        PRINTF(L_CORE_SC,"%d: protocol failure: %ld",slotnum,dwProtocol);
        return 0;
    }
  DWORD answlen=answerlen;
  DWORD rv=SCardTransmit(hCard,&pioSendPci,(LPCBYTE)request,(DWORD)requestlen,&pioRecvPci,(LPBYTE)answer,&answlen);
  if(rv!=SCARD_S_SUCCESS) {
     PRINTF(L_CORE_SC, "%d: transmit failed: %lx:%s\n",slotnum,rv,pcsc_stringify_error(rv));
     return -1;
     }
  return answlen;
}

bool cSmartCardSlotCCID::IsoRead(const unsigned char *cmd, unsigned char *data)
{
  LDUMP(L_CORE_SC,cmd,CMD_LEN,"%d: -> INS:",slotnum);
  int restlen=Transmit(cmd,CMD_LEN,data,MAX_LEN);
  if(restlen<2) return Test(false);
  sb[0]=data[restlen-2];
  sb[1]=data[restlen-1];
  LDUMP(L_CORE_SC,sb,2,"%d: <- SB: ",slotnum);
  LDUMP(L_CORE_SC,data,restlen-2,"%d: <- DATA:",slotnum);
  return true;
}

bool cSmartCardSlotCCID::IsoWrite(const unsigned char *cmd, const unsigned char *data)
{
  LDUMP(L_CORE_SC,cmd,CMD_LEN,"%d: -> INS:",slotnum);
  LDUMP(L_CORE_SC,data,cmd[LEN_IDX],"%d: -> DATA:",slotnum);
  unsigned char sendbuf[MAX_LEN+CMD_LEN], recvbuf[MAX_LEN];
  memcpy(sendbuf,cmd,CMD_LEN);
  memcpy(sendbuf+CMD_LEN,data,sendbuf[LEN_IDX]);
  int restlen=Transmit(sendbuf,CMD_LEN+sendbuf[LEN_IDX],recvbuf,MAX_LEN);
  if(restlen<2) return Test(false);
  sb[0]=recvbuf[restlen-2];
  sb[1]=recvbuf[restlen-1];
  LDUMP(L_CORE_SC,sb,2,"%d: <- SB: ",slotnum);
  return true;
}

#endif //WITH_PCSC

// -- cSmartCardSlotEmuGeneric -------------------------------------------------

#ifdef CARD_EMU

#define PUSH(mem,len) { memcpy(devBuff+buffCount,(mem),(len)); buffCount+=(len); }
#define PUSHB(b)      { devBuff[buffCount++]=(b); }

class cSmartCardSlotEmuGeneric : public cSmartCardSlot {
protected:
  unsigned char devBuff[1024], nextSW[SB_LEN];
  int buffCount, dataLen, record;
  bool cmdStart, rts, dsr, flag;
  time_t remTime;
  //
  virtual bool DeviceOpen(const char *cfg);
  virtual void DeviceClose(void);
  virtual bool DeviceSetMode(int mode, int baud);
  virtual int DeviceRead(unsigned char *mem, int len, int timeout, int initialTimeout=0);
  virtual void DeviceToggleReset(void);
  virtual bool DevicePTS(void);
  virtual bool DeviceIsInserted(void);
  //
  virtual void EmuPushAtr(void)=0;
  void Flush(void);
  };

bool cSmartCardSlotEmuGeneric::DeviceOpen(const char *cfg)
{
  PRINTF(L_CORE_SERIAL,"%s: open serial port (emulator)",devName);
  PRINTF(L_CORE_SERIAL,"%s: init done",devName);
  buffCount=0; cmdStart=true; rts=false; flag=false;
  remTime=time(0); dsr=true;
  PRINTF(L_CORE_LOAD,"cardslot: added emulated port %s as port %d",devName,slotnum);
  return true;
}

void cSmartCardSlotEmuGeneric::DeviceClose(void)
{
  PRINTF(L_CORE_SERIAL,"%s: shutting down",devName);
}

void cSmartCardSlotEmuGeneric::Flush(void)
{
  buffCount=0;
}

bool cSmartCardSlotEmuGeneric::DeviceSetMode(int mode, int baud)
{
  currMode=mode;
  Flush();
  return true;
}

int cSmartCardSlotEmuGeneric::DeviceRead(unsigned char *mem, int len, int timeout, int initialTimeout)
{
  PRINTF(L_CORE_SERIAL,"%s: read len=%d timeout=%d",devName,len,timeout);
  if(len<0) {
    len=-len;
    if(buffCount<len) len=buffCount;
    }
  if(buffCount<len) return -2; // timeout
  memcpy(mem,devBuff,len);
  memmove(devBuff,devBuff+len,buffCount-len);
  buffCount-=len;
  return len;
}

void cSmartCardSlotEmuGeneric::DeviceToggleReset(void)
{
  rts=!rts;
  if(!rts) {
    EmuPushAtr();
    PRINTF(L_CORE_SERIAL,"%s: toggle RTS, now off",devName);
    }
  else { PRINTF(L_CORE_SERIAL,"%s: toggle RTS, now on",devName); }
}

bool cSmartCardSlotEmuGeneric::DevicePTS(void)
{
  return true;
}

bool cSmartCardSlotEmuGeneric::DeviceIsInserted(void)
{
#if 0
  if(time(0)>=remTime+30) {
    dsr=!dsr;
    remTime=time(0);
    }
#endif
  return dsr;
}

// -- cSmartCardSlotEmuSeca ----------------------------------------------------

class cSmartCardSlotEmuSeca : public cSmartCardSlotEmuGeneric {
protected:
  virtual int DeviceWrite(const unsigned char *mem, int len, int delay=0);
  virtual void EmuPushAtr(void);
public:
  cSmartCardSlotEmuSeca(void);
  };

static cSmartCardSlotLinkReg<cSmartCardSlotEmuSeca> __scs_emuseca("emuseca");

cSmartCardSlotEmuSeca::cSmartCardSlotEmuSeca(void)
{
  strcpy(devName,"emuseca");
}

int cSmartCardSlotEmuSeca::DeviceWrite(const unsigned char *mem, int len, int delay)
{
  PRINTF(L_CORE_SERIAL,"%s: write len=%d delay=%d",devName,len,delay);
  Flush();
  cCondWait::SleepMs(300);
  PUSH(mem,len); // echo back
  //---
  if(cmdStart && len==CMD_LEN) { // new INS
    PUSHB(mem[INS_IDX]); // ACK byte
    cmdStart=false;
    dataLen=mem[LEN_IDX];
    unsigned char data[256];
    memset(data,0,sizeof(data));
    nextSW[0]=0x90; nextSW[1]=0x00;
    bool readcmd=false;
    switch(mem[0]*256+mem[1]) {
      case 0xc13a:
      case 0xc10e:
        readcmd=true;
        break;
      case 0xc116:
        data[3]=0x04;
        readcmd=true;
        break;
      case 0xc112:
        data[1]=0x64;
        data[22]=0x1d; data[23]=0x84;
        readcmd=true;
        break;
      case 0xc132:
        data[1]=0xFF; data[2]=0xFF; data[3]=0xFF; data[4]=0xFF;
        data[5]=0xFF; data[6]=0xFF; data[7]=0xFF; data[8]=0xFF;
        readcmd=true;
        break;
      }
    if(readcmd) {
      PUSH(data,dataLen);
      PUSH(nextSW,2);
      cmdStart=true;
      }
    }
  else {
    dataLen-=len;
    if(dataLen<=0 && !cmdStart) {
      PUSH(nextSW,2);
      cmdStart=true;
      }
    }
  //---
  return len;
}

void cSmartCardSlotEmuSeca::EmuPushAtr(void)
{
  static const unsigned char atr[] = { 0x3b,0x77,0x12,0x00,0x00,
                                       0x60,0x60,0x03,0x0E,0x6C,0xB6,0xD6 };
  PUSH(atr,sizeof(atr));
}

// -- cSmartCardSlotEmuCrypto --------------------------------------------------

class cSmartCardSlotEmuCrypto : public cSmartCardSlotEmuGeneric {
protected:
  virtual int DeviceWrite(const unsigned char *mem, int len, int delay=0);
  virtual void EmuPushAtr(void);
public:
  cSmartCardSlotEmuCrypto(void);
  };

static cSmartCardSlotLinkReg<cSmartCardSlotEmuCrypto> __scs_emucrypto("emucrypto");

cSmartCardSlotEmuCrypto::cSmartCardSlotEmuCrypto(void)
{
  strcpy(devName,"emucrypto");
}

int cSmartCardSlotEmuCrypto::DeviceWrite(const unsigned char *mem, int len, int delay)
{
  PRINTF(L_CORE_SERIAL,"%s: write len=%d delay=%d",devName,len,delay);
  Flush();
  cCondWait::SleepMs(300);
  PUSH(mem,len); // echo back
  //---
  if(cmdStart && len==CMD_LEN) { // new INS
    cmdStart=false;
    dataLen=mem[LEN_IDX];
    unsigned char data[256];
    memset(data,0,sizeof(data));
    nextSW[0]=0x90; nextSW[1]=0x00;
    bool readcmd=false;
    switch(mem[0]*256+mem[1]) {
      case 0xa4a4:
        switch(mem[5]*256+mem[6]) {
          case 0x2f01:
          case 0x0f00:
          case 0x0f20:
          //case 0x0f40:
          case 0x0f60:
          case 0x0e11:
          case 0x1f88:
          case 0x1f8c: nextSW[0]=0x9f; nextSW[1]=0x11; break;
          default:     nextSW[0]=0x94; nextSW[1]=0x04; break;
          }
        break;
      case 0xa4a2:
        if(mem[2]==1) {
          if(mem[4]==3) {
            record=0x01;
            nextSW[0]=0x9f; nextSW[1]=0x26;
            }
          else {
            record=0x02;
            nextSW[0]=0x9f; nextSW[1]=0x42;
            }
          }
        else {
          record=mem[5];
          switch(record) {
            case 0x80: nextSW[0]=0x9f; nextSW[1]=0x07; break;
            case 0xD1: nextSW[0]=0x9f; nextSW[1]=0x04; break;
            case 0x9F: nextSW[0]=0x9f; nextSW[1]=0x03; break;
            case 0x9E: nextSW[0]=0x9f; nextSW[1]=0x42; break;
            case 0xD6:
            case 0xC0: nextSW[0]=0x9f; nextSW[1]=0x12; break;
            default:   nextSW[0]=0x94; nextSW[1]=0x02; break;
            }
          }
        break;
      case 0xa4b2:
        readcmd=true;
        switch(record) {
          case 0x01:
            if(mem[3]==1) {
              nextSW[0]=0x94; nextSW[1]=0x02;
              dataLen=0;
              }
            else {
              dataLen=0x26;
              static const unsigned char resp[0x26] = {
                0x83,0x01,0x88,
                0x8c,0x03,0x40,0x30,0x40,
                0x8d,0x04,0x16,0xac,0x16,0xba,
                0xd5,0x10,'D','u','m','m','y',0,0,0,0,0,0,0,0x12,0x34,0x56,0x67,
                0x8f,0x01,0x55,
                0x91,0x01,0x40
                };
              memcpy(data,resp,sizeof(resp));
              }
            break;
          case 0x02:
            if(mem[3]==1) {
              nextSW[0]=0x94; nextSW[1]=0x02;
              dataLen=0;
              }
            else {
              dataLen=0x42;
              static const unsigned char resp[0x42] = {
                0x83,0x01,0x88,
                0x8c,0x03,0xA0,0x30,0x40,
                0x8d,0x04,0x16,0xac,0x16,0xba,
                0xd5,0x10,'D','u','m','m','y',0,0,0,0,0,0,0,0x12,0x34,0x56,0x67,
                0x92,0x20,0x00 // ...
                };
              memcpy(data,resp,sizeof(resp));
              }
            break;
          case 0x80:
            dataLen=0x07;
            data[0]=0x80; data[1]=0x05; data[2]=0x5c; data[3]=0x0c;
            data[4]=0x00; data[5]=0xec; data[6]=0x0a;
            break;
          case 0xD1:
            dataLen=0x04;
            data[0]=0xd1; data[1]=0x02; data[2]=0x0d; data[3]=0x22;
            break;
          case 0x9F:
            dataLen=0x03;
            data[0]=0x9f; data[1]=0x01; data[2]=0x88;
            break;
          case 0x9E:
            {
            dataLen=0x42;
            static const unsigned char resp[0x42] = {
              0x9E,0x40,
              0x28,0xFE, 
              };
            memcpy(data,resp,sizeof(resp));
            flag=true;
            break;
            }
          case 0xC0:
          case 0xD6:
            dataLen=0x12;
            data[0]=record;
            data[1]=0x10;
            memset(data+2,0,16);
            strcpy((char *)data+2,"Dum Issuer");
            break;
          }
        break;
      case 0xa4b8:
        readcmd=true;
        if(mem[2]==0) {
          dataLen=0x0C;
          memset(data,0,0x0c);
          data[0]=0xDF; data[1]=0x0A; data[4]=0xDF; data[5]=0x88;
          }
        else {
          dataLen=0;
          nextSW[0]=0x94; nextSW[1]=0x02;
          }
        break;
      case 0xa44c:
        nextSW[0]=0x9f; nextSW[1]=flag ? 0x42 : 0x1c;
        break;
      case 0xa4c0:
        readcmd=true;
        if(mem[4]==0x1c) {
          data[0]=0xdb; data[1]=0x10;
          memset(&data[2],0x45,16);
          data[18]=0xdf; data[19]=0x08; data[20]=0x50; data[23]=0x80;
          }
        else if(mem[4]==0x11) {
          memset(data,0,0x11);
          data[0]=0xdf; data[1]=0x0f; data[6]=0x3f; data[7]=0x6a;
          }
        else if(mem[4]==0x42) {
          static const unsigned char resp[0x42] = {
            0xdf,0x40,
            0x6d,0xbb,0x81, // ...
            };
          memcpy(data,resp,sizeof(resp));
          }
        break;
      }
    if(readcmd) {
      if(dataLen>0) {
        PUSHB(mem[INS_IDX]); // ACK byte
        PUSH(data,dataLen);
        }
      PUSH(nextSW,2);
      cmdStart=true;
      }
    else {
      PUSHB(mem[INS_IDX]); // ACK byte
      }
    }
  else {
    dataLen-=len;
    if(dataLen<=0 && !cmdStart) {
      PUSH(nextSW,2);
      cmdStart=true;
      }
    }
  //---
  return len;
}

void cSmartCardSlotEmuCrypto::EmuPushAtr(void)
{
  static const unsigned char atr[] = { 0x3B,0x78,0x12,0x00,0x00,
                                       0x65,0xC4,0x05,0x05,0x8F,0xF1,0x90,0x00 };
  PUSH(atr,sizeof(atr));
}

// -- cSmartCardSlotEmuIrdeto --------------------------------------------------

class cSmartCardSlotEmuIrdeto : public cSmartCardSlotEmuGeneric {
private:
  bool acs384;
protected:
  virtual bool DeviceOpen(const char *cfg);
  virtual int DeviceWrite(const unsigned char *mem, int len, int delay=0);
  virtual void EmuPushAtr(void);
public:
  cSmartCardSlotEmuIrdeto(void);
  };

static cSmartCardSlotLinkReg<cSmartCardSlotEmuIrdeto> __scs_emuirdeto("emuirdeto");

cSmartCardSlotEmuIrdeto::cSmartCardSlotEmuIrdeto(void)
{
  strcpy(devName,"emuirdeto");
  acs384=false;
}

bool cSmartCardSlotEmuIrdeto::DeviceOpen(const char *cfg)
{
  char acs[32];
  if(sscanf(cfg,"%31[^:]",acs)>=0) {
    if(!strcasecmp(acs,"acs384")) acs384=true;
    else if(!strcasecmp(acs,"acs383")) acs384=false;
    else {
      PRINTF(L_GEN_ERROR,"unknown ACS type");
      return false;
      }
    return cSmartCardSlotEmuGeneric::DeviceOpen(0);
    }
  else PRINTF(L_GEN_ERROR,"bad parameter for cardslot type '%s'",devName);
  return false;
}

int cSmartCardSlotEmuIrdeto::DeviceWrite(const unsigned char *mem, int len, int delay)
{
  PRINTF(L_CORE_SERIAL,"%s: write len=%d delay=%d",devName,len,delay);
  Flush();
  cCondWait::SleepMs(300);
  PUSH(mem,len); // echo back
  //---
  static const struct Resp {
    unsigned int cmd;
    int acs;
    unsigned char data[MAX_LEN];
    } resp[] = {
  { 0x01020203,0x384,
    {0x01,0x02,0x00,0x00,0x02,0x00,0x00,0x10,0x03,0x84,0x00,0x00,0x00,0x17,0x02,0x00,0x00,0x00,0x00,0x00,0x00,0x47,0x45,0x52} },
  { 0x01020E02,0x384,
    {0x01,0x02,0x00,0x00,0x0e,0x02,0x00,0x40,0xa9,0x6d,0x73,0x97,0x9e,0xfc,0x9b,0x8e,0x5b,0x8c,0xfa,0xb2,0x0c,0xb2,0x57,0x0f,0xb2,0xf7,0x29,0x4e,0xa2,0xcb,0xbd,0x5b,0x52,0x74,0xb1,0x2a,0xb7,0xc5,0xd9,0x62,0x6d,0x37,0x6d,0x9d,0xa3,0xe9,0x61,0xbb,0x1b,0x2b,0x56,0xb7,0x86,0x0c,0xe6,0xb1,0x07,0x6f,0xe0,0xf8,0x8a,0xd3,0x05,0x83,0xf6,0x53,0x0e,0xd2,0x72,0xd5,0xc1,0x50} },
  { 0x01020E03,0x384,
    {0x01,0x02,0x00,0x00,0x0e,0x03,0x00,0x40,0xb6,0xde,0xa8,0xce,0x86,0x1c,0x42,0x72,0xa8,0x16,0x4b,0xf9,0xce,0x33,0xb5,0x43,0xd0,0x50,0xe6,0xa7,0xf1,0xcb,0x55,0x25,0x97,0x13,0xee,0x62,0x98,0xe7,0x17,0x50,0xeb,0x3b,0x59,0x10,0x0a,0xb6,0x2e,0x93,0x61,0x71,0x3c,0xe6,0xe2,0x2c,0x1e,0x7d,0xbd,0x6a,0x49,0xbb,0x04,0x5b,0xdf,0x2f,0xb7,0xa7,0x93,0xe0,0x3d,0x40,0x4e,0xd1} },
  //
  { 0x01020203,0x383,
    {0x01,0x02,0x00,0x00,0x02,0x00,0x00,0x10,0x03,0x83,0x00,0x00,0x00,0x17,0x02,0x00,0x00,0x00,0x00,0x00,0x00,0x47,0x45,0x52} },
  { 0x01020E02,0x383,
    {0x01,0x02,0x00,0x00,0x0E,0x02,0x00,0x40,0x65,0xEF,0xD0,0xA7,0xF3,0x80,0x48,0x0E,0xC1,0x4B,0x41,0x6C,0xDB,0x68,0x47,0xE4,0x23,0xAD,0x96,0x12,0x07,0x58,0x58,0x29,0xE9,0x14,0x27,0x7F,0x7D,0xF8,0xC2,0x65,0x76,0x4D,0x75,0x04,0x7C,0x9B,0xAA,0x99,0x58,0xEA,0xE2,0x43,0xB5,0x03,0x05,0xD6,0x62,0x99,0xF5,0x18,0x16,0x4E,0xCF,0x49,0x11,0xBD,0xF3,0xEE,0xC3,0xCD,0x90,0x3B} },
  { 0x01020E03,0x383,
    {0x01,0x02,0x00,0x00,0x0E,0x03,0x00,0x40,0x9B,0x06,0xB5,0x0A,0x98,0xC6,0x2E,0x1D,0x71,0xA1,0xE8,0x84,0xAE,0x98,0x57,0xE9,0xE6,0xC2,0x97,0x46,0x25,0x7A,0x2B,0xA1,0xD5,0x33,0x18,0xDE,0x16,0xC1,0xAB,0x22,0x2C,0xC2,0x11,0x24,0x81,0x11,0xA8,0x39,0xE3,0xB1,0xDB,0x33,0x1A,0x93,0x31,0xB0,0x61,0xD8,0xDE,0x92,0x1F,0x29,0x20,0xD0,0x9E,0x0F,0x6A,0xF0,0x7C,0xBA,0xCD,0xCC} },
  //
  { 0x01020003,0x0,
    {0x01,0x02,0x00,0x00,0x00,0x03,0x00,0x14,0x37,0x30,0x31,0x32,0x30,0x36,0x39,0x33,0x34,0x37,0x32,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00} },
  { 0x01020103,0x0,
    {0x01,0x02,0x00,0x00,0x01,0x00,0x00,0x10,0x00,0x17,0x00,0x00,0x01,0x00,0x17,0x00,0x00,0x01,0x04,0x00,0xF3,0x86,0x01,0x1A} },
  { 0x01021100,0x0,
    {0x01,0x02,0x58,0x00,0x11,0x00,0x00,0x00} },
  { 0x01020903,0x0,
    {0x01,0x02,0x55,0x00,0x09,0x03,0x00,0x00} },
  { 0x01020303,0x0,
    {0x01,0x02,0x00,0x00,0x03,0x03,0x02,0x18,0x0F,0xFF,0xFF,0xFF,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x31,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00} },
  { 0x01020400,0x0,
    {0x01,0x02,0x54,0x00,0x04,0x00,0x00,0x00} },
  { 0x01050000,0x0,
    {0x01,0x05,0x9D,0x00,0x38,0x00,0x02,0x16,0x00,0x01,0x00,0x13,0xFF,0xFF,0x22,0x88,0xBF,0x02,0x70,0xFA,0x5F,0x80,0xFD,0x1E,0xD4,0xD6,0xF0,0xF1,0x81,0xB3} },
  { 0x01010000,0x0,
    {0x01,0x01,0x00,0x00,0x00,0x00,0x00,0x03,0x00,0x00,0xFF} },
  { 0x00000000,0x0, // don't delete this one
    {} }
  };
  const unsigned int cmd=(mem[0]<<24) + (mem[1]<<16) + (mem[2]<<8) + mem[3];
  const struct Resp *r=&resp[0];
  int acs=acs384 ? 0x384:0x383;
  while(1) {
    if(!r->cmd) {
      static const unsigned char fail[] = { 0x01,0x99,0x6f };
      PUSH(fail,sizeof(fail));
      break;
      }
    if(cmd==r->cmd && (!r->acs || r->acs==acs)) {
      const int len=r->data[7]+9-1;
      int cs=0x3f;
      for(int i=0 ; i<len ; i++) cs ^= r->data[i];
      PUSH(r->data,len);
      PUSHB(cs);
      break;
      }
    r++;
    }
  //---
  return len;
}

void cSmartCardSlotEmuIrdeto::EmuPushAtr(void)
{
  static const unsigned char atr384[] = { 0x3B,0x9F,0x21,0x0E,
                                          0x49,0x52,0x44,0x45,0x54,0x4f,0x20,0x41,0x43,0x53,0x03,0x84,0x55,0xff,0x80,0x6d };
  static const unsigned char atr383[] = { 0x3B,0x9F,0x21,0x0E,
                                          0x49,0x52,0x44,0x45,0x54,0x4F,0x20,0x41,0x43,0x53,0x03,0x83,0x95,0x00,0x80,0x55 };
  if(acs384) PUSH(atr384,sizeof(atr384))
  else       PUSH(atr383,sizeof(atr383))
}

// -- cSmartCardSlotEmuNagra --------------------------------------------------

class cSmartCardSlotEmuNagra : public cSmartCardSlotEmuGeneric {
private:
  int toggle;
  int dt_count[16];
protected:
  virtual void DeviceToggleReset(void);
  virtual int DeviceWrite(const unsigned char *mem, int len, int delay=0);
  virtual void EmuPushAtr(void);
public:
  cSmartCardSlotEmuNagra(void);
  };

static cSmartCardSlotLinkReg<cSmartCardSlotEmuNagra> __scs_emunagra("emunagra");

cSmartCardSlotEmuNagra::cSmartCardSlotEmuNagra(void)
{
  strcpy(devName,"emunagra");
  toggle=0;
  memset(dt_count,0,sizeof(dt_count));
}

void cSmartCardSlotEmuNagra::DeviceToggleReset(void)
{
  toggle=0;
  memset(dt_count,0,sizeof(dt_count));
  cSmartCardSlotEmuGeneric::DeviceToggleReset();
}

int cSmartCardSlotEmuNagra::DeviceWrite(const unsigned char *mem, int len, int delay)
{
  PRINTF(L_CORE_SERIAL,"%s: write len=%d delay=%d",devName,len,delay);
  Flush();
  cCondWait::SleepMs(100);
  PUSH(mem,len); // echo back

// for this sample data:
// BOXKEY:  BB99FF99BB997788
// CARDMOD: 9A2AE686F360A8F63B679E05443FE32969DE606A8521A48003A9C904F53FCE34D6D62B3DA6A9EF090556559068B4B127213A6EC310E629AEA7286D6B46AB6519
// -> SESSKEY: 9d2cd4cbc4b22bdf65c5c2d8506a2927
  static const struct Resp {
    int cmd, cc;
    unsigned int idata;
    unsigned char data[MAX_LEN];
    } resp[] = {
/* status */  { 0xC0, 0,0x00000000, { 0x08,0xb0,0x04,0x00,0x13,0x00,0x20,0x90,0x00 } },
/* datetim */ { 0xC8, 0,0x00000000, { 0x08,0xb8,0x04,0x00,0x00,0x00,0x00,0x90,0x00 } },
/* card ID*/  { 0x12, 0,0x00000000, { 0x08,0x92,0x04,0x71,0x2A,0x3B,0x4C,0x90,0x00 } },
/* IRDINFO */ { 0x22, 0,0x00000000, { 0x3b,0xA2,0x37,0x2A,0xFF,0x90,0x00,0x00,0x00,0x01,0x01,0xE9,0x01,0x01,0x01,0x12,0x3B,0x4F,0x5C,0x00,0x00,0x00,0x01,0x60,0x62,0x18,0x7A,0xA8,0xBE,0x10,0x5C,0x4F,0x3B,0x12,0x31,0x37,0x42,0x42,0x44,0x41,0x4C,0x44,0x50,0x34,0x35,0x32,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/*  */        { 0x22,-1,0x00000080, { 0x3b,0xa2,0x37,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/* DT01 */    { 0x22, 0,0x00000001, { 0x10,0xa2,0x0c,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/* DT04 */    { 0x22, 0,0x00000004, { 0x46,0xa2,0x42,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/*  */        { 0x22,-1,0x00000084, { 0x46,0xa2,0x42,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/* TIERS */   { 0x22, 0,0x00000005, { 0x59,0xa2,0x55,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/*  */        { 0x22,-1,0x00000085, { 0x59,0xa2,0x55,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/* DT06 */    { 0x22, 0,0x00000006, { 0x18,0xa2,0x14,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/* CAMDATA */ { 0x22, 0,0x00000008, { 0x57,0xa2,0x53,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/*  */        { 0x22,-1,0x00000088, { 0x57,0xa2,0x53,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x00,0x90,0x00 } },
/* CMD 26 */  { 0x26, 0,0x123b4f5c, { 0x44,0xa6,0x40,0xa1,0x36,0x96,0xdc,0x3d,0x43,0x98,0xc9,0xd3,0xda,0x73,0xca,0x67,0x37,0x75,0xf0,0x29,0x33,0x6c,0xf9,0x2c,0xb4,0xdd,0x0e,0x18,0xaf,0x9e,0x24,0xb8,0x56,0xa2,0x04,0xd9,0xbf,0x7b,0xf5,0xc2,0x64,0xc4,0x61,0xd0,0xce,0x33,0xa7,0x13,0x56,0x68,0xcd,0xb2,0xa5,0x54,0x04,0xce,0x79,0x72,0x1a,0xde,0x9a,0xc4,0x92,0x2c,0x49,0x4f,0x85,0x90,0x00 } },
/* CMD 27 */  { 0x27, 0,0xfecd819a, { 0x04,0xa7,0x00,0x90,0x00 } },
// don't remove this one
/* END */     { 0xFF, 0,0x00000000, { 0x0 }} };

  unsigned char *rmem=AUTOMEM(len);
  memcpy(rmem,mem,len);
  Invert(rmem,len);

  unsigned char buff[MAX_LEN+16];
  int c=0;
  if(rmem[0]==0x21 && rmem[1]==0xc1) { // IFS
    buff[c++]=0x12;
    buff[c++]=0x00;
    buff[c++]=0x00;
    buff[c++]=0x00;
    }
  else {
    int cmd=rmem[8], ilen=rmem[9];
    unsigned int idata=0;
    if(ilen>0) {
      if(ilen>4) ilen=4;
      for(int i=0; i<ilen; i++) idata=(idata<<8) | rmem[10+i];
      }
    bool isdt = (cmd==0x22);
    for(const struct Resp *r=&resp[0]; 1 ;r++) {
      if(r->cmd==0xFF) {
        static const unsigned char fail[] = { 0x12,0x82,0x00,0x90 };
        c=sizeof(fail);
        memcpy(buff,fail,c);
        break;
        }
      if(cmd==r->cmd && idata==r->idata && (!isdt || dt_count[idata&0xF]==r->cc || r->cc<0)) {
        buff[c++]=0x12;
        buff[c++]=toggle; toggle^=0x40;
        unsigned int l=r->data[0]+1;
        memcpy(&buff[c],r->data,l);
        c+=l;
        if(isdt) {
          dt_count[idata&0xF]++;
          PRINTF(L_CORE_SERIAL,"%s: dt%02x count now %d",devName,idata&0xf,dt_count[idata&0xF]);
          }
        break;
        }
      }
    }
  if(c>0) {
    buff[c]=XorSum(buff,c); c++;
    Invert(buff,c);
    PUSH(buff,c);
    }
  return len;
}

void cSmartCardSlotEmuNagra::EmuPushAtr(void)
{
  static const unsigned char atr[] = { 0x03,0x00,0x56,0xff,0x00,0x76,0x7e,0x71,0x80,0x1d,0xff,0xdd,0x8d,0x7d,0x35,0xf5,0xb3,0xd3,0x73,0xfb,0xdd,0x31,0xe9,0xed,0xf3,0x33,0x9f };
  PUSH(atr,sizeof(atr))
}

#endif // CARD_EMU

// -- cInfoStr -----------------------------------------------------------------

cInfoStr::cInfoStr(void)
:cLineBuff(256)
{
  current=0;
}

cInfoStr::~cInfoStr()
{
  free(current);
}

bool cInfoStr::Get(char *buff, int len)
{
  cMutexLock lock(&mutex);
  if(current && current[0]) {
    strn0cpy(buff,current,len);
    return true;
    }
  return false;
}

void cInfoStr::Begin(void)
{
  Flush();
}

void cInfoStr::Finish()
{
  cMutexLock lock(&mutex);
  free(current);
  current=Grab();
}

// -- cSmartCardData -----------------------------------------------------------

cSmartCardData::cSmartCardData(int Ident)
{
  ident=Ident;
}

// -- cSmartCardDatas ----------------------------------------------------------

class cSmartCardDatas : public cStructList<cSmartCardData> {
protected:
  virtual cStructItem *ParseLine(char *line);
public:
  cSmartCardDatas(void);
  cSmartCardData *Find(cSmartCardData *param);
  };

static cSmartCardDatas carddatas;

cSmartCardDatas::cSmartCardDatas(void)
:cStructList<cSmartCardData>("smartcard data","smartcard.conf",SL_MISSINGOK|SL_WATCH|SL_VERBOSE)
{}

cSmartCardData *cSmartCardDatas::Find(cSmartCardData *param)
{
  ListLock(false);
  cSmartCardData *cd;
  for(cd=First(); cd; cd=Next(cd))
    if(cd->Ident()==param->Ident() && cd->Matches(param)) break;
  ListUnlock();
  return cd;
}

cStructItem *cSmartCardDatas::ParseLine(char *line)
{
  char *r=index(line,':');
  if(r)
    for(cSmartCardLink *scl=smartcards.First(); scl; scl=smartcards.Next(scl))
      if(!strncasecmp(scl->Name(),line,r-line)) {
        cSmartCardData *scd=scl->CreateData();
        if(scd && scd->Parse(r+1)) return scd;
        delete scd;
        break;
        }
  return 0;
}

// -- cSmartCard ---------------------------------------------------------------

cSmartCard::cSmartCard(const struct CardConfig *Cfg, const struct StatusMsg *Msg)
{
  msg=Msg;
  slot=0; sb=0; atr=0; idStr[0]=0; cardUp=false;
  NewCardConfig(Cfg);
}

void cSmartCard::NewCardConfig(const struct CardConfig *Cfg)
{
  cfg=Cfg;
  if(slot) slot->SetCardConfig(cfg);
}

bool cSmartCard::GetCardIdStr(char *str, int len)
{
  strn0cpy(str,idStr,len);
  return (str[0]!=0);
}

bool cSmartCard::GetCardInfoStr(char *str, int len)
{
  return infoStr.Get(str,len);
}

bool cSmartCard::Setup(cSmartCardSlot *Slot, int sermode, const struct Atr *Atr, unsigned char *Sb)
{
  slot=Slot; atr=Atr; sb=Sb;
  slotnum=slot->SlotNum(); slot->SetCardConfig(cfg);
  cardUp=false;
  if(cfg->SerMode==sermode && Init()) cardUp=true;
  return cardUp;
}

int cSmartCard::SerRead(unsigned char *data, int len, int to)
{
  if(atr->T==1 || atr->T==14) return slot->RawRead(data,len,to);
  PRINTF(L_CORE_SC,"%d: SerRead() not allowed for ISO compliant cards (T=%d)",slotnum,atr->T);
  return -1;
}

int cSmartCard::SerWrite(const unsigned char *data, int len)
{
  if(atr->T==1 || atr->T==14) return slot->RawWrite(data,len);
  PRINTF(L_CORE_SC,"%d: SerWrite() not allowed for ISO compliant cards (T=%d)",slotnum,atr->T);
  return -1;
}

bool cSmartCard::IsoRead(const unsigned char *cmd, unsigned char *data)
{
  if(atr->T==0) return slot->IsoRead(cmd,data);
  PRINTF(L_CORE_SC,"%d: can't IsoRead() from incompatible card (T=%d)",slotnum,atr->T);
  return false;
}

bool cSmartCard::IsoWrite(const unsigned char *cmd, const unsigned char *data)
{
  if(atr->T==0) return slot->IsoWrite(cmd,data);
  PRINTF(L_CORE_SC,"%d: can't IsoWrite() to incompatible card (T=%d)",slotnum,atr->T);
  return false;
}

bool cSmartCard::Status(void)
{
  const struct StatusMsg *m=msg;
  while(m->sb[0]!=0xFF) {
    if(sb[0]==m->sb[0] && (m->sb[1]==0xFF || sb[1]==m->sb[1])) {
      if(!m->retval) PRINTF(L_CORE_SC,"%d: %s (status: %02x %02x)",slotnum,m->message,sb[0],sb[1]);
      return m->retval;
      }
    m++;
    }
  PRINTF(L_CORE_SC,"%d: unknown (status: %02x %02x)",slotnum,sb[0],sb[1]);
  return false;
}

int cSmartCard::CheckSctLen(const unsigned char *data, int off)
{
  int l=SCT_LEN(data);
  if(l+off > MAX_LEN) {
    PRINTF(L_CORE_SC,"section too long %d > %d",l,MAX_LEN-off);
    l=-1;
    }
  return l;
}

void cSmartCard::CaidsChanged(void)
{
  cGlobal::CaidsChanged();
}

// -- cSmartCardLink -----------------------------------------------------------

cSmartCardLink::cSmartCardLink(const char *Name, int Id)
{
  name=Name; id=Id;
  cSmartCards::Register(this);
}

// -- cSmartCards --------------------------------------------------------------

cSmartCardLink *cSmartCards::first=0;

cSmartCards smartcards;

void cSmartCards::Register(cSmartCardLink *scl)
{
  PRINTF(L_CORE_DYN,"registering %s smartcard (id %x)",scl->name,scl->id);
  scl->next=first;
  first=scl;
}

void cSmartCards::Shutdown(void)
{
  carddatas.SafeClear();
  cardslots.SafeClear();
}

void cSmartCards::Disable(void)
{
  carddatas.Disable();
  cardslots.Disable();
}

cSmartCardData *cSmartCards::FindCardData(cSmartCardData *param)
{
  return carddatas.Find(param);
}

bool cSmartCards::HaveCard(int id)
{
  bool res=false;
  for(cSmartCardSlot *slot=cardslots.FirstSlot(); slot; slot=cardslots.Next(slot))
    if(slot->HaveCard(id)) { res=true; break; }
  cardslots.Release();
  return res;
}

cSmartCard *cSmartCards::LockCard(int id)
{
  cSmartCard *sc=0;
  for(cSmartCardSlot *slot=cardslots.FirstSlot(); slot; slot=cardslots.Next(slot))
    if((sc=slot->LockCard(id))) break;
  cardslots.Release();
  return sc;
}

void cSmartCards::ReleaseCard(cSmartCard *sc)
{
  for(cSmartCardSlot *slot=cardslots.FirstSlot(); slot; slot=cardslots.Next(slot))
    slot->ReleaseCard(sc);
  cardslots.Release();
}

bool cSmartCards::ListCard(int num, char *str, int len)
{
  cSmartCardSlot *slot=cardslots.GetSlot(num);
  str[0]=0;
  bool res=false;
  if(slot) { slot->GetCardIdStr(str,len); res=true; }
  cardslots.Release();
  return res;
}

bool cSmartCards::CardInfo(int num, char *str, int len)
{
  cSmartCardSlot *slot=cardslots.GetSlot(num);
  str[0]=0;
  bool res=false;
  if(slot) res=slot->GetCardInfoStr(str,len);
  cardslots.Release();
  return res;
}

void cSmartCards::CardReset(int num)
{
  cSmartCardSlot *slot=cardslots.GetSlot(num);
  if(slot) slot->TriggerReset();
  cardslots.Release();
}