ikey3k.c

读写Smart卡加解密接口的程序

#include <stdint.h>
#include <stdlib.h>
#include <string.h>
#include <syslog.h>

#include "usbtoken.h"

int ikey3k_init();
int ikey3k_transmit(uint8_t * buf_send, int len_send,
		    uint8_t * buf_recv, int *len_recv);

const struct token_drv ikey3k_drv = {
	.init = ikey3k_init,
	.transmit = ikey3k_transmit,
	.max_ifsc = 0xb4,	/* as used under windows */
	.timeout = 10000,
	.name = "Rainbow iKey 3000",
};

char *ikey3k_products[] = { "4b9/1300/100", 0 };

int ikey3k_test(char *product)
{
	char **p;
	if (!product)
		return USBTOKEN_ERROR;

	for (p = ikey3k_products; *p; p++) {
		if (strcmp(product, *p) == 0) {
			usbtoken.drv = ikey3k_drv;
			return USBTOKEN_OK;
		}
	}
	return USBTOKEN_ERROR;
}


int ikey3k_init()
{
	uint8_t buffer[1024];

	uint8_t expect5[] =
	    { 0x0a, 0x61, 0x00, 0x07, 0x2d, 0x2d, 0xc0, 0x80, 0x80, 0x60 };
	uint8_t expect11[] = { 0xff, 0x11, 0x11, 0xff };
#ifdef MANUAL_IFSC
	uint8_t expect13[] =
	    { 0x00, 0xe1, 0x01, 0xb4, 0x54, 0x40, 0x98, 0xc1 };
#endif				/* MANUAL_IFSC */


	int rc;

	rc = usb_control_xmit(0xc1, 0x00, 0x0000, 0x0000, 0x0040, buffer);
	if (memcmp(buffer, expect5, sizeof(expect5)) != 0) {
		syslog(LOG_ERR, "ikey3k fatal: urb 5 bad match");
		return USBTOKEN_ERROR;
	}

	rc = usb_control_xmit(0x41, 0x16, 0x0000, 0x0000, 0x0000, buffer);
	if (rc != 0) {
		syslog(LOG_ERR, "ikey3k fatal: urb 6 returned %d", rc);
		return USBTOKEN_ERROR;
	}

	rc = usb_control_xmit(0xc1, 0x01, 0x0000, 0x0000, 0x0002, buffer);
	if (rc != 1 || buffer[0] != 0) {
		syslog(LOG_ERR,
		       "ikey3k fataiL: urb 7 returned %d, first byte %hhx",
		       rc, buffer[0]);
		return USBTOKEN_ERROR;
	}

	rc = usb_control_xmit(0x41, 0x16, 0x2005, 0x0000, 0x0000, buffer);
	if (rc != 0) {
		syslog(LOG_ERR, "ikey3k fatal: urb 8 returned %d", rc);
		return USBTOKEN_ERROR;
	}

	rc = usb_control_xmit(0xc1, 0x01, 0x0000, 0x0000, 0x0020, buffer);
	if (rc != 32) {
		syslog(LOG_ERR, "ikey3k fatal: urb 9 returned %d", rc);
		return USBTOKEN_ERROR;
	}

	if (rc < 1 || (rc < buffer[0])) {
		syslog(LOG_ERR, "ikey3k fatal: atr incomplete (%d/%hhd)",
		       rc, buffer[0]);
		return USBTOKEN_ERROR;
	}

	usbtoken.atr = malloc(buffer[0]);
	if (!usbtoken.atr) {
		syslog(LOG_ERR, "ikey3k fatal: could not malloc for atr");
		return USBTOKEN_ERROR;
	}
	memcpy(usbtoken.atr, &buffer[1], buffer[0]);
	usbtoken.atrlen = buffer[0];

	buffer[0] = 0x74;
	rc = usb_control_xmit(0x41, 0x16, 0x0002, 0x0000, 0x0001, buffer);
	if (rc != 1) {
		syslog(LOG_ERR, "ikey3k urb 10 returned %d", rc);
		return USBTOKEN_ERROR;
	}

	rc = usb_control_xmit(0xc1, 0x01, 0x0000, 0x0000, 0x0004, buffer);
	if (memcmp(buffer, expect11, sizeof(expect11)) != 0) {
		syslog(LOG_ERR, "ikey3k fatal: urb 11 bad match");
		return USBTOKEN_ERROR;
	}
#ifdef MANUAL_IFSC
	buffer[0] = 0x74;
	rc = usb_control_xmit(0x41, 0x17, 0xc100, 0xb401, 0x0001, buffer);
	if (rc != 1) {
		syslog(LOG_ERR, "ikey3k fatal: urb 12 returned %d", rc);
		return USBTOKEN_ERROR;
	}

	rc = usb_control_xmit(0xc1, 0x01, 0x0000, 0x0000, 0x0008, buffer);
	if (memcmp(buffer, expect13, sizeof(expect13)) != 0) {
		syslog(LOG_ERR, "ikey3k fatal: urb 13 bad match");
		return USBTOKEN_ERROR;
	}
#endif				/* MANUAL_IFSC */

	return USBTOKEN_OK;
}

int ikey3k_transmit(uint8_t * buf_send, int len_send,
		    uint8_t * buf_recv, int *len_recv)
{
	int rc;
	int value, index;

	value = buf_send[1] << 8 | buf_send[0];
	index = buf_send[3] << 8 | buf_send[2];

	/* send via usb */
	rc = usb_control_xmit(0x41, 0x17, value, index, len_send - 4,
			      &buf_send[4]);
	if (rc != len_send - 4) {
		syslog(LOG_ERR,
		       "ikey3k fatal: tranfer sending failed rc %d len %d",
		       rc, len_send);
		return USBTOKEN_ERROR;
	}

	/* receive answer via usb */
	rc = usb_control_xmit(0xc1, 0x01, 0x0000, 0x0000, usbtoken.ifsc,
			      buf_recv);
	if (rc == -1) {
		syslog(LOG_ERR,
		       "ikey3k fatal: tranfer receive failed rc %d", rc);
		return USBTOKEN_ERROR;
	}

	*len_recv = rc;

	return USBTOKEN_OK;
}