From d78e768b132a7fe1e87410cc07daf555271c018b Mon Sep 17 00:00:00 2001
From: hackbard <hackbard>
Date: Tue, 21 Mar 2006 18:16:47 +0000
Subject: [PATCH] added write16 function (not working by now)

---
 gemtag/gemtag.c | 63 +++++++++++++++++++++++++++++++++----------------
 gemtag/gemtag.h | 24 +++++++++++++++++--
 2 files changed, 65 insertions(+), 22 deletions(-)

diff --git a/gemtag/gemtag.c b/gemtag/gemtag.c
index 48dc427..d6191ba 100644
--- a/gemtag/gemtag.c
+++ b/gemtag/gemtag.c
@@ -29,7 +29,7 @@ int asciidump(unsigned char *data,int len) {
 
 	for(i=0;i<len;i++)
 		if((data[i]>0x19)&&(data[i]<0x7f)) printf("%c",data[i]);
-		else printf("_");
+		else printf(".");
 	//printf("\n");
 
 	return 0;
@@ -261,7 +261,7 @@ int gemtag_auth_mifare_key(struct gemtag_handle *gh,
 
 	gemtag_transform_mifare_key(gh,key6,key12);
 	                     
-	buf[0]=0x60; /* auth mode */
+	buf[0]=GEMTAG_PICC_AUTHENT1A; 	/* auth mode */
 	memcpy(buf+1,gh->serial,4);	/* sreial */
 	memcpy(buf+5,key12,12); 	/* transformed key */
 	buf[17]=sector; 		/* sector */
@@ -272,21 +272,32 @@ int gemtag_auth_mifare_key(struct gemtag_handle *gh,
 	return 0;
 }
 
-int gemtag_read16(struct gemtag_handle *gh,int sector,
-                  unsigned char *data) {
+int gemtag_read16(struct gemtag_handle *gh,int sector,unsigned char *data) {
 
 	unsigned char buf[32];
 	int len,ret;
 
 	buf[0]=sector;
-	ret=gemtag_transceive(gh,GEMTAG_CMD_PICC_READ,
-	                      buf,1,data,&len);
+	ret=gemtag_transceive(gh,GEMTAG_CMD_PICC_READ,buf,1,data,&len);
 	if(ret) return -READ_FAILED;
 
 	return 0;
 }
 
-int gemtag_pick_picc(struct gemtag_handle *gh) {
+int gemtag_write16(struct gemtag_handle *gh,int sector,unsigned char *data) {
+
+	unsigned char buf[32];
+	int ret,len;
+
+	buf[0]=GEMTAG_PICC_WRITE16;
+	buf[1]=sector;
+	memcpy(buf+2,data,16);
+	ret=gemtag_transceive(gh,GEMTAG_CMD_COMMON_WRITE,buf,18,buf,&len);
+
+	return ret;
+}
+
+int gemtag_select_picc(struct gemtag_handle *gh) {
 
 	unsigned char buf[16];
 	unsigned int len;
@@ -309,13 +320,13 @@ int gemtag_pick_picc(struct gemtag_handle *gh) {
 
 	return 0;
 }
-	
+
 int main(int argc, char **argv) {
 
 	struct gemtag_handle *gh;
 	unsigned char buf[256];
 	unsigned char key6[6];
-	int i;
+	int i,ret;
 
 	gh=gemtag_open();
 
@@ -330,7 +341,7 @@ int main(int argc, char **argv) {
 	printf("\n");
 	*/
 
-	if(gemtag_pick_picc(gh)) {
+	if(gemtag_select_picc(gh)) {
 		printf("no card found!\n");
 		return -NO_PICC;
 	}
@@ -338,17 +349,29 @@ int main(int argc, char **argv) {
 	memset(key6,0xff,6);
 	printf("\nreading sectors ... (serial: %02x %02x %02x %02x)\n\n",
 	       gh->serial[3],gh->serial[2],gh->serial[1],gh->serial[0]);
-	for(i=0;i<256;i++) {
-		gemtag_auth_mifare_key(gh,key6,i);
-		if(!gemtag_read16(gh,i,buf)) {
-			printf("%02x: ",i++);
-			hexdump(buf,16);
-			printf(" | ");
-			asciidump(buf,16);
-			printf("\n");
-		}
-		else return 0;
+	i=0;
+	while(!gemtag_auth_mifare_key(gh,key6,i)) {
+		gemtag_read16(gh,i,buf);
+		printf("%02x: ",i);
+		hexdump(buf,16);
+		printf(" | ");
+		asciidump(buf,16);
+		printf("\n");
+		i+=1;
 	}
+	printf("\n");
+
+	/* try to write some data
+	printf("write some data to the 5th sector:\n");
+	for(i=0;i<16;i++) buf[i]=i;
+	i=4;
+	ret=gemtag_write16(gh,i,buf);
+	printf("return = %d\n",ret);
+	gemtag_read16(gh,i,buf);
+	printf("%02x: ",i);
+	hexdump(buf,16);
+	printf("\n");
+	*/
 
 	gemtag_close(gh);
 
diff --git a/gemtag/gemtag.h b/gemtag/gemtag.h
index fa716f8..dfdfa64 100644
--- a/gemtag/gemtag.h
+++ b/gemtag/gemtag.h
@@ -44,8 +44,9 @@ struct gemtag_cmd_hdr {
 #define CMD_FAILED			0x04
 #define AUTH_FAILED			0x05
 #define READ_FAILED			0x06
-#define NO_PICC				0x07
-#define PICC_SELECT_ERROR		0x08
+#define WRITE_FAILED			0x07
+#define NO_PICC				0x08
+#define PICC_SELECT_ERROR		0x09
 
 /* gemtag commands */
 
@@ -119,4 +120,23 @@ struct gemtag_cmd_hdr {
 #define GEMTAG_CMD_PPS_REQUEST		0xa0
 #define GEMTAG_CMD_DESELECT		0xa1
 
+
+/* function prototypes */
+int asciidump(unsigned char *data,int len);
+int hexdump(unsigned char *data,int len);
+struct usb_device *find_device(unsigned short vendor,unsigned short device);
+u_int16_t gemtag_calc_crc(unsigned char *data,u_int16_t len);
+int gemtag_transceive(struct gemtag_handle *gh,unsigned char cmd,
+                      unsigned char *tx,unsigned int tx_len,
+                      unsigned char *rx,unsigned int *rx_len);
+struct gemtag_handle *gemtag_open(void);
+int gemtag_close(struct gemtag_handle *gh);
+int gemtag_transform_mifare_key(struct gemtag_handle *gh,
+                                unsigned char *key6,unsigned char *key12);
+int gemtag_auth_mifare_key(struct gemtag_handle *gh,
+                           unsigned char *key6,int sector);
+int gemtag_read16(struct gemtag_handle *gh,int sector,unsigned char *data);
+int gemtag_write16(struct gemtag_handle *gh,int sector,unsigned char *data);
+int gemtag_select_picc(struct gemtag_handle *gh);
+
 #endif
-- 
2.20.1