X-Git-Url: http://git.rot13.org/?a=blobdiff_plain;f=src%2Frfid_layer2_iso15693.c;h=8f694cdd967f9478bc27c4b47b6dbc99b9428b2d;hb=f05760f4053e2e77cbb922998d2b652176f93abd;hp=5547ec913ab0474772d6f3d6db61ca969aef8ed4;hpb=7142d7da7ac0264e16f23f2e8319f3fd01e11470;p=librfid

diff --git a/src/rfid_layer2_iso15693.c b/src/rfid_layer2_iso15693.c
index 5547ec9..8f694cd 100644
--- a/src/rfid_layer2_iso15693.c
+++ b/src/rfid_layer2_iso15693.c
@@ -60,6 +60,33 @@ const unsigned int iso15693_timing[2][5] = {
 	},
 };
 
+char *
+iso15693_get_response_error_name(u_int8_t error){
+	switch (error){
+		case RFID_15693_ERR_NOTSUPP:
+			return "ERR_NOTSUPP";
+		case RFID_15693_ERR_INVALID: /* command not recognized */
+			return "ERR_INVALID";
+		case RFID_15693_ERR_UNKNOWN: /* unknown error */
+			return "ERR_UNKNOWN";
+		case RFID_15693_ERR_BLOCK_NA: /* block not available */
+			return "ERR_BLOCK_N";
+		case RFID_15693_ERR_BLOCK_LOCKED:
+			return "ERR_BLOCK_LOCKE";
+		case RFID_15693_ERR_BLOCK_LOCKED_CH:
+			return "ERR_BLOCK_LOCKED_CH";
+		case RFID_15693_ERR_BLOCK_NOTPROG:
+			return "ERR_BLOCK_NOTPROG";
+		case RFID_15693_ERR_BLOCK_NOTLOCK:
+			return "ERR_BLOCK_NOTLOCK";
+		case 0xA0: /* until 0xDF*/
+			return "Custom Command error Code";
+		case 0xE0:
+		default:
+			return "Undef.";
+	}
+}
+
 static int iso15693_transceive(struct rfid_layer2_handle *handle,
 			       enum rfid_frametype frametype,
 			       const unsigned char *tx_buf, unsigned int tx_len,
@@ -140,7 +167,9 @@ iso15693_build_acf(u_int8_t *target, u_int8_t flags, u_int8_t afi,
 		   u_int8_t mask_len, u_int8_t *mask)
 {
 	struct iso15693_request *req = (struct iso15693_request *) target;
-	int i = 0, j;
+	int i = 0, j, mask_bytes;
+	u_int8_t byte=0;
+	void* mask_p;
 
 	req->flags = flags;
 	req->command = ISO15693_CMD_INVENTORY;
@@ -148,16 +177,24 @@ iso15693_build_acf(u_int8_t *target, u_int8_t flags, u_int8_t afi,
 		req->data[i++] = afi;
 	req->data[i++] = mask_len;
 
-	for (j = 0; j < mask_len; j++)
+	mask_bytes = mask_len/8 + (mask_len%8)?1:0;
+	mask_p=&req->data[i];
+
+	for (j = 0; j < mask_bytes; j++)
 		req->data[i++] = mask[j];
-	
+
+	byte = 0xFF >> (8-mask_len%8);
+	req->data[i-1]&=byte;
+
+	DEBUGP("mask_len: %d mask_bytes: %d i: %d return: %d mask:%s\n",
+		mask_len,mask_bytes,i,i + sizeof(*req),rfid_hexdump(mask_p,mask_bytes));
 	return i + sizeof(*req);
 }
 
 static int
 iso15693_anticol(struct rfid_layer2_handle *handle)
 {
-	int i, ret;
+	int i, ret, mask_len;
 	int tx_len, rx_len;
 	int num_valid = 0;
 	union {
@@ -167,7 +204,7 @@ iso15693_anticol(struct rfid_layer2_handle *handle)
 
 	struct iso15693_anticol_resp resp;
 		
-	char boc;
+	u_int8_t boc;
 #define MAX_SLOTS 16	
 	int num_slots = MAX_SLOTS;
 
@@ -200,51 +237,113 @@ iso15693_anticol(struct rfid_layer2_handle *handle)
 	}
 	if (handle->priv.iso15693.use_afi)
 		flags |= RFID_15693_F5_AFI_PRES;
-
+#if 1
 	tx_len = iso15693_build_acf((u_int8_t *)&acf, flags,
 				    handle->priv.iso15693.afi, 0, NULL);
-
+#else
+	/*FIXME: testcode*/
+	u_int8_t uid[8]={0x1f, 0x1e, 0x95, 0x01, 0x00, 0x01, 0x04, 0xe0};
+	//u_int8_t uid[8]={0xe3, 0xe8, 0xf1, 0x01, 0x00, 0x00, 0x07, 0xe0};
+	tx_len = iso15693_build_acf((u_int8_t *)&acf, flags,
+				    handle->priv.iso15693.afi, 2, uid);
+#endif
+start_of_ac_loop:
 	for (i = 0; i < num_slots; i++) {
 		rx_len = sizeof(resp);
+		memset(&resp, 0, rx_len);
 		ret = iso15693_transceive_acf(handle, (u_int8_t *) &acf, tx_len, &resp, &rx_len, &boc);
+
 		if (ret == -ETIMEDOUT) {
-			DEBUGP("no answer from vicc in slot %d\n", i);
+			//DEBUGP("no answer from vicc in slot %d\n", i);
+			DEBUGP("slot[%d]: timeout\n",i);
 			uuid_list_valid[i] = MY_NONE;
 		} else if (ret < 0) {
-			DEBUGP("ERROR ret: %d, slot %d\n", ret, i);
+			DEBUGP("slot[%d]: ERROR ret: %d\n", i, ret);
 			uuid_list_valid[i] = MY_NONE;
 		} else {
-
+			if (ret)
+				DEBUGP("iso15693_transceive_acf() ret: %d\n",ret);
 			if (boc) {
-				DEBUGP("Collision during anticol. slot %d bit %d\n",
-					i, boc);
-				uuid_list_valid[i] = -boc;
+				DEBUGP("slot[%d]: Collision! bit:%d byte:%d,%d (UID bit:%d byte:%d,%d)\n",
+					i, boc,boc/8,boc%8,
+					boc-16,(boc-16)/8,(boc-16)%8);
+				DEBUGP("Slot[%d]: ret: %d DSFID: %02x UUID: %s\n", i, ret,
+					resp.dsfid, rfid_hexdump(resp.uuid, ISO15693_UID_LEN));
+
+				uuid_list_valid[i]=-boc;
 				memcpy(uuid_list[i], resp.uuid, ISO15693_UID_LEN);
 			} else {
-				DEBUGP("Slot %d ret: %d UUID: %s\n", i, ret,
-					rfid_hexdump(resp.uuid, ISO15693_UID_LEN));
+				DEBUGP("Slot[%d]: ret: %d DSFID: %02x UUID: %s\n", i, ret,
+					resp.dsfid, rfid_hexdump(resp.uuid, ISO15693_UID_LEN));
 				uuid_list_valid[i] = MY_UUID;
 				memcpy(&uuid_list[i][0], resp.uuid, ISO15693_UID_LEN);
+
+				memcpy(handle->uid,resp.uuid, ISO15693_UID_LEN);
+				/* FIXME: move to init_iso15693 */
+				handle->uid_len = ISO15693_UID_LEN;
+				return 1;
 			}
 		}
 	}
 
+
+	for (i = 0; i < num_slots; i++) {
+		if (uuid_list_valid[i] < 0) {
+			boc=uuid_list_valid[i]*-1;
+			if (boc>16){
+				boc=boc-16;
+			}
+			else
+				DEBUGP("slot[%d]:boc is smaller than 2 bytes (collision before uid)!!!!\n",i);
+
+			if (boc<65){
+				tx_len = iso15693_build_acf((u_int8_t *)&acf, flags,
+				    handle->priv.iso15693.afi, boc+1,  resp.uuid);
+				boc=0;
+				// FIXME: dont use goto
+				goto start_of_ac_loop;
+			}else{
+				DEBUGP("slot[%d]:boc is bigger than 64 (uid size)(collision after uid)\n",i);
+				memcpy(handle->uid,uuid_list[i],ISO15693_UID_LEN);
+
+				/* FIXME: move to init_iso15693 */
+				handle->uid_len = ISO15693_UID_LEN;
+				return 1;
+			}
+		}
+	}
+#if 0
 	for (i = 0; i < num_slots; i++) {
 		if (uuid_list_valid[i] == MY_NONE) {
 			DEBUGP("slot[%d]: timeout\n",i);
 		} else if (uuid_list_valid[i] == MY_UUID) {
 			DEBUGP("slot[%d]: VALID uuid: %s\n", i,
 				rfid_hexdump(uuid_list[i], ISO15693_UID_LEN));
+			memcpy(handle->uid, uuid_list[i], ISO15693_UID_LEN);
+			/* FIXME: move to init_iso15693 */
+			handle->uid_len = ISO15693_UID_LEN;
 			num_valid++;
 		} else if (uuid_list_valid[i] < 0) {
-			DEBUGP("slot[%d]: collision(%d %d,%d) uuid: %s\n",
-				i,uuid_list_valid[i]*-1,
-				(uuid_list_valid[i]*-1)/8,
-				(uuid_list_valid[i]*-1)%8,
-			rfid_hexdump(uuid_list[i], ISO15693_UID_LEN));
+ 				if (boc>16){
+ 					boc=boc-16;
+ 				}
+ 				else
+ 					DEBUGP("boc is smaller than 2 bytes (collision before uid)!!!!\n");
+
+ 				uuid_list_valid[i] = -boc;
+ 				if (boc<65){
+ 					tx_len = iso15693_build_acf((u_int8_t *)&acf, flags,
+ 					    handle->priv.iso15693.afi, boc+1,  resp.uuid);
+ 					boc=0;
+ 					// FIXME: dont use goto
+ 					goto start_of_ac_loop;
+ 				}else{
+ 					DEBUGP("boc is bigger than 64 (uid size)\n");
+ 					uuid_list_valid[i] = MY_UUID;
+ 				}
 		}
 	}
-
+#endif
 	if (num_valid == 0)
 		return -1;
 
@@ -252,7 +351,7 @@ iso15693_anticol(struct rfid_layer2_handle *handle)
 }
 
 static int
-iso15693_select(struct rfid_layer2_handle *handle)
+iso15693_select(struct rfid_layer2_handle *l2h)
 {
 	struct iso15693_request_adressed tx_req;
 	int ret;
@@ -266,18 +365,68 @@ iso15693_select(struct rfid_layer2_handle *handle)
 	rx_len = sizeof(rx_buf);
 
 	tx_req.head.command = ISO15693_CMD_SELECT;
-	tx_req.head.flags = RFID_15693_F4_ADDRESS | RFID_15693_F_SUBC_TWO ;
-	tx_req.uid = 0xE0070000020C1F18;
-	//req.uid = 0x181F0C02000007E0;
-	//req.uid = 0xe004010001950837;
-	//req.uid = 0x37089501000104e0;
+	tx_req.head.flags = RFID_15693_F4_ADDRESS;
+	if (l2h->priv.iso15693.vicc_fast)
+		tx_req.head.flags |= RFID_15693_F_RATE_HIGH;
+	if (l2h->priv.iso15693.vicc_two_subc)
+		tx_req.head.flags |= RFID_15693_F_SUBC_TWO;
+	memcpy(&tx_req.uid, l2h->uid, ISO15693_UID_LEN);
 	tx_len = sizeof(tx_req);
+
 	DEBUGP("tx_len=%u", tx_len); DEBUGPC(" rx_len=%u\n",rx_len);
-	ret = iso15693_transceive(handle, RFID_15693_FRAME, (u_int8_t*)&tx_req,
-				  tx_len, (u_int8_t*)&rx_buf, &rx_len, 50,0);
-	DEBUGP("ret: %d, error_flag: %d error: %d\n", ret,
-		rx_buf.head.flags&RFID_15693_RF_ERROR, 0);
-	return -1;
+
+	DEBUGP("ret: %d%s, error_flag: %d", ret,(ret==-ETIMEDOUT)?"(TIMEOUT)":"",
+			rx_buf.head.flags&RFID_15693_RF_ERROR);
+	if (rx_buf.head.flags&RFID_15693_RF_ERROR){
+		DEBUGPC(" -> error: %02x '%s'\n", rx_buf.error,
+			iso15693_get_response_error_name(rx_buf.error));
+		l2h->priv.iso15693.state = RFID_15693_STATE_SELECTED;
+		return 0;
+	}else{
+		DEBUGPC("\n");
+		return -1;
+	}
+}
+
+static int
+iso15693_stay_quiet(struct rfid_layer2_handle *l2h)
+{
+	struct iso15693_request_adressed tx_req;
+	int ret;
+	unsigned int rx_len, tx_len;
+
+	struct {
+		struct iso15693_response head;
+		u_int8_t error;
+		unsigned char crc[2];
+	} rx_buf;
+	rx_len = sizeof(rx_buf);
+
+	tx_req.head.command = ISO15693_CMD_STAY_QUIET;
+
+	tx_req.head.flags = RFID_15693_F4_ADDRESS;
+	if (l2h->priv.iso15693.vicc_fast)
+		tx_req.head.flags |= RFID_15693_F_RATE_HIGH;
+	if (l2h->priv.iso15693.vicc_two_subc)
+		tx_req.head.flags |= RFID_15693_F_SUBC_TWO;
+	memcpy(&tx_req.uid, l2h->uid, ISO15693_UID_LEN);
+	tx_len = sizeof(tx_req);
+
+	DEBUGP("tx_len=%u", tx_len); DEBUGPC(" rx_len=%u\n",rx_len);
+
+	ret = iso15693_transceive(l2h, RFID_15693_FRAME, (u_int8_t*)&tx_req,
+				  tx_len, (u_int8_t*)&rx_buf, &rx_len, 30,0);
+
+	l2h->priv.iso15693.state = RFID_15693_STATE_QUIET;
+
+	DEBUGP("ret: %d%s, error_flag: %d", ret,(ret==-ETIMEDOUT)?"(TIMEOUT)":"",
+			rx_buf.head.flags&RFID_15693_RF_ERROR);
+	if (rx_buf.head.flags&RFID_15693_RF_ERROR)
+		DEBUGPC(" -> error: %02x\n", rx_buf.error);
+	else
+		DEBUGPC("\n");
+
+	return 0;
 }
 
 static int
@@ -421,7 +570,7 @@ iso15693_setopt(struct rfid_layer2_handle *handle, int optname,
 		if (val)
 			handle->priv.iso15693.use_afi = 1;
 		else
-			handle->priv.iso15693.use_afi = 1;
+			handle->priv.iso15693.use_afi = 0;
 		break;
 	case RFID_OPT_15693_AFI:
 		if (val > 0xff)
@@ -483,7 +632,7 @@ const struct rfid_layer2 rfid_layer2_iso15693 = {
 		.open 		= &iso15693_anticol,
 		//.open		= &iso15693_select,
 		//.transceive 	= &iso15693_transceive,
-		//.close 		= &iso14443a_hlta,
+		.close 		= &iso15693_stay_quiet,
 		.fini 		= &iso15693_fini,
 		.setopt		= &iso15693_setopt,
 		.getopt		= &iso15693_getopt,