+ int i, ret, mask_len;
+ int tx_len, rx_len;
+ int num_valid = 0;
+ union {
+ struct iso15693_anticol_cmd_afi w_afi;
+ struct iso15693_anticol_cmd no_afi;
+ } acf;
+
+ struct iso15693_anticol_resp resp;
+
+ u_int8_t boc;
+#define MAX_SLOTS 16
+ int num_slots = MAX_SLOTS;
+
+ u_int8_t uuid_list[MAX_SLOTS][ISO15693_UID_LEN];
+ int uuid_list_valid[MAX_SLOTS];
+
+ u_int8_t flags;
+
+#define MY_NONE 0
+#define MY_COLL 1
+#define MY_UUID 2
+
+ memset(uuid_list_valid, MY_NONE, sizeof(uuid_list_valid));
+ memset(uuid_list, 0, sizeof(uuid_list));
+
+ //memset(&acf, 0, sizeof(acf));
+
+ /* FIXME: we can't use multiple slots at this point, since the RC632
+ * with librfid on the host PC has too much latency between 'EOF pulse
+ * to mark start of next slot' and 'receive data' commands :( */
+
+ flags = RFID_15693_F_INV_TABLE_5;
+ if (handle->priv.iso15693.vicc_fast)
+ flags |= RFID_15693_F_RATE_HIGH;
+ if (handle->priv.iso15693.vicc_two_subc)
+ flags |= RFID_15693_F_SUBC_TWO;
+ if (handle->priv.iso15693.single_slot) {
+ flags |= RFID_15693_F5_NSLOTS_1;
+ num_slots = 1;
+ }
+ 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("slot[%d]: timeout\n",i);
+ uuid_list_valid[i] = MY_NONE;
+ } else if (ret < 0) {
+ 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("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 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) {
+ 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;
+
+ return num_valid;
+}
+
+static int
+iso15693_select(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_SELECT;
+ 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);
+
+ 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;