mirror of
https://gitea.osmocom.org/sim-card/simtrace2.git
synced 2026-03-17 05:38:33 +03:00
3d8c093cb2
When the timeout was too small, the main function would infinitely loop around, restarting the board and waiting for the USB interface to get configured. But since configuration seems to take more than one second, it rarely succeeded. Increasing the timeout makes the USB configuration finish in the first try.
96 lines
2.9 KiB
C
96 lines
2.9 KiB
C
// FIXME: Copyright license here
|
|
/*------------------------------------------------------------------------------
|
|
* Headers
|
|
*------------------------------------------------------------------------------*/
|
|
|
|
#include "board.h"
|
|
|
|
/*------------------------------------------------------------------------------
|
|
* Internal variables
|
|
*------------------------------------------------------------------------------*/
|
|
typedef struct {
|
|
void (* configure) ( void );
|
|
void (* init) ( void );
|
|
void (* exit) ( void );
|
|
void (* run) ( void );
|
|
} conf_func;
|
|
|
|
conf_func config_func_ptrs[] = {
|
|
{Sniffer_configure, Sniffer_init, Sniffer_exit, Sniffer_run}, /* CFG_NUM_SNIFF */
|
|
{CCID_configure, CCID_init, CCID_exit, CCID_run}, /* CFG_NUM_CCID */
|
|
{Phone_configure, Phone_init, Phone_exit, Phone_run}, /* CFG_NUM_PHONE */
|
|
{MITM_configure, MITM_init, MITM_exit, MITM_run}, /* CFG_NUM_MITM */
|
|
};
|
|
|
|
|
|
/*------------------------------------------------------------------------------
|
|
* Internal variables
|
|
*------------------------------------------------------------------------------*/
|
|
volatile enum confNum simtrace_config = CFG_NUM_SNIFF;
|
|
|
|
/*------------------------------------------------------------------------------
|
|
* Main
|
|
*------------------------------------------------------------------------------*/
|
|
#define MAX_USB_ITER BOARD_MCK/72 // This should be around a second
|
|
extern int main( void )
|
|
{
|
|
uint8_t isUsbConnected = 0;
|
|
enum confNum last_simtrace_config = simtrace_config;
|
|
unsigned int i = 0;
|
|
|
|
LED_Configure(LED_NUM_RED);
|
|
LED_Configure(LED_NUM_GREEN);
|
|
LED_Set(LED_NUM_RED);
|
|
|
|
/* Disable watchdog*/
|
|
WDT_Disable( WDT ) ;
|
|
|
|
PIO_InitializeInterrupts(0);
|
|
|
|
SIMtrace_USB_Initialize();
|
|
|
|
printf("%s", "USB init\n\r");
|
|
while(USBD_GetState() < USBD_STATE_CONFIGURED){
|
|
if(i >= MAX_USB_ITER*3) {
|
|
TRACE_ERROR("Resetting board (USB could not be configured)\n");
|
|
NVIC_SystemReset();
|
|
}
|
|
i++;
|
|
}
|
|
|
|
for (i = 0; i < sizeof(config_func_ptrs)/sizeof(config_func_ptrs[0]); ++i)
|
|
{
|
|
config_func_ptrs[i].configure();
|
|
}
|
|
|
|
config_func_ptrs[simtrace_config-1].init();
|
|
last_simtrace_config = simtrace_config;
|
|
|
|
printf("%s", "Start\n\r");
|
|
while(1) {
|
|
|
|
if (USBD_GetState() < USBD_STATE_CONFIGURED) {
|
|
|
|
if (isUsbConnected) {
|
|
isUsbConnected = 0;
|
|
}
|
|
}
|
|
else if (isUsbConnected == 0) {
|
|
printf("USB is now configured\n\r");
|
|
LED_Set(LED_NUM_GREEN);
|
|
LED_Clear(LED_NUM_RED);
|
|
|
|
isUsbConnected = 1;
|
|
}
|
|
|
|
|
|
if (last_simtrace_config != simtrace_config) {
|
|
config_func_ptrs[last_simtrace_config-1].exit();
|
|
config_func_ptrs[simtrace_config-1].init();
|
|
last_simtrace_config = simtrace_config;
|
|
} else {
|
|
config_func_ptrs[simtrace_config-1].run();
|
|
}
|
|
}
|
|
}
|