#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;
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;
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");
}
/* 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);
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();
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;
}