git.rot13.org Git - librfid/blob - src/rfid_layer2_iso14443a.c

   1 /* ISO 14443-3 A anticollision implementation
   2  *
   3  * (C) 2005-2006 by Harald Welte <laforge@gnumonks.org>
   4  *
   5  */
   6
   7 /*
   8  *  This program is free software; you can redistribute it and/or modify
   9  *  it under the terms of the GNU General Public License version 2
  10  *  as published by the Free Software Foundation
  11  *
  12  *  This program is distributed in the hope that it will be useful,
  13  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  14  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  15  *  GNU General Public License for more details.
  16  *
  17  *  You should have received a copy of the GNU General Public License
  18  *  along with this program; if not, write to the Free Software
  19  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  20  */
  21
  22 #include <stdlib.h>
  23 #include <unistd.h>
  24 #include <string.h>
  25 #include <errno.h>
  26
  27 #include <librfid/rfid.h>
  28 #include <librfid/rfid_layer2.h>
  29 #include <librfid/rfid_reader.h>
  30 #include <librfid/rfid_layer2_iso14443a.h>
  31 #include <librfid/rfid_protocol.h>
  32
  33 #define TIMEOUT 1236
  34
  35 /* Transceive a 7-bit short frame */
  36 int
  37 iso14443a_transceive_sf(struct rfid_layer2_handle *handle,
  38                          unsigned char cmd,
  39                          struct iso14443a_atqa *atqa)
  40 {
  41         struct rfid_reader *rdr = handle->rh->reader;
  42
  43         return rdr->iso14443a.transceive_sf(handle->rh, cmd, atqa);
  44 }
  45
  46 /* Transmit an anticollission bit frame */
  47 static int
  48 iso14443a_transceive_acf(struct rfid_layer2_handle *handle,
  49                          struct iso14443a_anticol_cmd *acf,
  50                          unsigned int *bit_of_col)
  51 {
  52         struct rfid_reader *rdr = handle->rh->reader;
  53
  54         return rdr->iso14443a.transceive_acf(handle->rh, acf, bit_of_col);
  55 }
  56
  57 /* Transmit a regular frame */
  58 static int
  59 iso14443a_transceive(struct rfid_layer2_handle *handle,
  60                      enum rfid_frametype frametype,
  61                         const unsigned char *tx_buf, unsigned int tx_len,
  62                         unsigned char *rx_buf, unsigned int *rx_len,
  63                         u_int64_t timeout, unsigned int flags)
  64 {
  65         return handle->rh->reader->transceive(handle->rh, frametype, tx_buf,
  66                                         tx_len, rx_buf, rx_len, timeout, flags);
  67 }
  68
  69 static int
  70 iso14443a_code_nvb_bits(unsigned char *nvb, unsigned int bits)
  71 {
  72         unsigned int byte_count = bits / 8;
  73         unsigned int bit_count = bits % 8;
  74
  75         if (byte_count < 2 || byte_count > 7)
  76                 return -1;
  77
  78         *nvb = ((byte_count & 0xf) << 4) | bit_count;
  79
  80         return 0;
  81 }
  82
  83 /* first bit is '1', second bit '2' */
  84 static void
  85 set_bit_in_field(unsigned char *bitfield, unsigned int bit)
  86 {
  87         unsigned int byte_count = bit / 8;
  88         unsigned int bit_count = bit % 8;
  89
  90         DEBUGP("bitfield=%p, byte_count=%u, bit_count=%u\n",
  91                         bitfield, byte_count, bit_count);
  92         DEBUGP("%p = 0x%02x\n", (bitfield+byte_count), *(bitfield+byte_count));
  93         *(bitfield+byte_count) |= 1 << (bit_count-1);
  94         DEBUGP("%p = 0x%02x\n", (bitfield+byte_count), *(bitfield+byte_count));
  95 }
  96
  97 static int
  98 iso14443a_anticol(struct rfid_layer2_handle *handle)
  99 {
 100         int ret;
 101         unsigned int uid_size;
 102         struct iso14443a_handle *h = &handle->priv.iso14443a;
 103         struct iso14443a_atqa *atqa = &h->atqa;
 104         struct iso14443a_anticol_cmd acf;
 105         unsigned int bit_of_col;
 106         unsigned char sak[3];
 107         unsigned int rx_len = sizeof(sak);
 108         char *aqptr = (char *) atqa;
 109
 110         memset(handle->uid, 0, sizeof(handle->uid));
 111         memset(sak, 0, sizeof(sak));
 112         memset(atqa, 0, sizeof(&atqa));
 113         memset(&acf, 0, sizeof(acf));
 114
 115         if (handle->flags & RFID_OPT_LAYER2_WUP)
 116                 ret = iso14443a_transceive_sf(handle, ISO14443A_SF_CMD_WUPA, atqa);
 117         else
 118                 ret = iso14443a_transceive_sf(handle, ISO14443A_SF_CMD_REQA, atqa);
 119         if (ret < 0) {
 120                 h->state = ISO14443A_STATE_REQA_SENT;
 121                 DEBUGP("error during transceive_sf: %d\n", ret);
 122                 return ret;
 123         }
 124         h->state = ISO14443A_STATE_ATQA_RCVD;
 125
 126         DEBUGP("ATQA: 0x%02x 0x%02x\n", *aqptr, *(aqptr+1));
 127
 128         if (!atqa->bf_anticol) {
 129                 h->state = ISO14443A_STATE_NO_BITFRAME_ANTICOL;
 130                 DEBUGP("no bitframe anticollission bits set, aborting\n");
 131                 return -1;
 132         }
 133
 134         if (atqa->uid_size == 2 || atqa->uid_size == 3)
 135                 uid_size = 3;
 136         else if (atqa->uid_size == 1)
 137                 uid_size = 2;
 138         else
 139                 uid_size = 1;
 140
 141         acf.sel_code = ISO14443A_AC_SEL_CODE_CL1;
 142
 143         h->state = ISO14443A_STATE_ANTICOL_RUNNING;
 144         h->level = ISO14443A_LEVEL_CL1;
 145
 146 cascade:
 147         rx_len = sizeof(sak);
 148         iso14443a_code_nvb_bits(&acf.nvb, 16);
 149
 150         ret = iso14443a_transceive_acf(handle, &acf, &bit_of_col);
 151         if (ret < 0)
 152                 return ret;
 153         DEBUGP("bit_of_col = %u\n", bit_of_col);
 154
 155         while (bit_of_col != ISO14443A_BITOFCOL_NONE) {
 156                 set_bit_in_field(&acf.uid_bits[0], bit_of_col-16);
 157                 iso14443a_code_nvb_bits(&acf.nvb, bit_of_col);
 158                 ret = iso14443a_transceive_acf(handle, &acf, &bit_of_col);
 159                 DEBUGP("bit_of_col = %u\n", bit_of_col);
 160                 if (ret < 0)
 161                         return ret;
 162         }
 163
 164         iso14443a_code_nvb_bits(&acf.nvb, 7*8);
 165         ret = iso14443a_transceive(handle, RFID_14443A_FRAME_REGULAR,
 166                                    (unsigned char *)&acf, 7,
 167                                    (unsigned char *) &sak, &rx_len,
 168                                    TIMEOUT, 0);
 169         if (ret < 0)
 170                 return ret;
 171
 172         if (sak[0] & 0x04) {
 173                 /* Cascade bit set, UID not complete */
 174                 switch (acf.sel_code) {
 175                 case ISO14443A_AC_SEL_CODE_CL1:
 176                         /* cascading from CL1 to CL2 */
 177                         if (acf.uid_bits[0] != 0x88) {
 178                                 DEBUGP("Cascade bit set, but UID0 != 0x88\n");
 179                                 return -1;
 180                         }
 181                         memcpy(&handle->uid[0], &acf.uid_bits[1], 3);
 182                         acf.sel_code = ISO14443A_AC_SEL_CODE_CL2;
 183                         h->level = ISO14443A_LEVEL_CL2;
 184                         break;
 185                 case ISO14443A_AC_SEL_CODE_CL2:
 186                         /* cascading from CL2 to CL3 */
 187                         memcpy(&handle->uid[3], &acf.uid_bits[1], 3);
 188                         acf.sel_code = ISO14443A_AC_SEL_CODE_CL3;
 189                         h->level = ISO14443A_LEVEL_CL3;
 190                         break;
 191                 default:
 192                         DEBUGP("cannot cascade any further than CL3\n");
 193                         h->state = ISO14443A_STATE_ERROR;
 194                         return -1;
 195                         break;
 196                 }
 197                 goto cascade;
 198
 199         } else {
 200                 switch (acf.sel_code) {
 201                 case ISO14443A_AC_SEL_CODE_CL1:
 202                         /* single size UID (4 bytes) */
 203                         memcpy(&handle->uid[0], &acf.uid_bits[0], 4);
 204                         break;
 205                 case ISO14443A_AC_SEL_CODE_CL2:
 206                         /* double size UID (7 bytes) */
 207                         memcpy(&handle->uid[3], &acf.uid_bits[0], 4);
 208                         break;
 209                 case ISO14443A_AC_SEL_CODE_CL3:
 210                         /* triple size UID (10 bytes) */
 211                         memcpy(&handle->uid[6], &acf.uid_bits[0], 4);
 212                         break;
 213                 }
 214         }
 215
 216         h->level = ISO14443A_LEVEL_NONE;
 217         h->state = ISO14443A_STATE_SELECTED;
 218
 219         {
 220                 if (uid_size == 1)
 221                         handle->uid_len = 4;
 222                 else if (uid_size == 2)
 223                         handle->uid_len = 7;
 224                 else
 225                         handle->uid_len = 10;
 226
 227                 DEBUGP("UID %s\n", rfid_hexdump(handle->uid, handle->uid_len));
 228         }
 229
 230         if (sak[0] & 0x20) {
 231                 DEBUGP("we have a T=CL compliant PICC\n");
 232                 handle->proto_supported = 1 << RFID_PROTOCOL_TCL;
 233                 h->tcl_capable = 1;
 234         } else {
 235                 DEBUGP("we have a T!=CL PICC\n");
 236                 handle->proto_supported = (1 << RFID_PROTOCOL_MIFARE_UL)|
 237                                           (1 << RFID_PROTOCOL_MIFARE_CLASSIC);
 238                 h->tcl_capable = 0;
 239         }
 240
 241         return 0;
 242 }
 243
 244 static int
 245 iso14443a_hlta(struct rfid_layer2_handle *handle)
 246 {
 247         int ret;
 248         unsigned char tx_buf[2] = { 0x50, 0x00 };
 249         unsigned char rx_buf[10];
 250         unsigned int rx_len = sizeof(rx_buf);
 251
 252         ret = iso14443a_transceive(handle, RFID_14443A_FRAME_REGULAR,
 253                                    tx_buf, sizeof(tx_buf),
 254                                    rx_buf, &rx_len, 1000 /* 1ms */, 0);
 255         if (ret < 0) {
 256                 /* "error" case: we don't get somethng back from the card */
 257                 return 0;
 258         }
 259         return -1;
 260 }
 261
 262 static int
 263 iso14443a_setopt(struct rfid_layer2_handle *handle, int optname,
 264                  const void *optval, unsigned int optlen)
 265 {
 266         int ret = -EINVAL;
 267         struct rfid_reader *rdr = handle->rh->reader;
 268         unsigned int speed;
 269
 270         switch (optname) {
 271         case RFID_OPT_14443A_SPEED_RX:
 272                 if (!rdr->iso14443a.set_speed)
 273                         return -ENOTSUP;
 274                 speed = *(unsigned int *)optval;
 275                 ret = rdr->iso14443a.set_speed(handle->rh, 0, speed);
 276                 break;
 277         case RFID_OPT_14443A_SPEED_TX:
 278                 if (!rdr->iso14443a.set_speed)
 279                         return -ENOTSUP;
 280                 speed = *(unsigned int *)optval;
 281                 ret = rdr->iso14443a.set_speed(handle->rh, 1, speed);
 282                 break;
 283         };
 284
 285         return ret;
 286 }
 287
 288 static int
 289 iso14443a_getopt(struct rfid_layer2_handle *handle, int optname,
 290                  void *optval, unsigned int optlen)
 291 {
 292         int ret = -EINVAL;
 293         struct iso14443a_handle *h = &handle->priv.iso14443a;
 294         struct iso14443a_atqa *atqa = optval;
 295
 296         switch (optname) {
 297         case RFID_OPT_14443A_ATQA:
 298                 *atqa = h->atqa;
 299                 ret = 0;
 300                 break;
 301         };
 302
 303         return ret;
 304 }
 305
 306
 307 static struct rfid_layer2_handle *
 308 iso14443a_init(struct rfid_reader_handle *rh)
 309 {
 310         int ret;
 311         struct rfid_layer2_handle *h = malloc_layer2_handle(sizeof(*h));
 312         if (!h)
 313                 return NULL;
 314
 315         memset(h, 0, sizeof(*h));
 316
 317         h->l2 = &rfid_layer2_iso14443a;
 318         h->rh = rh;
 319         h->priv.iso14443a.state = ISO14443A_STATE_NONE;
 320         h->priv.iso14443a.level = ISO14443A_LEVEL_NONE;
 321
 322         ret = h->rh->reader->iso14443a.init(h->rh);
 323         if (ret < 0) {
 324                 free_layer2_handle(h);
 325                 return NULL;
 326         }
 327
 328         return h;
 329 }
 330
 331 static int
 332 iso14443a_fini(struct rfid_layer2_handle *handle)
 333 {
 334         free_layer2_handle(handle);
 335         return 0;
 336 }
 337
 338
 339 const struct rfid_layer2 rfid_layer2_iso14443a = {
 340         .id     = RFID_LAYER2_ISO14443A,
 341         .name   = "ISO 14443-3 A",
 342         .fn     = {
 343                 .init           = &iso14443a_init,
 344                 .open           = &iso14443a_anticol,
 345                 .transceive     = &iso14443a_transceive,
 346                 .close          = &iso14443a_hlta,
 347                 .fini           = &iso14443a_fini,
 348                 .setopt         = &iso14443a_setopt,
 349                 .getopt         = &iso14443a_getopt,
 350         },
 351 };
 352