mirror of https://gerrit.osmocom.org/simtrace2
187 lines
5.9 KiB
C
187 lines
5.9 KiB
C
/* ----------------------------------------------------------------------------
|
|
* ATMEL Microcontroller Software Support
|
|
* ----------------------------------------------------------------------------
|
|
* Copyright (c) 2009, Atmel Corporation
|
|
*
|
|
* All rights reserved.
|
|
*
|
|
* Redistribution and use in source and binary forms, with or without
|
|
* modification, are permitted provided that the following conditions are met:
|
|
*
|
|
* - Redistributions of source code must retain the above copyright notice,
|
|
* this list of conditions and the disclaimer below.
|
|
*
|
|
* Atmel's name may not be used to endorse or promote products derived from
|
|
* this software without specific prior written permission.
|
|
*
|
|
* DISCLAIMER: THIS SOFTWARE IS PROVIDED BY ATMEL "AS IS" AND ANY EXPRESS OR
|
|
* IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED WARRANTIES OF
|
|
* MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NON-INFRINGEMENT ARE
|
|
* DISCLAIMED. IN NO EVENT SHALL ATMEL BE LIABLE FOR ANY DIRECT, INDIRECT,
|
|
* INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT
|
|
* LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA,
|
|
* OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
|
* LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
|
* NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE,
|
|
* EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
|
* ----------------------------------------------------------------------------
|
|
*/
|
|
|
|
/*------------------------------------------------------------------------------
|
|
* Headers
|
|
*------------------------------------------------------------------------------*/
|
|
|
|
#include "board.h"
|
|
|
|
#include <string.h>
|
|
|
|
/*------------------------------------------------------------------------------
|
|
* Internal definitions
|
|
*------------------------------------------------------------------------------*/
|
|
/** Maximum ucSize in bytes of the smartcard answer to a command.*/
|
|
#define MAX_ANSWER_SIZE 10
|
|
|
|
/** Maximum ATR ucSize in bytes.*/
|
|
#define MAX_ATR_SIZE 55
|
|
|
|
|
|
/*------------------------------------------------------------------------------
|
|
* Internal variables
|
|
*------------------------------------------------------------------------------*/
|
|
|
|
/** ISO7816 pins */
|
|
static const Pin pinsISO7816[] = {PINS_ISO7816};
|
|
/** Bus switch pins */
|
|
static const Pin pinsBus[] = {PINS_BUS_DEFAULT};
|
|
/* SIMcard power pin */
|
|
static const Pin pinsPower[] = {PWR_PINS};
|
|
/** ISO7816 RST pin */
|
|
static const Pin pinIso7816RstMC = PIN_ISO7816_RSTMC;
|
|
static uint8_t sim_inserted = 0;
|
|
|
|
/*------------------------------------------------------------------------------
|
|
* Optional smartcard detection
|
|
*------------------------------------------------------------------------------*/
|
|
|
|
#ifdef SMARTCARD_CONNECT_PIN
|
|
|
|
/** Smartcard detection pin.*/
|
|
static const Pin pinSmartCard = SMARTCARD_CONNECT_PIN;
|
|
|
|
/**
|
|
* PIO interrupt service routine. Checks if the smartcard has been connected
|
|
* or disconnected.
|
|
*/
|
|
static void ISR_PioSmartCard( const Pin *pPin )
|
|
{
|
|
/* FIXME: why is pinSmartCard.pio->PIO_ISR the wrong number?
|
|
printf("+++++ Trying to check for pending interrupts (PIO ISR: 0x%X)\n\r", pinSmartCard.pio->PIO_ISR);
|
|
printf("+++++ Mask: 0x%X\n\r", pinSmartCard.mask);
|
|
Output:
|
|
+++++ Trying to check for pending interrupts (PIO ISR: 0x400)) = 1<<10
|
|
+++++ Mask: 0x100 = 1<<8
|
|
*/
|
|
// PA10 is DTXD, which is the debug uart transmit pin
|
|
|
|
printf("Interrupt!!\n\r");
|
|
/* Check all pending interrupts */
|
|
// FIXME: this if condition is not always true...
|
|
// if ( (pinSmartCard.pio->PIO_ISR & pinSmartCard.mask) != 0 )
|
|
{
|
|
/* Check current level on pin */
|
|
if ( PIO_Get( &pinSmartCard ) == 0 )
|
|
{
|
|
sim_inserted = 1;
|
|
printf( "-I- Smartcard inserted\n\r" ) ;
|
|
CCID_Insertion();
|
|
}
|
|
else
|
|
{
|
|
sim_inserted = 0;
|
|
printf( "-I- Smartcard removed\n\r" ) ;
|
|
CCID_Removal();
|
|
}
|
|
}
|
|
}
|
|
|
|
/**
|
|
* Configures the smartcard detection pin to trigger an interrupt.
|
|
*/
|
|
static void ConfigureCardDetection( void )
|
|
{
|
|
printf("+++++ Configure PIOs\n\r");
|
|
PIO_Configure( &pinSmartCard, 1 ) ;
|
|
NVIC_EnableIRQ( PIOA_IRQn );
|
|
// FIXME: Do we need to set priority?: NVIC_SetPriority( PIOA_IRQn, 10);
|
|
PIO_ConfigureIt( &pinSmartCard, ISR_PioSmartCard ) ;
|
|
PIO_EnableIt( &pinSmartCard ) ;
|
|
}
|
|
|
|
#else
|
|
|
|
/**
|
|
* Dummy implementation.
|
|
*/
|
|
static void ConfigureCardDetection( void )
|
|
{
|
|
printf( "-I- Smartcard detection not supported.\n\r" ) ;
|
|
}
|
|
|
|
#endif
|
|
|
|
|
|
/*-----------------------------------------------------------------------------
|
|
* Initialization and run
|
|
*-----------------------------------------------------------------------------*/
|
|
static const CCIDDriverConfigurationDescriptors *configDescCCID;
|
|
extern CCIDDriverConfigurationDescriptors configurationDescriptorCCID;
|
|
|
|
void CCID_init( void )
|
|
{
|
|
uint8_t pAtr[MAX_ATR_SIZE];
|
|
uint8_t ucSize ;
|
|
|
|
configDescCCID = &configurationDescriptorCCID;
|
|
|
|
// FIXME: do we want to print ATR?
|
|
/* Initialize Atr buffer */
|
|
memset( pAtr, 0, sizeof( pAtr ) ) ;
|
|
|
|
/* Configure IT on Smart Card */
|
|
ConfigureCardDetection() ;
|
|
|
|
// Configure ISO7816 driver
|
|
PIO_Configure(pinsISO7816, PIO_LISTSIZE(pinsISO7816));
|
|
PIO_Configure(pinsBus, PIO_LISTSIZE(pinsBus));
|
|
PIO_Configure(pinsPower, PIO_LISTSIZE(pinsPower));
|
|
|
|
/* power up the card */
|
|
// PIO_Set(&pinsPower[0]);
|
|
|
|
ISO7816_Init( &pinIso7816RstMC ) ;
|
|
|
|
CCIDDriver_Initialize();
|
|
|
|
/* Read ATR */
|
|
ISO7816_warm_reset() ;
|
|
|
|
ISO7816_Datablock_ATR( pAtr, &ucSize ) ;
|
|
|
|
/* Decode ATR and print it */
|
|
ISO7816_Decode_ATR( pAtr ) ;
|
|
|
|
// FIXME. what if smcard is not inserted?
|
|
if(PIO_Get(&pinSmartCard) == 0) {
|
|
printf("SIM card inserted\n\r");
|
|
CCID_Insertion();
|
|
}
|
|
}
|
|
|
|
void CCID_run( void )
|
|
{
|
|
|
|
//if (USBD_Read(INT, pBuffer, dLength, fCallback, pArgument);
|
|
|
|
CCID_SmartCardRequest();
|
|
}
|