SIM card related Projects » SIMtrace

/* simtrace - main program for the host PC

 *

 *  This program is free software; you can redistribute it and/or modify

 *  it under the terms of the GNU General Public License version 2 

 *  as published by the Free Software Foundation

 *

 *  This program is distributed in the hope that it will be useful,

 *  but WITHOUT ANY WARRANTY; without even the implied warranty of

 *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the

 *  GNU General Public License for more details.

 *

 *  You should have received a copy of the GNU General Public License

 *  along with this program; if not, write to the Free Software

 *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA

 */

#include <errno.h>

#include <unistd.h>

#include <stdio.h>

#include <stdint.h>

#include <time.h>

#define _GNU_SOURCE

#include <getopt.h>

#include <sys/time.h>

#include <sys/types.h>

#include <sys/socket.h>

#include <netinet/in.h>

#include <arpa/inet.h>

#include "simtrace.h"

#include "simtrace_usb.h"

#include "apdu_split.h"

static struct apdu_split *as;

	struct gsmtap_hdr *gh;

	unsigned int gross_len = len + sizeof(*gh);

	uint8_t *buf = malloc(gross_len);

	int rc;

	if (!buf)

		return -ENOMEM;

	memset(buf, 0, sizeof(*gh));

	gh = (struct gsmtap_hdr *) buf;

	gh->version = GSMTAP_VERSION;

	gh->hdr_len = sizeof(*gh)/4;

	gh->type = GSMTAP_TYPE_SIM;

	memcpy(buf + sizeof(*gh), apdu, len);

		perror("write gsmtap");

		free(buf);

		return rc;

	}

	free(buf);

	return 0;

}

static void apdu_out_cb(uint8_t *buf, unsigned int len, void *user_data)

{

static int process_usb_msg(uint8_t *buf, int len)

{

	int payload_len = len - sizeof(*sh);

	if (payload_len < 0)

		return -EINVAL;

	switch (sh->cmd) {

	case SIMTRACE_MSGT_DATA:

		/* special treatment for ATR */

		if (sh->flags & SIMTRACE_FLAG_ATR) {

			printf("ATR ");

			apdu_out_cb(payload, payload_len, NULL);

			break;

		}

			printf("PPS(Fi=%u/Di=%u) ",

				sh->res[0], sh->res[1]);

		}

		apdu_split_in(as, payload, payload_len);

#if 0

		/* If waiting time has expired, signal explicit boundary */

		if (sh->flags & SIMTRACE_FLAG_WTIME_EXP)

			apdu_split_boundary(as);

#endif

		break;

	case SIMTRACE_MSGT_RESET:

	default:

		printf("unknown simtrace msg type 0x%02x\n", sh->cmd);

		break;

	}

}

static void print_welcome(void)

{

	printf("simtrace - GSM SIM and smartcard tracing\n"

	       "(C) 2010 by Harald Welte <laforge@gnumonks.org>\n\n");

}

static void print_help(void)

{

	printf( "\t-i\t--gsmtap-ip\tA.B.C.D\n"

		"\t-a\t--skip-atr\n"

		"\t-h\t--help\n"

		);

}

static const struct option opts[] = {

	{ "gsmtap-ip", 1, 0, 'i' },

	{ "skip-atr", 0, 0, 'a' },

	{ "help", 0, 0, 'h' },

};

	int rc;

	printf("Entering main loop\n");

	while (1) {

		rc = libusb_bulk_transfer(devh, SIMTRACE_IN_EP, buf, sizeof(buf), &xfer_len, 100000);

		if (rc < 0 && rc != LIBUSB_ERROR_TIMEOUT) {

			fprintf(stderr, "BULK IN transfer error; rc=%d\n", rc);

			return;

		}

		if (xfer_len > 0) {

			//printf("URB: %s\n", osmo_hexdump(buf, rc));

			process_usb_msg(buf, xfer_len);

			msg_count++;

			byte_count += xfer_len;

		}

	}

}

int main(int argc, char **argv)

{

	int c, ret = 1;

	print_welcome();

	while (1) {

		int option_index = 0;

			break;

		switch (c) {

		case 'h':

			print_help();

			exit(0);

			break;

		case 'i':

			gsmtap_host = optarg;

			break;

		case 'a':

			skip_atr = 1;

			break;

			keep_running = 1;

			break;

	}

	if (rc < 0) {

		fprintf(stderr, "libusb initialization failed\n");

		goto close_exit;

	}

	if (!g_gti) {

		perror("unable to open GSMTAP");

	if (!as)

		goto release_exit;

		devh = libusb_open_device_with_vid_pid(NULL, SIMTRACE_USB_VENDOR, SIMTRACE_USB_PRODUCT);

		if (!devh) {

			fprintf(stderr, "can't open USB device\n");

			goto close_exit;

		}

		if (rc < 0) {

			fprintf(stderr, "can't claim interface; rc=%d\n", rc);

			goto close_exit;

		}

		ret = 0;

			libusb_close(devh);

		if (keep_running)

			sleep(1);

	} while (keep_running);

release_exit:

	return ret;