crypthead.c

Go to the documentation of this file.

/***************************************************************************
    begin       : Mon Dec 01 2008
    copyright   : (C) 2008 by Martin Preuss
    email       : martin@libchipcard.de

 ***************************************************************************
 *          Please see toplevel file COPYING for license details           *
 ***************************************************************************/

#ifdef HAVE_CONFIG_H
# include <config.h>
#endif

#define DISABLE_DEBUGLOG


#include "crypthead_p.h"
#include "i18n_l.h"
#include <gwenhywfar/misc.h>
#include <gwenhywfar/debug.h>
#include <gwenhywfar/tag16.h>


GWEN_LIST_FUNCTIONS(GWEN_CRYPTHEAD, GWEN_CryptHead)


GWEN_CRYPTHEAD *GWEN_CryptHead_new(void) {
  GWEN_CRYPTHEAD *ch;

  GWEN_NEW_OBJECT(GWEN_CRYPTHEAD, ch);

  return ch;
}



void GWEN_CryptHead_free(GWEN_CRYPTHEAD *ch) {
  if (ch) {
    free(ch->keyName);
    if (ch->pKey &&ch->lKey)
      free(ch->pKey);
    GWEN_FREE_OBJECT(ch);
  }
}



GWEN_CRYPTHEAD *GWEN_CryptHead_fromBuffer(const uint8_t *p, uint32_t l) {
  if (p==NULL || l<1) {
    DBG_INFO(GWEN_LOGDOMAIN, "Bad tag");
    return NULL;
  }
  else {
    GWEN_CRYPTHEAD *ch;
    const uint8_t *sp;
    uint32_t sl;

    ch=GWEN_CryptHead_new();
    sp=p;
    sl=l;
    while(sl) {
      GWEN_TAG16 *subtag;
      uint32_t subtagLen;
      const char *subtagPtr;
      int i;

      subtag=GWEN_Tag16_fromBuffer2(sp, sl, 0);
      if (subtag==NULL) {
        DBG_INFO(GWEN_LOGDOMAIN, "Bad sub-tag");
        GWEN_CryptHead_free(ch);
        return NULL;
      }
      subtagLen=GWEN_Tag16_GetTagLength(subtag);
      subtagPtr=(const char*)GWEN_Tag16_GetTagData(subtag);

      if (subtagLen && subtagPtr) {
        switch(GWEN_Tag16_GetTagType(subtag)) {

        case GWEN_CRYPTHEAD_TLV_KEYNAME:
          ch->keyName=(char*)malloc(subtagLen+1);
          memmove(ch->keyName, subtagPtr, subtagLen);
          ch->keyName[subtagLen]=0;
          break;

        case GWEN_CRYPTHEAD_TLV_KEYNUM:
          if (sscanf(subtagPtr, "%d", &i)==1)
            ch->keyNumber=i;
          break;

        case GWEN_CRYPTHEAD_TLV_KEYVER:
          if (sscanf(subtagPtr, "%d", &i)==1)
            ch->keyVersion=i;
          break;

        case GWEN_CRYPTHEAD_TLV_KEY:
          ch->pKey=(uint8_t*)malloc(subtagLen);
          assert(ch->pKey);
          memmove(ch->pKey, subtagPtr, subtagLen);
          ch->lKey=subtagLen;
          break;

        case GWEN_CRYPTHEAD_TLV_CRYPTPROFILE:
          if (sscanf(subtagPtr, "%d", &i)==1)
            ch->cryptProfile=i;
          break;

        default:
          DBG_WARN(GWEN_LOGDOMAIN, "Unknown tag %02x", GWEN_Tag16_GetTagType(subtag));
        }
      }

      sp+=GWEN_Tag16_GetTagSize(subtag);
      sl-=GWEN_Tag16_GetTagSize(subtag);
      GWEN_Tag16_free(subtag);
    } /* while */

    return ch;
  }

}



