X-Git-Url: http://git.rot13.org/?a=blobdiff_plain;f=src%2Frfid_layer2_iso15693.c;h=a4829ccc06e040c670cf99f071ecd4cdef96c5ef;hb=893a580c6f1c7f1cc50d9bd1acc51c9fd6307a17;hp=8c5d808e26dd1456140c0ee9057b52bb9f0deb4e;hpb=858b4d3edd15139b2be05e5ca811b1ceab70d79e;p=librfid diff --git a/src/rfid_layer2_iso15693.c b/src/rfid_layer2_iso15693.c index 8c5d808..a4829cc 100644 --- a/src/rfid_layer2_iso15693.c +++ b/src/rfid_layer2_iso15693.c @@ -1,12 +1,12 @@ /* ISO 15693 anticollision implementation * - * (C) 2005 by Harald Welte - * + * (C) 2005-2008 by Harald Welte + * (C) 2007 by Bjoern Riemer */ /* * This program is free software; you can redistribute it and/or modify - * it under the terms of the GNU General Public License version 2 + * it under the terms of the GNU General Public License version 2 * as published by the Free Software Foundation * * This program is distributed in the hope that it will be useful, @@ -16,264 +16,773 @@ * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software - * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA + * Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA */ +//#define DEBUG_LIBRFID #include #include #include +#include #include #include #include #include -#if 0 -/* Transceive a 7-bit short frame */ -static int -iso14443a_transceive_sf(struct rfid_layer2_handle *handle, - unsigned char cmd, - struct iso14443a_atqa *atqa) -{ - struct rfid_reader *rdr = handle->rh->reader; +/*struct iso15693_request_read { + struct iso15693_request head; + u_int64_t uid; + u_int8_t blocknum; +} __attribute__ ((packed));*/ + +struct iso15693_request_adressed { + struct iso15693_request head; + u_int64_t uid; +} __attribute__ ((packed)); + +struct iso15693_request_block_addressed { + struct iso15693_request head; + u_int64_t uid; + u_int8_t blocknum; + u_int8_t data[0]; +} __attribute__ ((packed)); + +struct iso15693_request_block_selected { + struct iso15693_request head; + u_int8_t blocknum; + u_int8_t data[0]; +} __attribute__ ((packed)); + +struct iso15693_err_resp { + struct iso15693_response head; + u_int8_t error; + unsigned char crc[2]; +} __attribute__ ((packed)); + +struct iso15693_response_sec { + struct iso15693_response head; + u_int8_t block_sec; + u_int8_t data[]; +} __attribute__ ((packed)); + +#define ISO15693_BLOCK_SIZE_MAX (256/8) +#define ISO15693_RESP_SIZE_MAX (4+ISO15693_BLOCK_SIZE_MAX) + +const unsigned int iso15693_timing[2][5] = { + [ISO15693_T_SLOW] = { + [ISO15693_T1] = 1216, /* max time after VCD EOF before VICC SOF */ + [ISO15693_T2] = 1200, /* min time before VCD EOF after VICC response */ + [ISO15693_T3] = 1502, /* min time after VCD EOF before next EOF if no VICC response */ + [ISO15693_T4] = 1216, /* time after wich VICC transmits after VCD EOF */ + [ISO15693_T4_WRITE]=20000, /* time after wich VICC transmits after VCD EOF */ + }, + [ISO15693_T_FAST] = { + [ISO15693_T1] = 304, /* max time after VCD EOF before VICC SOF */ + [ISO15693_T2] = 300, /* min time before VCD EOF after VICC response */ + [ISO15693_T3] = 602, /* min time after VCD EOF before next EOF if no VICC response */ + [ISO15693_T4] = 304, /* time after wich VICC transmits after VCD EOF */ + [ISO15693_T4_WRITE]=20000, /* time after wich VICC transmits after VCD EOF */ + }, +}; - return rdr->iso14443a.transceive_sf(handle->rh, cmd, atqa); +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_NOTSUPP_OPTION: + return "ERR_NotSuppOpt"; + 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."; + } } -/* Transmit an anticollission bit frame */ -static int -iso14443a_transceive_acf(struct rfid_layer2_handle *handle, - struct iso14443a_anticol_cmd *acf, - unsigned int *bit_of_col) +static int iso15693_transceive(struct rfid_layer2_handle *handle, + enum rfid_frametype frametype, + const unsigned char *tx_buf, unsigned int tx_len, + unsigned char *rx_buf, unsigned int *rx_len, + u_int64_t timeout, unsigned int flags) { - struct rfid_reader *rdr = handle->rh->reader; - - return rdr->iso14443a.transceive_acf(handle->rh, acf, bit_of_col); + return handle->rh->reader->transceive(handle->rh, frametype, tx_buf, + tx_len, rx_buf, rx_len, timeout, flags); } -/* Transmit a regular frame */ -static int -iso14443a_transceive(struct rfid_layer2_handle *handle, - const unsigned char *tx_buf, unsigned int tx_len, - unsigned char *rx_buf, unsigned int *rx_len, - u_int64_t, unsigned int flags) +/* Transmit an anticollission frame */ +static int +iso15693_transceive_acf(struct rfid_layer2_handle *handle, + const struct iso15693_anticol_cmd *acf, + unsigned int acf_len, + struct iso15693_anticol_resp *resp, + unsigned int *rx_len, char *bit_of_col) { - return handle->rh->reader->transceive(handle->rh, tx_buf, tx_len, - rx_buf, rx_len, timeout, flags); + const struct rfid_reader *rdr = handle->rh->reader; + if (!rdr->iso15693.transceive_ac) + return -1; + return rdr->iso15693.transceive_ac(handle->rh, acf, acf_len, resp, rx_len, bit_of_col); } -static int -iso14443a_code_nvb_bits(unsigned char *nvb, unsigned int bits) + +int +iso15693_read_block(struct rfid_layer2_handle *handle, + u_int8_t blocknr, u_int32_t *data, unsigned int len, + unsigned char *block_sec_out) { - unsigned int byte_count = bits / 8; - unsigned int bit_count = bits % 8; + union { + struct iso15693_request_block_selected sel; + struct iso15693_request_block_addressed addr; + } tx_req; - if (byte_count < 2 || byte_count > 7) - return -1; + int ret; + unsigned char *errstr; + unsigned int rx_len, tx_len,timeout; + u_int8_t resp[ISO15693_RESP_SIZE_MAX]; + struct iso15693_err_resp *rx_err; + struct iso15693_response *rx_pkt; + struct iso15693_response_sec *rx_pkt_sec; - *nvb = ((byte_count & 0xf) << 4) | bit_count; + rx_pkt_sec = (struct iso15693_response_sec *)&resp[0]; + rx_pkt = (struct iso15693_response *)&resp[0]; + rx_err = (struct iso15693_err_resp *)&resp[0]; - return 0; -} + memset(&tx_req,0,sizeof(tx_req)); -/* first bit is '1', second bit '2' */ -static void -set_bit_in_field(unsigned char *bitfield, unsigned int bit) -{ - unsigned int byte_count = bit / 8; - unsigned int bit_count = bit % 8; - - DEBUGP("bitfield=%p, byte_count=%u, bit_count=%u\n", - bitfield, byte_count, bit_count); - DEBUGP("%p = 0x%02x\n", (bitfield+byte_count), *(bitfield+byte_count)); - *(bitfield+byte_count) |= 1 << (bit_count-1); - DEBUGP("%p = 0x%02x\n", (bitfield+byte_count), *(bitfield+byte_count)); -} + rx_len = sizeof(resp); -static int -iso14443a_anticol(struct rfid_layer2_handle *handle) -{ - int ret; - unsigned int uid_size; - struct iso14443a_atqa atqa; - struct iso14443a_anticol_cmd acf; - unsigned int bit_of_col; - unsigned char sak[3]; - unsigned char uid[10]; // triple size equals 10 bytes; - unsigned int rx_len = sizeof(sak); - char *aqptr = (char *) &atqa; - static int first = 0; - - memset(uid, 0, sizeof(uid)); - memset(sak, 0, sizeof(sak)); - memset(&atqa, 0, sizeof(atqa)); - memset(&acf, 0, sizeof(acf)); - - if (first == 0) { - DEBUGP("Sending REQA\n"); - ret = iso14443a_transceive_sf(handle, ISO14443A_SF_CMD_REQA, &atqa); - first = 1; + tx_req.sel.head.command = ISO15693_CMD_READ_BLOCK_SINGLE; + + if (handle->priv.iso15693.vicc_fast){ + tx_req.sel.head.flags |= RFID_15693_F_RATE_HIGH; + timeout=iso15693_timing[ISO15693_T_FAST][ISO15693_T4]; + }else + timeout=iso15693_timing[ISO15693_T_SLOW][ISO15693_T4]; + + if (handle->priv.iso15693.vicc_two_subc) + tx_req.sel.head.flags |= RFID_15693_F_SUBC_TWO; + + if (block_sec_out!=NULL) + tx_req.sel.head.flags |= RFID_15693_F4_CUSTOM; + + if (handle->priv.iso15693.state==RFID_15693_STATE_SELECTED) { + tx_len = sizeof(struct iso15693_request_block_selected); + tx_req.sel.blocknum = blocknr; + tx_req.sel.head.flags |= RFID_15693_F4_SELECTED; } else { - DEBUGP("Sending WUPA\n"); - ret = iso14443a_transceive_sf(handle, ISO14443A_SF_CMD_WUPA, &atqa); + tx_len = sizeof(struct iso15693_request_block_addressed); + memcpy(&tx_req.addr.uid, handle->uid, ISO15693_UID_LEN); + tx_req.addr.head.flags |= RFID_15693_F4_ADDRESS; + tx_req.addr.blocknum = blocknr; } - if (ret < 0) { - handle->priv.iso14443a.state = ISO14443A_STATE_REQA_SENT; - DEBUGP("error during transceive_sf: %d\n", ret); + //DEBUGP("sizeof: addr: %d sel:%d\n",sizeof(struct iso15693_request_read_addressed),sizeof(struct iso15693_request_read_selected)); + 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, resp, &rx_len, timeout, 0); + + if (ret==-ETIMEDOUT) + errstr="(TIMEOUT)"; + else if (ret==-EIO) + errstr="(EIO)"; + else + errstr=""; + DEBUGP("length: %d rx_len: %d ret: %d%s\n",len,rx_len,ret,errstr); + + if (ret < 0) return ret; + + if (rx_len > len+1) + return -1; + DEBUGP("error_flag: %d", rx_pkt->flags&RFID_15693_RF_ERROR); + if (rx_pkt->flags & RFID_15693_RF_ERROR) { + DEBUGPC(" -> error: %02x '%s'\n", rx_err->error, + iso15693_get_response_error_name(rx_err->error)); + return -1; + } else if (block_sec_out != NULL) { + DEBUGPC(" block_sec_stat: 0x%02x\n",rx_pkt_sec->block_sec); + memcpy(data, rx_pkt_sec->data, rx_len-2); + return rx_len-2; + } else { + memcpy(data, rx_pkt->data, rx_len-1); /* FIXME rc-3 in case of CRC */ + return rx_len-1; } - handle->priv.iso14443a.state = ISO14443A_STATE_ATQA_RCVD; +} - DEBUGP("ATQA: 0x%02x 0x%02x\n", *aqptr, *(aqptr+1)); +int +iso15693_write_block(struct rfid_layer2_handle *handle, + u_int8_t blocknr, u_int32_t *data, unsigned int len) +{ + int ret; + unsigned char *errstr; + unsigned int rx_len, tx_len,timeout; + + union{ + struct iso15693_request_block_selected sel; + struct iso15693_request_block_addressed addr; + u_int32_t buf[sizeof(struct iso15693_request_block_addressed)+ISO15693_BLOCK_SIZE_MAX]; + } tx_req; + + u_int8_t resp[ISO15693_RESP_SIZE_MAX]; + struct iso15693_response *rx_pkt; + struct iso15693_err_resp *rx_err; - if (!atqa.bf_anticol) { - handle->priv.iso14443a.state =ISO14443A_STATE_NO_BITFRAME_ANTICOL; - DEBUGP("no bitframe anticollission bits set, aborting\n"); + rx_pkt = (struct iso15693_response *)&resp[0]; + rx_err = (struct iso15693_err_resp *)&resp[0]; + rx_len = sizeof(resp); + + if (len > ISO15693_BLOCK_SIZE_MAX) return -1; + + //return -1; + + memset(&tx_req,0,sizeof(tx_req)); + tx_req.sel.head.command = ISO15693_CMD_WRITE_BLOCK_SINGLE; + + if (handle->priv.iso15693.vicc_fast) { + tx_req.sel.head.flags |= RFID_15693_F_RATE_HIGH; + timeout = iso15693_timing[ISO15693_T_FAST][ISO15693_T4_WRITE]; + } else + timeout = iso15693_timing[ISO15693_T_SLOW][ISO15693_T4_WRITE]; + + if (handle->priv.iso15693.vicc_two_subc) + tx_req.sel.head.flags |= RFID_15693_F_SUBC_TWO; + + if (handle->priv.iso15693.state == RFID_15693_STATE_SELECTED) { + tx_len=sizeof(struct iso15693_request_block_selected)+len; + tx_req.sel.head.flags |= RFID_15693_F4_SELECTED; + tx_req.sel.blocknum = blocknr; + memcpy(&tx_req.sel.data,data,len); + } else { + memcpy(&tx_req.addr.uid, handle->uid, ISO15693_UID_LEN); + tx_len=sizeof(struct iso15693_request_block_addressed)+len; + tx_req.addr.head.flags |= RFID_15693_F4_ADDRESS; + tx_req.addr.blocknum = blocknr; + memcpy(&tx_req.addr.data,data,len); } - if (atqa.uid_size == 2 || atqa.uid_size == 3) - uid_size = 3; - else if (atqa.uid_size == 1) - uid_size = 2; - else - uid_size = 1; - - acf.sel_code = ISO14443A_AC_SEL_CODE_CL1; + //DEBUGP("sizeof: addr: %d sel:%d\n",sizeof(struct iso15693_request_read_addressed),sizeof(struct iso15693_request_read_selected)); + DEBUGP("tx_len=%u", tx_len); DEBUGPC(" rx_len=%u\n",rx_len); - handle->priv.iso14443a.state = ISO14443A_STATE_ANTICOL_RUNNING; - handle->priv.iso14443a.level = ISO14443A_LEVEL_CL1; + ret = iso15693_transceive(handle, RFID_15693_FRAME, (u_int8_t*)&tx_req, + tx_len, resp, &rx_len, timeout, 0); -cascade: - iso14443a_code_nvb_bits(&acf.nvb, 16); + if (ret == -ETIMEDOUT) + errstr = "(TIMEOUT)"; + else if (ret == -EIO) + errstr = "(EIO)"; + else + errstr = ""; + DEBUGP("length: %d rx_len: %d ret: %d%s\n",len,rx_len,ret,errstr); - ret = iso14443a_transceive_acf(handle, &acf, &bit_of_col); if (ret < 0) return ret; - DEBUGP("bit_of_col = %u\n", bit_of_col); - - while (bit_of_col != ISO14443A_BITOFCOL_NONE) { - set_bit_in_field(&acf.uid_bits[0], bit_of_col-16); - iso14443a_code_nvb_bits(&acf.nvb, bit_of_col); - ret = iso14443a_transceive_acf(handle, &acf, &bit_of_col); - DEBUGP("bit_of_col = %u\n", bit_of_col); - if (ret < 0) - return ret; + + if (rx_len > len+1) + return -1; + DEBUGP("error_flag: %d", rx_pkt->flags & RFID_15693_RF_ERROR); + if (rx_pkt->flags & RFID_15693_RF_ERROR) { + DEBUGPC(" -> error: %02x '%s'\n", rx_err->error, + iso15693_get_response_error_name(rx_err->error)); + return -1; + } else { + //DEBUGPC(" block_sec_stat: 0x%02x\n",rx_pkt->data[0]); + //memcpy(data, rx_pkt->data, rx_len-1); /* FIXME rc-3 in case of CRC */ + //return rx_len-1; + return 0; } - iso14443a_code_nvb_bits(&acf.nvb, 7*8); - ret = iso14443a_transceive(handle, (unsigned char *)&acf, 7, - (unsigned char *) &sak, &rx_len, - TIMEOUT, 0); - if (ret < 0) - return ret; +} - if (sak[0] & 0x04) { - /* Cascade bit set, UID not complete */ - switch (acf.sel_code) { - case ISO14443A_AC_SEL_CODE_CL1: - /* cascading from CL1 to CL2 */ - if (acf.uid_bits[0] != 0x88) { - DEBUGP("Cascade bit set, but UID0 != 0x88\n"); - return -1; - } - memcpy(&uid[0], &acf.uid_bits[1], 3); - acf.sel_code = ISO14443A_AC_SEL_CODE_CL2; - handle->priv.iso14443a.level = ISO14443A_LEVEL_CL2; - break; - case ISO14443A_AC_SEL_CODE_CL2: - /* cascading from CL2 to CL3 */ - memcpy(&uid[3], &acf.uid_bits[1], 3); - acf.sel_code = ISO14443A_AC_SEL_CODE_CL3; - handle->priv.iso14443a.level = ISO14443A_LEVEL_CL3; - break; - default: - DEBUGP("cannot cascade any further than CL3\n"); - handle->priv.iso14443a.state = ISO14443A_STATE_ERROR; - return -1; - break; - } - goto cascade; - } else { - switch (acf.sel_code) { - case ISO14443A_AC_SEL_CODE_CL1: - /* single size UID (4 bytes) */ - memcpy(&uid[0], &acf.uid_bits[0], 4); - break; - case ISO14443A_AC_SEL_CODE_CL2: - /* double size UID (7 bytes) */ - memcpy(&uid[3], &acf.uid_bits[0], 4); - break; - case ISO14443A_AC_SEL_CODE_CL3: - /* triple size UID (10 bytes) */ - memcpy(&uid[6], &acf.uid_bits[0], 4); - break; +#if 0 + +static int +iso15693_lock_block() +{ +} + +#endif + +/* Helper function to build an ISO 15693 anti collision frame */ +static int +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, mask_bytes; + u_int8_t byte=0; + void* mask_p; + + req->flags = flags; + req->command = ISO15693_CMD_INVENTORY; + if (flags & RFID_15693_F5_AFI_PRES) + req->data[i++] = afi; + req->data[i++] = mask_len; + + 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, 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, + (struct iso15693_anticol_cmd *) &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; + } } } - handle->priv.iso14443a.level = ISO14443A_LEVEL_NONE; - handle->priv.iso14443a.state = ISO14443A_STATE_SELECTED; - - { - int uid_len; - if (uid_size == 1) - uid_len = 4; - else if (uid_size == 2) - uid_len = 7; - else - uid_len = 10; - DEBUGP("UID %s\n", rfid_hexdump(uid, uid_len)); + 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; +} - if (sak[0] & 0x20) { - DEBUGP("we have a T=CL compliant PICC\n"); - handle->priv.iso14443a.tcl_capable = 1; +int +iso15693_select(struct rfid_layer2_handle *l2h) +{ + struct iso15693_request_adressed tx_req; + int ret; + unsigned int rx_len, tx_len, timeout; + + struct { + struct iso15693_response head; + u_int8_t error; + unsigned char crc[2]; + } rx_buf; + rx_len = sizeof(rx_buf); + + if (l2h->priv.iso15693.vicc_fast) { + tx_req.head.flags |= RFID_15693_F_RATE_HIGH; + timeout = iso15693_timing[ISO15693_T_FAST][ISO15693_T4]; + } else + timeout = iso15693_timing[ISO15693_T_SLOW][ISO15693_T4]; + + 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, rx_len=%u\n", tx_len,rx_len); + + ret = iso15693_transceive(l2h, RFID_15693_FRAME, (u_int8_t*)&tx_req, + tx_len, (u_int8_t*)&rx_buf, &rx_len,timeout ,0); + + DEBUGP("ret: %d%s, rx_len: %d, error_flag: %d", ret, + (ret==-ETIMEDOUT)?"(TIMEOUT)":"", rx_len, + 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)); + return -1; } else { - DEBUGP("we have a T!=CL PICC\n"); - handle->priv.iso14443a.tcl_capable = 0; + DEBUGPC(" SELECTED\n"); + l2h->priv.iso15693.state = RFID_15693_STATE_SELECTED; + return 0; } +} + +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 -iso14443a_hlta(struct rfid_layer2_handle *handle) +iso15693_getopt(struct rfid_layer2_handle *handle, + int optname, void *optval, unsigned int *optlen) { - int ret; - unsigned char tx_buf[2] = { 0x50, 0x00 }; - unsigned char rx_buf[10]; - unsigned int rx_len = sizeof(rx_buf); + unsigned int *val = optval; + u_int8_t *val_u8 = optval; + + if (!optlen || !optval || *optlen < sizeof(unsigned int)) + return -EINVAL; + + *optlen = sizeof(unsigned int); + + switch (optname) { + case RFID_OPT_15693_MOD_DEPTH: + if (handle->priv.iso15693.vcd_ask100) + *val = RFID_15693_MOD_100ASK; + else + *val = RFID_15693_MOD_10ASK; + break; + case RFID_OPT_15693_VCD_CODING: + if (handle->priv.iso15693.vcd_out256) + *val = RFID_15693_VCD_CODING_1OUT256; + else + *val = RFID_15693_VCD_CODING_1OUT4; + break; + case RFID_OPT_15693_VICC_SUBC: + if (handle->priv.iso15693.vicc_two_subc) + *val = RFID_15693_VICC_SUBC_DUAL; + else + *val = RFID_15693_VICC_SUBC_SINGLE; + break; + case RFID_OPT_15693_VICC_SPEED: + if (handle->priv.iso15693.vicc_fast) + *val = RFID_15693_VICC_SPEED_FAST; + else + *val = RFID_15693_VICC_SPEED_SLOW; + break; + case RFID_OPT_15693_VCD_SLOTS: + if (handle->priv.iso15693.single_slot) + *val = 1; + else + *val = 16; + break; + case RFID_OPT_15693_USE_AFI: + if (handle->priv.iso15693.use_afi) + *val = 1; + else + *val = 0; + break; + case RFID_OPT_15693_AFI: + *val_u8 = handle->priv.iso15693.afi; + *optlen = sizeof(u_int8_t); + break; + default: + return -EINVAL; + break; + } return 0; +} - ret = iso14443a_transceive(handle, tx_buf, sizeof(tx_buf), - rx_buf, &rx_len, 1000 /* 1ms */, 0); - if (ret < 0) { - /* "error" case: we don't get somethng back from the card */ - return 0; +static int +iso15693_setopt(struct rfid_layer2_handle *handle, int optname, + const void *optval, unsigned int optlen) +{ + unsigned int val; + + if (optlen < sizeof(u_int8_t) || !optval) + return -EINVAL; + + if (optlen == sizeof(u_int8_t)) + val = *((u_int8_t *) optval); + if (optlen == sizeof(u_int16_t)) + val = *((u_int16_t *) optval); + if (optlen == sizeof(unsigned int)) + val = *((unsigned int *) optval); + + switch (optname) { + case RFID_OPT_15693_MOD_DEPTH: + switch (val) { + case RFID_15693_MOD_10ASK: + handle->priv.iso15693.vcd_ask100 = 0; + break; + case RFID_15693_MOD_100ASK: + handle->priv.iso15693.vcd_ask100 = 1; + break; + default: + return -EINVAL; + } + break; + case RFID_OPT_15693_VCD_CODING: + switch (val) { + case RFID_15693_VCD_CODING_1OUT256: + handle->priv.iso15693.vcd_out256 = 1; + break; + case RFID_15693_VCD_CODING_1OUT4: + handle->priv.iso15693.vcd_out256 = 0; + break; + default: + return -EINVAL; + } + break; + case RFID_OPT_15693_VICC_SUBC: + switch (val) { + case RFID_15693_VICC_SUBC_SINGLE: + handle->priv.iso15693.vicc_two_subc = 0; + break; + case RFID_15693_VICC_SUBC_DUAL: + handle->priv.iso15693.vicc_two_subc = 1; + break; + default: + return -EINVAL; + } + break; + case RFID_OPT_15693_VICC_SPEED: + switch (val) { + case RFID_15693_VICC_SPEED_SLOW: + handle->priv.iso15693.vicc_fast = 0; + break; + case RFID_15693_VICC_SPEED_FAST: + handle->priv.iso15693.vicc_fast = 1; + break; + default: + return -EINVAL; + } + case RFID_OPT_15693_VCD_SLOTS: + switch (val) { + case 16: + handle->priv.iso15693.single_slot = 0; + break; + case 1: + handle->priv.iso15693.single_slot = 1; + break; + default: + return -EINVAL; + } + break; + case RFID_OPT_15693_USE_AFI: + if (val) + handle->priv.iso15693.use_afi = 1; + else + handle->priv.iso15693.use_afi = 0; + break; + case RFID_OPT_15693_AFI: + if (val > 0xff) + return -EINVAL; + handle->priv.iso15693.afi = val; + break; + default: + return -EINVAL; } + return 0; +} + +static int transceive_inventory(struct rfid_layer2_handle *l2h) +{ return -1; } -#endif static struct rfid_layer2_handle * iso15693_init(struct rfid_reader_handle *rh) { int ret; - struct rfid_layer2_handle *h = malloc(sizeof(*h)); + struct rfid_layer2_handle *h = malloc_layer2_handle(sizeof(*h)); if (!h) return NULL; h->l2 = &rfid_layer2_iso15693; h->rh = rh; h->priv.iso15693.state = ISO15693_STATE_NONE; - - ret = h->rh->reader->iso15693.init(h->rh); + h->priv.iso15693.vcd_ask100 = 1; /* 100ASK is easier to generate */ + h->priv.iso15693.vicc_two_subc = 0; + h->priv.iso15693.vicc_fast = 1; + h->priv.iso15693.single_slot = 1; + h->priv.iso15693.vcd_out256 = 0; + h->priv.iso15693.use_afi = 0; /* not all VICC support AFI */ + h->priv.iso15693.afi = 0; + + ret = h->rh->reader->init(h->rh, RFID_LAYER2_ISO15693); if (ret < 0) { - free(h); + free_layer2_handle(h); return NULL; } @@ -283,20 +792,23 @@ iso15693_init(struct rfid_reader_handle *rh) static int iso15693_fini(struct rfid_layer2_handle *handle) { - free(handle); + free_layer2_handle(handle); return 0; } -struct rfid_layer2 rfid_layer2_iso15693 = { +const struct rfid_layer2 rfid_layer2_iso15693 = { .id = RFID_LAYER2_ISO15693, .name = "ISO 15693", .fn = { .init = &iso15693_init, - //.open = &iso15693_anticol, + .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, }, };