/*
 * This keeps track of smartcard protocols, timing issues
 * and ATR handling.
 *
 * MUSCLE SmartCard Development ( http://www.linuxnet.com )
 *
 * Copyright (C) 1999-2004
 *  David Corcoran <corcoran@linuxnet.com>
 *  Ludovic Rousseau <ludovic.rousseau@free.fr>
 *
 * $Id: atrhandler.c,v 1.13 2004/06/25 13:57:40 rousseau Exp $
 */

#include "config.h"
#include <syslog.h>
#include <string.h>

#include "PCSC/pcsclite.h"
#include "PCSC/debuglog.h"
#include "atrhandler.h"

/*
 * Uncomment the following for ATR debugging 
 * or use ./configure --enable-debugatr
 */
/* #define ATR_DEBUG */

#define SCARD_PROTOCOL_UNSET 0x00

short ATRDecodeAtr(PSMARTCARD_EXTENSION psExtension,
	PUCHAR pucAtr, DWORD dwLength)
{
	USHORT p;
	UCHAR K, TCK;				/* MSN of T0/Check Sum */
	UCHAR Y1i, T;				/* MSN/LSN of TDi */
	int i = 1;					/* value of the index in TAi, TBi, etc. */

	/*
	 * Zero out everything 
	 */
	p = K = TCK = Y1i = T = 0;

#ifdef ATR_DEBUG
	if (dwLength > 0)
		DebugXxd("ATR: ", pucAtr, dwLength);
#endif

	if (dwLength < 2)
		return 0;	/* Atr must have TS and T0 */

	/*
	 * Zero out the bitmasks 
	 */
	psExtension->CardCapabilities.AvailableProtocols = SCARD_PROTOCOL_UNSET;
	psExtension->CardCapabilities.CurrentProtocol = SCARD_PROTOCOL_UNSET;

	/*
	 * Decode the TS byte 
	 */
	if (pucAtr[0] == 0x3F)
	{	/* Inverse convention used */
		psExtension->CardCapabilities.Convention = SCARD_CONVENTION_INVERSE;
	}
	else
		if (pucAtr[0] == 0x3B)
		{	/* Direct convention used */
			psExtension->CardCapabilities.Convention = SCARD_CONVENTION_DIRECT;
		}
		else
		{
			memset(psExtension, 0x00, sizeof(SMARTCARD_EXTENSION));
			return 0;
		}

	/*
	 * Here comes the platform dependant stuff 
	 */

	/*
	 * Decode the T0 byte 
	 */
	Y1i = pucAtr[1] >> 4;	/* Get the MSN in Y1 */
	K = pucAtr[1] & 0x0F;	/* Get the LSN in K */

	p = 2;

#ifdef ATR_DEBUG
	debug_msg("%s:%d:%s Conv: %02X, Y1: %02X, K: %02X",
		__FILE__, __LINE__, __FUNCTION__,
		psExtension->CardCapabilities.Convention, Y1i, K);
#endif

	/*
	 * Examine Y1 
	 */
	do
	{
		short TAi, TBi, TCi, TDi;	/* Interface characters */

		TAi = (Y1i & 0x01) ? pucAtr[p++] : -1;
		TBi = (Y1i & 0x02) ? pucAtr[p++] : -1;
		TCi = (Y1i & 0x04) ? pucAtr[p++] : -1;
		TDi = (Y1i & 0x08) ? pucAtr[p++] : -1;

#ifdef ATR_DEBUG
		debug_msg("%s:%d:%s TA%d: %02X, TB%d: %02X, TC%d: %02X, TD%d: %02X",
			__FILE__, __LINE__, __FUNCTION__,
			i, TAi, i, TBi, i, TCi, i, TDi);
#endif

		/*
		 * Examine TDi to determine protocol and more 
		 */
		if (TDi >= 0)
		{
			Y1i = TDi >> 4;	/* Get the MSN in Y1 */
			T = TDi & 0x0F;	/* Get the LSN in K */

			/*
			 * Set the current protocol TD1 (first TD only)
			 */
			if (psExtension->CardCapabilities.CurrentProtocol == SCARD_PROTOCOL_UNSET)
			{
				switch (T)
				{
					case 0:
						psExtension->CardCapabilities.CurrentProtocol =
							SCARD_PROTOCOL_T0;
						break;
					case 1:
						psExtension->CardCapabilities.CurrentProtocol =
							SCARD_PROTOCOL_T1;
						break;
					default:
						return 0;
				}
			}

#ifdef ATR_DEBUG
			DebugLogB("T=%d Protocol Found", T);
#endif
			if (0 == T)
			{
				psExtension->CardCapabilities.AvailableProtocols |=
					SCARD_PROTOCOL_T0;
				psExtension->CardCapabilities.T0.BGT = 0;
				psExtension->CardCapabilities.T0.BWT = 0;
				psExtension->CardCapabilities.T0.CWT = 0;
				psExtension->CardCapabilities.T0.CGT = 0;
				psExtension->CardCapabilities.T0.WT = 0;
			}
			else
				if (1 == T)
				{
					psExtension->CardCapabilities.AvailableProtocols |=
						SCARD_PROTOCOL_T1;
					psExtension->CardCapabilities.T1.BGT = 0;
					psExtension->CardCapabilities.T1.BWT = 0;
					psExtension->CardCapabilities.T1.CWT = 0;
					psExtension->CardCapabilities.T1.CGT = 0;
					psExtension->CardCapabilities.T1.WT = 0;
				}
				else
					if (15 == T)
					{
						psExtension->CardCapabilities.AvailableProtocols |=
							SCARD_PROTOCOL_T15;
					}
					else
					{
						/*
						 * Do nothing for now since other protocols are not
						 * supported at this time 
						 */
					}

			/* test presence of TA2 */
			if ((2 == i) && (TAi >= 0))
			{
				T = TAi & 0x0F;
#ifdef ATR_DEBUG
				DebugLogB("Specific mode: T=%d", T);
#endif
				switch (T)
				{
					case 0:
						psExtension->CardCapabilities.CurrentProtocol =
							psExtension->CardCapabilities.AvailableProtocols =
							SCARD_PROTOCOL_T0;
						break;

					case 1:
						psExtension->CardCapabilities.CurrentProtocol =
							psExtension->CardCapabilities.AvailableProtocols =
							SCARD_PROTOCOL_T1;
						break;

					default:
						return 0;
				}
			}
		} else
			Y1i = 0;

		if (p > MAX_ATR_SIZE)
		{
			memset(psExtension, 0x00, sizeof(SMARTCARD_EXTENSION));
			return 0;
		}

		/* next interface characters index */
		i++;
	}
	while (Y1i != 0);

	/*
	 * If TDx is not set then the current must be T0 
	 */
	if (psExtension->CardCapabilities.CurrentProtocol == SCARD_PROTOCOL_UNSET)
	{
		psExtension->CardCapabilities.CurrentProtocol = SCARD_PROTOCOL_T0;
		psExtension->CardCapabilities.AvailableProtocols |= SCARD_PROTOCOL_T0;
	}

	/*
	 * Take care of the historical characters 
	 */
	psExtension->ATR.HistoryLength = K;
	memcpy(psExtension->ATR.HistoryValue, &pucAtr[p], K);

	p = p + K;

	/*
	 * Check to see if TCK character is included It will be included if
	 * more than T=0 is supported 
	 */
	if (psExtension->CardCapabilities.AvailableProtocols & SCARD_PROTOCOL_T1)
		TCK = pucAtr[p++];

	memcpy(psExtension->ATR.Value, pucAtr, p);
	psExtension->ATR.Length = p;	/* modified from p-1 */

#ifdef ATR_DEBUG
	DebugLogC("CurrentProtocol: %d, AvailableProtocols: %d",
		psExtension->CardCapabilities.CurrentProtocol,
		psExtension->CardCapabilities.AvailableProtocols);
#endif

	return 1;
}