int GWEN_CryptHead_toBuffer(const GWEN_CRYPTHEAD *ch, GWEN_BUFFER *buf, uint8_t tagType) {
  char numbuf[32];
  uint32_t pos;
  uint8_t *p;
  uint32_t l;

  GWEN_Buffer_AppendByte(buf, tagType);
  pos=GWEN_Buffer_GetPos(buf);
  GWEN_Buffer_AppendByte(buf, 0);
  GWEN_Buffer_AppendByte(buf, 0);

  if (ch->keyName)
    GWEN_Tag16_DirectlyToBuffer(GWEN_CRYPTHEAD_TLV_KEYNAME, ch->keyName, -1, buf);

  snprintf(numbuf, sizeof(numbuf), "%d", ch->keyNumber);
  GWEN_Tag16_DirectlyToBuffer(GWEN_CRYPTHEAD_TLV_KEYNUM, numbuf, -1, buf);

  snprintf(numbuf, sizeof(numbuf), "%d", ch->keyVersion);
  GWEN_Tag16_DirectlyToBuffer(GWEN_CRYPTHEAD_TLV_KEYVER, numbuf, -1, buf);
  if (ch->pKey && ch->lKey)
    GWEN_Tag16_DirectlyToBuffer(GWEN_CRYPTHEAD_TLV_KEY,
                                (const char*)ch->pKey,
                                ch->lKey,
                                buf);

  snprintf(numbuf, sizeof(numbuf), "%d", ch->cryptProfile);
  GWEN_Tag16_DirectlyToBuffer(GWEN_CRYPTHEAD_TLV_CRYPTPROFILE, numbuf, -1, buf);

  /* write size */
  l=GWEN_Buffer_GetPos(buf)-pos-2;
  p=(uint8_t*)GWEN_Buffer_GetStart(buf)+pos;
  *(p++)=l & 0xff;
  *p=(l>>8) & 0xff;

  return 0;
}



const char *GWEN_CryptHead_GetKeyName(const GWEN_CRYPTHEAD *ch) {
  assert(ch);
  return ch->keyName;
}



void GWEN_CryptHead_SetKeyName(GWEN_CRYPTHEAD *ch, const char *s) {
  assert(ch);
  free(ch->keyName);
  if (s) ch->keyName=strdup(s);
  else ch->keyName=NULL;
}



int GWEN_CryptHead_GetKeyNumber(const GWEN_CRYPTHEAD *ch) {
  assert(ch);
  return ch->keyNumber;
}



void GWEN_CryptHead_SetKeyNumber(GWEN_CRYPTHEAD *ch, int i) {
  assert(ch);
  ch->keyNumber=i;
}



int GWEN_CryptHead_GetKeyVersion(const GWEN_CRYPTHEAD *ch) {
  assert(ch);
  return ch->keyVersion;
}



void GWEN_CryptHead_SetKeyVersion(GWEN_CRYPTHEAD *ch, int i) {
  assert(ch);
  ch->keyVersion=i;
}



int GWEN_CryptHead_GetCryptProfile(const GWEN_CRYPTHEAD *ch) {
  assert(ch);
  return ch->cryptProfile;
}



void GWEN_CryptHead_SetCryptProfile(GWEN_CRYPTHEAD *ch, int i) {
  assert(ch);
  ch->cryptProfile=i;
}



const uint8_t *GWEN_CryptHead_GetKeyPtr(const GWEN_CRYPTHEAD *ch) {
  assert(ch);
  return ch->pKey;
}



uint32_t GWEN_CryptHead_GetKeyLen(const GWEN_CRYPTHEAD *ch) {
  assert(ch);
  return ch->lKey;
}



void GWEN_CryptHead_SetKey(GWEN_CRYPTHEAD *ch, const uint8_t *p, uint32_t l) {
  assert(ch);
  if (ch->pKey && ch->lKey)
    free(ch->pKey);
  if (p && l) {
    ch->pKey=(uint8_t*)malloc(l);
    assert(ch->pKey);
    memmove(ch->pKey, p, l);
    ch->lKey=l;
  }
  else {
    ch->pKey=NULL;
    ch->lKey=0;
  }
}