mirror of https://gerrit.osmocom.org/simtrace2
simtrace main with phone as clk master
This commit is contained in:
parent
5bcac5df4d
commit
32906bb919
|
@ -48,7 +48,9 @@ MEMORIES = flash
|
||||||
# TRACE_LEVEL_ERROR 2
|
# TRACE_LEVEL_ERROR 2
|
||||||
# TRACE_LEVEL_FATAL 1
|
# TRACE_LEVEL_FATAL 1
|
||||||
# TRACE_LEVEL_NO_TRACE 0
|
# TRACE_LEVEL_NO_TRACE 0
|
||||||
TRACE_LEVEL = 1
|
TRACE_LEVEL = 5
|
||||||
|
#FIXME: Remove this variable
|
||||||
|
NOAUTOCALLBACK=no
|
||||||
|
|
||||||
# Optimization level, put in comment for debugging
|
# Optimization level, put in comment for debugging
|
||||||
OPTIMIZATION = -O0
|
OPTIMIZATION = -O0
|
||||||
|
@ -91,13 +93,13 @@ NM = $(CROSS_COMPILE)nm
|
||||||
INCLUDES_USB = -Iatmel_softpack_libraries/usb/include
|
INCLUDES_USB = -Iatmel_softpack_libraries/usb/include
|
||||||
INCLUDES_USB += -I$(AT91LIB_CCIDDEV_PATH)
|
INCLUDES_USB += -I$(AT91LIB_CCIDDEV_PATH)
|
||||||
|
|
||||||
INCLUDES = -Iinclude_board -Iinclude_sam3s -Iinclude
|
INCLUDES = -Iinclude_board -Iinclude_sam3s -Iinclude -Isimtrace
|
||||||
INCLUDES += -Icmsis
|
INCLUDES += -Icmsis
|
||||||
INCLUDES += -I$(LIBC_PATH)/include
|
INCLUDES += -I$(LIBC_PATH)/include
|
||||||
INCLUDES += $(INCLUDES_USB)
|
INCLUDES += $(INCLUDES_USB)
|
||||||
#INCLUDES += -I$(LIBRARIES)
|
#INCLUDES += -I$(LIBRARIES)
|
||||||
|
|
||||||
CFLAGS += -Wall -Wchar-subscripts -Wcomment -Wimplicit-int -Wformat=2
|
CFLAGS += -Wall -Wchar-subscripts -Wcomment -Wimplicit-int #-Wformat=2
|
||||||
CFLAGS += -Werror-implicit-function-declaration -Wmain -Wparentheses
|
CFLAGS += -Werror-implicit-function-declaration -Wmain -Wparentheses
|
||||||
CFLAGS += -Wsequence-point -Wreturn-type -Wswitch -Wtrigraphs #-Wunused
|
CFLAGS += -Wsequence-point -Wreturn-type -Wswitch -Wtrigraphs #-Wunused
|
||||||
CFLAGS += -Wuninitialized -Wunknown-pragmas -Wfloat-equal -Wundef
|
CFLAGS += -Wuninitialized -Wunknown-pragmas -Wfloat-equal -Wundef
|
||||||
|
@ -135,7 +137,7 @@ LDFLAGS = -mcpu=cortex-m3 -mthumb -Wl,--cref -Wl,--check-sections -Wl,--gc-secti
|
||||||
# Directories where source files can be found
|
# Directories where source files can be found
|
||||||
|
|
||||||
USB_PATHS = $(AT91LIB_CCIDDEV_PATH) $(AT91LIB_USB_CORE_PATH) $(AT91LIB_USB_COMMON_CORE_PATH)
|
USB_PATHS = $(AT91LIB_CCIDDEV_PATH) $(AT91LIB_USB_CORE_PATH) $(AT91LIB_USB_COMMON_CORE_PATH)
|
||||||
VPATH += src_board src_sam3s cmsis $(USB_PATHS)
|
VPATH += src_board src_sam3s cmsis $(USB_PATHS) simtrace
|
||||||
|
|
||||||
# Objects built from C source files
|
# Objects built from C source files
|
||||||
C_CMSIS = core_cm3.o
|
C_CMSIS = core_cm3.o
|
||||||
|
|
|
@ -0,0 +1,318 @@
|
||||||
|
/* ----------------------------------------------------------------------------
|
||||||
|
* 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
|
||||||
|
|
||||||
|
/** USB states */
|
||||||
|
/// Use for power management
|
||||||
|
#define STATE_IDLE 0
|
||||||
|
/// The USB device is in suspend state
|
||||||
|
#define STATE_SUSPEND 4
|
||||||
|
/// The USB device is in resume state
|
||||||
|
#define STATE_RESUME 5
|
||||||
|
|
||||||
|
/*------------------------------------------------------------------------------
|
||||||
|
* Internal variables
|
||||||
|
*------------------------------------------------------------------------------*/
|
||||||
|
/** USB state: suspend, resume, idle */
|
||||||
|
unsigned char USBState = STATE_IDLE;
|
||||||
|
|
||||||
|
/** ISO7816 pins */
|
||||||
|
static const Pin pinsISO7816_PHONE[] = {PINS_ISO7816_PHONE};
|
||||||
|
/** ISO7816 RST pin */
|
||||||
|
static const Pin pinIso7816RstMC = PIN_ISO7816_RST_PHONE;
|
||||||
|
static uint8_t sim_inserted = 0;
|
||||||
|
|
||||||
|
static const Pin pPwr[] = {
|
||||||
|
/* Enable power converter 4.5-6V to 3.3V; low: off */
|
||||||
|
{SIM_PWEN, PIOA, ID_PIOA, PIO_OUTPUT_0, PIO_DEFAULT},
|
||||||
|
|
||||||
|
/* Enable second power converter: VCC_PHONE to VCC_SIM; high: off */
|
||||||
|
{VCC_FWD, PIOA, ID_PIOA, PIO_OUTPUT_1, PIO_DEFAULT}
|
||||||
|
};
|
||||||
|
|
||||||
|
|
||||||
|
#define ISO7816_PHONE_RST {PIO_PA24, PIOA, ID_PIOA, PIO_INPUT, PIO_PULLUP | PIO_DEBOUNCE | PIO_DEGLITCH | PIO_IT_EDGE }
|
||||||
|
static const Pin pinPhoneRST = ISO7816_PHONE_RST;
|
||||||
|
//#define ISO7816_PHONE_CLK {PIO_PA23A_SCK1, PIOA, ID_PIOA, PIO_INPUT, PIO_PULLUP | PIO_DEBOUNCE | PIO_DEGLITCH | PIO_IT_EDGE }
|
||||||
|
//static const Pin pinPhoneClk = ISO7816_PHONE_CLK;
|
||||||
|
|
||||||
|
/* ===================================================*/
|
||||||
|
/* Taken from iso7816_4.c */
|
||||||
|
/* ===================================================*/
|
||||||
|
/** Flip flop for send and receive char */
|
||||||
|
#define USART_SEND 0
|
||||||
|
#define USART_RCV 1
|
||||||
|
/*-----------------------------------------------------------------------------
|
||||||
|
* Internal variables
|
||||||
|
*-----------------------------------------------------------------------------*/
|
||||||
|
/** Variable for state of send and receive froom USART */
|
||||||
|
static uint8_t StateUsartGlobal = USART_RCV;
|
||||||
|
/** Pin reset master card */
|
||||||
|
static Pin st_pinIso7816RstMC;
|
||||||
|
|
||||||
|
static uint32_t char_stat = 0;
|
||||||
|
static char rcvdChar = 0;
|
||||||
|
|
||||||
|
/*-----------------------------------------------------------------------------
|
||||||
|
* Interrupt routines
|
||||||
|
*-----------------------------------------------------------------------------*/
|
||||||
|
/*
|
||||||
|
* char_stat is zero if no error occured.
|
||||||
|
* Otherwise it is filled with the content of the status register.
|
||||||
|
*/
|
||||||
|
void USART1_IrqHandler( void )
|
||||||
|
{
|
||||||
|
uint32_t stat;
|
||||||
|
char_stat = 0;
|
||||||
|
// Rcv buf full
|
||||||
|
/* if((stat & US_CSR_RXBUFF) == US_CSR_RXBUFF) {
|
||||||
|
TRACE_DEBUG("Rcv buf full");
|
||||||
|
USART_DisableIt(USART1, US_IDR_RXBUFF);
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
uint32_t csr = USART_PHONE->US_CSR;
|
||||||
|
|
||||||
|
// printf(".\n\r");
|
||||||
|
|
||||||
|
if (csr & US_CSR_TXRDY) {
|
||||||
|
/* transmit buffer empty, nothing to transmit */
|
||||||
|
}
|
||||||
|
if (csr & US_CSR_RXRDY) {
|
||||||
|
stat = (csr&(US_CSR_OVRE|US_CSR_FRAME|
|
||||||
|
US_CSR_PARE|US_CSR_TIMEOUT|US_CSR_NACK|
|
||||||
|
(1<<10)));
|
||||||
|
|
||||||
|
if (stat == 0 ) {
|
||||||
|
/* Get a char */
|
||||||
|
rcvdChar = ((USART_PHONE->US_RHR) & 0xFF);
|
||||||
|
} /* else: error occured */
|
||||||
|
char_stat = stat;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
static void ISR_PhoneRST( const Pin *pPin)
|
||||||
|
{
|
||||||
|
TRACE_DEBUG("+++++++++ Interrupt!! ISR:0x%x, CSR:0x%x\n\r", pinPhoneRST.pio->PIO_ISR, USART1->US_CSR);
|
||||||
|
phone_state = SEND_ATR;
|
||||||
|
PIO_DisableIt( &pinPhoneRST ) ;
|
||||||
|
}
|
||||||
|
|
||||||
|
static void Config_PhoneRST_IrqHandler()
|
||||||
|
{
|
||||||
|
PIO_Configure( &pinPhoneRST, 1);
|
||||||
|
// PIO_Configure( &pinPhoneClk, 1);
|
||||||
|
PIO_ConfigureIt( &pinPhoneRST, ISR_PhoneRST ) ;
|
||||||
|
// PIO_ConfigureIt( &pinPhoneClk, ISR_PhoneRST ) ;
|
||||||
|
PIO_EnableIt( &pinPhoneRST ) ;
|
||||||
|
// PIO_EnableIt( &pinPhoneClk ) ;
|
||||||
|
NVIC_EnableIRQ( PIOA_IRQn );
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Get a character from ISO7816
|
||||||
|
* \param pCharToReceive Pointer for store the received char
|
||||||
|
* \return 0: if timeout else status of US_CSR
|
||||||
|
*/
|
||||||
|
/* FIXME: This code is taken from cciddriver.c
|
||||||
|
--> Reuse the code!!! */
|
||||||
|
uint32_t _ISO7816_GetChar( uint8_t *pCharToReceive )
|
||||||
|
{
|
||||||
|
uint32_t status;
|
||||||
|
uint32_t timeout=0;
|
||||||
|
|
||||||
|
TRACE_DEBUG("--");
|
||||||
|
|
||||||
|
if( StateUsartGlobal == USART_SEND ) {
|
||||||
|
while((USART_PHONE->US_CSR & US_CSR_TXEMPTY) == 0) {}
|
||||||
|
USART_PHONE->US_CR = US_CR_RSTSTA | US_CR_RSTIT | US_CR_RSTNACK;
|
||||||
|
StateUsartGlobal = USART_RCV;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Wait USART ready for reception */
|
||||||
|
while( ((USART_PHONE->US_CSR & US_CSR_RXRDY) == 0) ) {
|
||||||
|
if(timeout++ > 12000 * (BOARD_MCK/1000000)) {
|
||||||
|
TRACE_DEBUG("TimeOut\n\r");
|
||||||
|
return( 0 );
|
||||||
|
}
|
||||||
|
}
|
||||||
|
|
||||||
|
/* At least one complete character has been received and US_RHR has not yet been read. */
|
||||||
|
|
||||||
|
/* Get a char */
|
||||||
|
*pCharToReceive = ((USART_PHONE->US_RHR) & 0xFF);
|
||||||
|
|
||||||
|
status = (USART_PHONE->US_CSR&(US_CSR_OVRE|US_CSR_FRAME|
|
||||||
|
US_CSR_PARE|US_CSR_TIMEOUT|US_CSR_NACK|
|
||||||
|
(1<<10)));
|
||||||
|
|
||||||
|
if (status != 0 ) {
|
||||||
|
TRACE_DEBUG("R:0x%X\n\r", status);
|
||||||
|
TRACE_DEBUG("R:0x%X\n\r", USART_PHONE->US_CSR);
|
||||||
|
TRACE_DEBUG("Nb:0x%X\n\r", USART_PHONE->US_NER );
|
||||||
|
USART_PHONE->US_CR = US_CR_RSTSTA;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Return status */
|
||||||
|
return( status );
|
||||||
|
}
|
||||||
|
|
||||||
|
/**
|
||||||
|
* Send a char to ISO7816
|
||||||
|
* \param CharToSend char to be send
|
||||||
|
* \return status of US_CSR
|
||||||
|
*/
|
||||||
|
uint32_t _ISO7816_SendChar( uint8_t CharToSend )
|
||||||
|
{
|
||||||
|
uint32_t status;
|
||||||
|
|
||||||
|
TRACE_DEBUG("********** Send char: %c (0x%X)\n\r", CharToSend, CharToSend);
|
||||||
|
|
||||||
|
if( StateUsartGlobal == USART_RCV ) {
|
||||||
|
USART_PHONE->US_CR = US_CR_RSTSTA | US_CR_RSTIT | US_CR_RSTNACK;
|
||||||
|
StateUsartGlobal = USART_SEND;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Wait USART ready for transmit */
|
||||||
|
while((USART_PHONE->US_CSR & US_CSR_TXRDY) == 0) {}
|
||||||
|
/* There is no character in the US_THR */
|
||||||
|
|
||||||
|
/* Transmit a char */
|
||||||
|
USART_PHONE->US_THR = CharToSend;
|
||||||
|
|
||||||
|
status = (USART_PHONE->US_CSR&(US_CSR_OVRE|US_CSR_FRAME|
|
||||||
|
US_CSR_PARE|US_CSR_TIMEOUT|US_CSR_NACK|
|
||||||
|
(1<<10)));
|
||||||
|
|
||||||
|
if (status != 0 ) {
|
||||||
|
TRACE_DEBUG("******* status: 0x%X (Overrun: %d, NACK: %d, Timeout: %d, underrun: %d)\n\r",
|
||||||
|
status, ((status & US_CSR_OVRE)>> 5), ((status & US_CSR_NACK) >> 13),
|
||||||
|
((status & US_CSR_TIMEOUT) >> 8), ((status & (1 << 10)) >> 10));
|
||||||
|
|
||||||
|
TRACE_DEBUG("E (USART CSR reg):0x%X\n\r", USART_PHONE->US_CSR);
|
||||||
|
TRACE_DEBUG("Nb (Number of errors):0x%X\n\r", USART_PHONE->US_NER );
|
||||||
|
USART_PHONE->US_CR = US_CR_RSTSTA;
|
||||||
|
}
|
||||||
|
|
||||||
|
/* Return status */
|
||||||
|
return( status );
|
||||||
|
}
|
||||||
|
|
||||||
|
|
||||||
|
/** Initializes a ISO driver
|
||||||
|
* \param pPinIso7816RstMC Pin ISO 7816 Rst MC
|
||||||
|
*/
|
||||||
|
// FIXME: This function is implemented in iso7816_4.c !! Only MCK instead of SCK is always taken. Change that!
|
||||||
|
void _ISO7816_Init( const Pin pPinIso7816RstMC )
|
||||||
|
{
|
||||||
|
TRACE_DEBUG("ISO_Init\n\r");
|
||||||
|
|
||||||
|
/* Pin ISO7816 initialize */
|
||||||
|
st_pinIso7816RstMC = pPinIso7816RstMC;
|
||||||
|
|
||||||
|
USART_Configure( USART_PHONE,
|
||||||
|
US_MR_USART_MODE_IS07816_T_0
|
||||||
|
// Nope, we aren't master:
|
||||||
|
// | US_MR_USCLKS_MCK
|
||||||
|
| US_MR_USCLKS_SCK
|
||||||
|
| US_MR_NBSTOP_1_BIT
|
||||||
|
| US_MR_PAR_EVEN
|
||||||
|
| US_MR_CHRL_8_BIT
|
||||||
|
| US_MR_CLKO /** TODO: This field was set in the original simtrace firmware..why? */
|
||||||
|
| (3<<24), /* MAX_ITERATION */
|
||||||
|
1,
|
||||||
|
0);
|
||||||
|
/*
|
||||||
|
SYNC = 0 (async mode)
|
||||||
|
OVER = 0 (oversampling by 8?)
|
||||||
|
FIDI = 372 (default val on startup before other value is negotiated)
|
||||||
|
USCLKS = 3 (Select SCK as input clock) --> US_MR_USCLKS_SCK
|
||||||
|
CD = 1 ? --> US_BRGR_CD(1)
|
||||||
|
*/
|
||||||
|
USART_PHONE->US_FIDI = 372;
|
||||||
|
// USART_PHONE->US_IDR = (uint32_t) -1;
|
||||||
|
USART_PHONE->US_BRGR = US_BRGR_CD(1);
|
||||||
|
// USART_PHONE->US_BRGR = BOARD_MCK / (372*9600);
|
||||||
|
USART_PHONE->US_TTGR = 5;
|
||||||
|
|
||||||
|
/* Configure USART */
|
||||||
|
PMC_EnablePeripheral(ID_USART_PHONE);
|
||||||
|
|
||||||
|
USART1->US_IDR = 0xffffffff;
|
||||||
|
USART_EnableIt( USART1, US_IER_RXRDY) ;
|
||||||
|
/* enable USART1 interrupt */
|
||||||
|
NVIC_EnableIRQ( USART1_IRQn ) ;
|
||||||
|
|
||||||
|
// USART_PHONE->US_IER = US_IER_RXRDY | US_IER_OVRE | US_IER_FRAME | US_IER_PARE | US_IER_NACK | US_IER_ITER;
|
||||||
|
|
||||||
|
USART_SetTransmitterEnabled(USART_PHONE, 1);
|
||||||
|
USART_SetReceiverEnabled(USART_PHONE, 1);
|
||||||
|
|
||||||
|
}
|
||||||
|
|
||||||
|
void Phone_Master_Init( void ) {
|
||||||
|
|
||||||
|
PIO_Configure( pinsISO7816_PHONE, PIO_LISTSIZE( pinsISO7816_PHONE ) ) ;
|
||||||
|
Config_PhoneRST_IrqHandler();
|
||||||
|
_ISO7816_Init(pinIso7816RstMC);
|
||||||
|
|
||||||
|
// FIXME: Or do I need to call VBUS_CONFIGURE() here instead, which will call USBD_Connect() later?
|
||||||
|
// USBD_Connect();
|
||||||
|
// FIXME: USB clock? USB PMC?
|
||||||
|
// NVIC_EnableIRQ( UDP_IRQn );
|
||||||
|
|
||||||
|
// USART_EnableIt( USART_PHONE, US_IER_RXRDY) ;
|
||||||
|
|
||||||
|
// FIXME: At some point USBD_IrqHandler() should get called and set USBD_STATE_CONFIGURED
|
||||||
|
/* while (USBD_GetState() < USBD_STATE_CONFIGURED) {
|
||||||
|
int i = 1;
|
||||||
|
if ((i%10000) == 0) {
|
||||||
|
TRACE_DEBUG("%d: USB State: %x\n\r", i, USBD_GetState());
|
||||||
|
}
|
||||||
|
i++;
|
||||||
|
}
|
||||||
|
*/
|
||||||
|
|
||||||
|
}
|
|
@ -0,0 +1,5 @@
|
||||||
|
|
||||||
|
// FIXME: static function definitions
|
||||||
|
uint32_t _ISO7816_GetChar( uint8_t *pCharToReceive );
|
||||||
|
uint32_t _ISO7816_SendChar( uint8_t CharToSend );
|
||||||
|
void Phone_Master_Init( void );
|
|
@ -0,0 +1,65 @@
|
||||||
|
// FIXME: Copyright license here
|
||||||
|
/*------------------------------------------------------------------------------
|
||||||
|
* Headers
|
||||||
|
*------------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
#include "board.h"
|
||||||
|
#include "simtrace.h"
|
||||||
|
|
||||||
|
/*------------------------------------------------------------------------------
|
||||||
|
* Internal definitions
|
||||||
|
*------------------------------------------------------------------------------*/
|
||||||
|
#define CONF_SNIFFER 1
|
||||||
|
#define CONF_CCID_READER 2
|
||||||
|
#define CONF_SIMCARD_EMUL 3
|
||||||
|
#define CONF_MITM 4
|
||||||
|
|
||||||
|
|
||||||
|
/*------------------------------------------------------------------------------
|
||||||
|
* Internal variables
|
||||||
|
*------------------------------------------------------------------------------*/
|
||||||
|
uint8_t simtrace_config = CONF_SNIFFER;
|
||||||
|
uint8_t conf_changed = 0;
|
||||||
|
|
||||||
|
/*------------------------------------------------------------------------------
|
||||||
|
* Main
|
||||||
|
*------------------------------------------------------------------------------*/
|
||||||
|
|
||||||
|
extern int main( void )
|
||||||
|
{
|
||||||
|
LED_Configure(LED_NUM_GREEN);
|
||||||
|
LED_Set(LED_NUM_GREEN);
|
||||||
|
|
||||||
|
/* Disable watchdog*/
|
||||||
|
WDT_Disable( WDT ) ;
|
||||||
|
|
||||||
|
PIO_InitializeInterrupts(0);
|
||||||
|
|
||||||
|
|
||||||
|
TRACE_DEBUG("%s", "Start\n\r");
|
||||||
|
while(1) {
|
||||||
|
/* FIXME: Or should we move the while loop into every case, and break out
|
||||||
|
in case the config changes? */
|
||||||
|
switch(simtrace_config) {
|
||||||
|
case CONF_SNIFFER:
|
||||||
|
break;
|
||||||
|
case CONF_CCID_READER:
|
||||||
|
break;
|
||||||
|
case CONF_SIMCARD_EMUL:
|
||||||
|
if (conf_changed) {
|
||||||
|
Phone_Master_Init();
|
||||||
|
/* Configure ISO7816 driver */
|
||||||
|
// FIXME: PIO_Configure(pPwr, PIO_LISTSIZE( pPwr ));
|
||||||
|
} else {
|
||||||
|
/* Send and receive chars */
|
||||||
|
// ISO7816_GetChar(&rcv_char);
|
||||||
|
// ISO7816_SendChar(char_to_send);
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
case CONF_MITM:
|
||||||
|
break;
|
||||||
|
default:
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
}
|
||||||
|
}
|
Loading…
Reference in New Issue