X-Git-Url: https://hackdaworld.org/gitweb/?p=rfid%2Flibrfid.git;a=blobdiff_plain;f=gemtag%2Fgemtag.c;fp=gemtag%2Fgemtag.c;h=c2b24d7f19350f53fdd5ada62cadfd2b204891b0;hp=19ccc637842862ce855b339cf5b2e0155c6a01f4;hb=b9ec871784f1408d26e24bd29e9084017239543d;hpb=698a0e4b024bf89b9862fdebfbd673f0bdc6a118

diff --git a/gemtag/gemtag.c b/gemtag/gemtag.c
index 19ccc63..c2b24d7 100644
--- a/gemtag/gemtag.c
+++ b/gemtag/gemtag.c
@@ -24,6 +24,17 @@
 #include <usb.h>
 #include "gemtag.h"
 
+int asciidump(unsigned char *data,int len) {
+	int i;
+
+	for(i=0;i<len;i++)
+		if((data[i]>0x19)&&(data[i]<0x7f)) printf("%c",data[i]);
+		else printf("_");
+	printf("\n");
+
+	return 0;
+}
+
 int hexdump(unsigned char *data,int len) {
 	int i;
 
@@ -83,9 +94,8 @@ int gemtag_transcieve(struct gemtag_handle *gh,unsigned char cmd,
 	unsigned char rxbuf[256];
 	struct gemtag_cmd_hdr *txhdr;
 	struct gemtag_cmd_hdr *rxhdr;
-	unsigned char buf[32];
 	u_int16_t crc,*crcptr;
-	int ret,size;
+	int i,ret,size,rest;
 
 	txhdr=(struct gemtag_cmd_hdr *)txbuf;
 	rxhdr=(struct gemtag_cmd_hdr *)rxbuf;
@@ -93,22 +103,25 @@ int gemtag_transcieve(struct gemtag_handle *gh,unsigned char cmd,
 	txhdr->start=0xa5;
 	txhdr->seq=++(gh->seq);
 	txhdr->cmd=cmd;
- 	txhdr->len=(tx_len>>8)|(tx_len<<8);
+ 	txhdr->len=tx_len;
 	size=sizeof(struct gemtag_cmd_hdr);
 	memcpy(txbuf+size,tx,tx_len);
 	size+=tx_len;
 
 	/* crc check */
-	if(gh->capabilities&GEMTAG_CAP_CRC) {
+	if(gh->caps&GEMTAG_CAP_CRC) {
 		crcptr=(u_int16_t *)(txbuf+size);
 		crc=gemtag_calc_crc(txbuf,size);
-		*crcptr=(crc>>8)|(crc<<8);
+		//*crcptr=(crc>>8)|(crc<<8);
+		*crcptr=crc;
 		size+=2;
 	}
 
 	/* usb write */
-	printf("(%02d) -> ",size);
-	hexdump(txbuf,size);
+	if(gh->caps&GEMTAG_CAP_VERB_TRANSMIT) {
+		printf("(%02d) -> ",size);
+		hexdump(txbuf,size);
+	}
 	ret=usb_interrupt_write(gh->handle,0x02,txbuf,size,0);
 	if(ret<=0) {
 		perror("usb interrupt write");
@@ -116,35 +129,53 @@ int gemtag_transcieve(struct gemtag_handle *gh,unsigned char cmd,
 	}
 
 	/* usb read */
-	ret=usb_interrupt_read(gh->handle,0x81,buf,32,0);
+	ret=usb_interrupt_read(gh->handle,0x81,rxbuf,32,0);
 	if(ret<=0) {
 		perror("usb interrupt read");
 		return ret;
 	}
-	memcpy(rxbuf,buf,ret);
-	printf("(%02d) <- ",ret);
-	hexdump(rxbuf,ret);
+	if(ret<5) {
+		if(gh->caps&GEMTAG_CAP_VERB_TRANSMIT)
+			printf("short answer (%d)\n",ret);
+		return -SHORT_ANSWER;
+	}
 
-	*rx_len=buf[3]|(buf[4]<<8);
-	printf("debug: length according to header -> %d 0x%04x\n",
-	       *rx_len,*rx_len);
-	size=*rx_len+5;
+	*rx_len=rxbuf[3]|(rxbuf[4]<<8);
+	size=*rx_len+sizeof(struct gemtag_cmd_hdr); 
+	if(gh->caps&GEMTAG_CAP_CRC) size+=2;
+
+	i=1;
+	rest=size-ret;
+	while(rest>=0) {
+		ret=usb_interrupt_read(gh->handle,0x81,rxbuf+i*32,32,0);
+		if(ret<=0) {
+			perror("usb interrupt read (missing bytes)");
+			return ret;
+		}
+		i++;
+		rest-=ret;
+	}
+
+	if(gh->caps&GEMTAG_CAP_VERB_TRANSMIT) {
+		printf("(%02d) <- ",size);
+		hexdump(rxbuf,size);
+	}
 
 	/* crc check */
-	if(gh->capabilities&GEMTAG_CAP_CRC) {
-		size=ret-2;
+	if(gh->caps&GEMTAG_CAP_CRC) {
+		size-=2;
 		crcptr=(u_int16_t *)(rxbuf+size);
 		crc=gemtag_calc_crc(rxbuf,size);
 		if(((crc>>8)!=rxbuf[size+1])||((crc&0xff)!=rxbuf[size])) {
 			printf("bad crc! (%04x)\n",crc);
-			//return -BAD_CRC;
+			return -BAD_CRC;
 		}
 	}
 
 	/* check sequence number */	
 	if(rxhdr->seq!=txhdr->seq) {
 		puts("transmitted/recieved sequence number do not match");
-		//return -SEQ_MISMATCH;
+		return -SEQ_MISMATCH;
 	}
 
 	memcpy(rx,rxbuf+sizeof(struct gemtag_cmd_hdr),*rx_len);
@@ -154,13 +185,10 @@ int gemtag_transcieve(struct gemtag_handle *gh,unsigned char cmd,
 
 struct gemtag_handle *gemtag_open(void) {
 	struct usb_device *gemtag;
-	unsigned char rbuf[256];
-	unsigned int i,rlen;
+	unsigned int i;
 	struct gemtag_handle *gh;
 	char info[64];
 
-	rlen=sizeof(rbuf);
-
 	usb_init();
 	usb_find_busses();
 	usb_find_devices();
@@ -200,26 +228,64 @@ struct gemtag_handle *gemtag_open(void) {
 		perror("set alt interface");
 	printf("activated alt setting 0\n");
 
-	gh->capabilities|=GEMTAG_CAP_CRC;
-
-	gemtag_transcieve(gh,GEMTAG_CMD_GET_FW_VERSION,
-	                  NULL,0,rbuf,&rlen);
-	gemtag_transcieve(gh,GEMTAG_CMD_GET_SERIAL_NUMBER,
-	                  NULL,0,rbuf,&rlen);
-
 	return gh;
 
 out_free:
 	free(gh);
 	return NULL;
 }
+
+int gemtag_close(struct gemtag_handle *gh) {
+
+	if(gh->handle) usb_close(gh->handle);
+	if(gh) free(gh);
+
+	return 0;
+}
+
 	
 int main(int argc, char **argv) {
 
 	struct gemtag_handle *gh;
+	unsigned char buf[256];
+	unsigned int buflen;
 
 	gh=gemtag_open();
 
+	gh->caps|=GEMTAG_CAP_CRC;
+	gh->caps|=GEMTAG_CAP_VERB_TRANSMIT;
+
+	printf("Device:\n");
+	gemtag_transcieve(gh,GEMTAG_CMD_GET_FW_VERSION,
+			  NULL,0,buf,&buflen);
+	asciidump(buf,buflen);
+	printf("\n");
+
+	printf("Serial Number:\n");
+	gemtag_transcieve(gh,GEMTAG_CMD_GET_SERIAL_NUMBER,
+	                  NULL,0,buf,&buflen);
+	printf("Snr: %d (%04x)\n",buf[1]<<8|buf[0],buf[1]<<8|buf[0]);
+	printf("\n");
+
+	printf("RC632 Version:\n");
+	gemtag_transcieve(gh,GEMTAG_CMD_GET_RIC_VERSION,
+	                  NULL,0,buf,&buflen);
+	printf("\n");
+
+	printf("Switching off the LED!\n");
+	buf[0]=GEMTAG_LED_OFF;
+	gemtag_transcieve(gh,GEMTAG_CMD_SWITCH_LED,
+	                  buf,1,buf,&buflen);
+	printf("\n");
+
+	printf("Detecting Card ...\n");
+	gemtag_transcieve(gh,GEMTAG_CMD_DETECT_CARD,
+	                  NULL,0,buf,&buflen);
+	asciidump(buf,buflen);
+	printf("\n");
+
+	gemtag_close(gh);
+
 	return 1;
 }