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

   1
   2 /* Mifare Classic implementation, PCD side.
   3  *
   4  * (C) 2005-2006 by Harald Welte <laforge@gnumonks.org>
   5  *
   6  */
   7
   8 /*
   9  *  This program is free software; you can redistribute it and/or modify
  10  *  it under the terms of the GNU General Public License version 2
  11  *  as published by the Free Software Foundation
  12  *
  13  *  This program is distributed in the hope that it will be useful,
  14  *  but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  *  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  16  *  GNU General Public License for more details.
  17  *
  18  *  You should have received a copy of the GNU General Public License
  19  *  along with this program; if not, write to the Free Software
  20  *  Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
  21  */
  22 #include <stdio.h>
  23 #include <stdlib.h>
  24 #include <unistd.h>
  25 #include <string.h>
  26 #include <errno.h>
  27
  28 #include <librfid/rfid.h>
  29 #include <librfid/rfid_protocol.h>
  30 #include <librfid/rfid_layer2.h>
  31 #include <librfid/rfid_protocol_mifare_classic.h>
  32
  33 #include <librfid/rfid_reader.h>
  34
  35 #include "rfid_iso14443_common.h"
  36
  37
  38 #define MIFARE_UL_CMD_WRITE     0xA2
  39 #define MIFARE_UL_CMD_READ      0x30
  40
  41 /* FIXME */
  42 #define MIFARE_CL_READ_FWT      100
  43 #define MIFARE_CL_WRITE_FWT     100
  44
  45 static int
  46 mfcl_read(struct rfid_protocol_handle *ph, unsigned int page,
  47           unsigned char *rx_data, unsigned int *rx_len)
  48 {
  49         unsigned char rx_buf[16];
  50         unsigned int real_rx_len = sizeof(rx_buf);
  51         unsigned char tx[2];
  52         int ret;
  53
  54         if (page > MIFARE_CL_PAGE_MAX)
  55                 return -EINVAL;
  56
  57         tx[0] = MIFARE_CL_CMD_READ;
  58         tx[1] = page & 0xff;
  59
  60         ret = rfid_layer2_transceive(ph->l2h, RFID_MIFARE_FRAME, tx,
  61                                      sizeof(tx), rx_buf, &real_rx_len,
  62                                      MIFARE_CL_READ_FWT, 0);
  63
  64         if (ret < 0)
  65                 return ret;
  66
  67         if (real_rx_len == 1 && *rx_buf == 0x04)
  68                 return -EPERM;
  69
  70         if (real_rx_len < *rx_len)
  71                 *rx_len = real_rx_len;
  72
  73         memcpy(rx_data, rx_buf, *rx_len);
  74
  75         return ret;
  76 }
  77
  78 static int
  79 mfcl_write(struct rfid_protocol_handle *ph, unsigned int page,
  80            unsigned char *tx_data, unsigned int tx_len)
  81 {
  82         unsigned int i;
  83         unsigned char tx[18];
  84         unsigned char rx[1];
  85         unsigned int rx_len = sizeof(rx);
  86         int ret;
  87
  88         if (page > MIFARE_CL_PAGE_MAX)
  89                 return -EINVAL;
  90
  91         if (tx_len != 16 && tx_len != 4)
  92                 return -EINVAL;
  93
  94         if (tx_len == 16) {
  95                 tx[0] = MIFARE_CL_CMD_WRITE16;
  96                 tx[1] = page & 0xff;
  97
  98                 ret = rfid_layer2_transceive(ph->l2h, RFID_MIFARE_FRAME, tx,
  99                                              2, rx, &rx_len,
 100                                              MIFARE_CL_WRITE_FWT, 0);
 101                 if (ret < 0)
 102                         return ret;
 103
 104                 ret = rfid_layer2_transceive(ph->l2h, RFID_MIFARE_FRAME, tx_data,
 105                                              tx_len, rx, &rx_len,
 106                                              MIFARE_CL_WRITE_FWT, 0);
 107                 if (ret < 0)
 108                         return ret;
 109
 110                 if (rx[0] != MIFARE_UL_RESP_ACK)
 111                         return -EIO;
 112
 113                 ret = rfid_layer2_transceive(ph->l2h, RFID_MIFARE_FRAME, tx,
 114                                              sizeof(tx), rx, &rx_len,
 115                                              MIFARE_CL_WRITE_FWT, 0);
 116                 if (ret < 0)
 117                         return ret;
 118
 119                 if (rx[0] != MIFARE_UL_RESP_ACK)
 120                         return -EIO;
 121
 122         } else if (tx_len == 4) {
 123
 124                 tx[0] = MIFARE_CL_CMD_WRITE4;
 125                 tx[1] = page & 0xff;
 126
 127                 memcpy(tx+2, tx_data, 4);
 128
 129                 ret = rfid_layer2_transceive(ph->l2h, RFID_MIFARE_FRAME, tx,
 130                                              2+4, rx, &rx_len,
 131                                              MIFARE_CL_WRITE_FWT, 0);
 132                 if (ret < 0)
 133                         return ret;
 134
 135                 if (rx[0] != MIFARE_UL_RESP_ACK)
 136                         return -EIO;
 137
 138         }
 139
 140         return ret;
 141 }
 142
 143 static int
 144 mfcl_getopt(struct rfid_protocol_handle *ph, int optname, void *optval,
 145             unsigned int *optlen)
 146 {
 147         int ret = -EINVAL;
 148         u_int16_t atqa;
 149         unsigned int atqa_size = sizeof(atqa);
 150         unsigned int *size = optval;
 151
 152         switch (optname) {
 153         case RFID_OPT_PROTO_SIZE:
 154                 if (*optlen < sizeof(*size))
 155                         return -EINVAL;
 156                 *optlen = sizeof(*size);
 157                 ret = 0;
 158                 rfid_layer2_getopt(ph->l2h, RFID_OPT_14443A_ATQA,
 159                                    (void *) &atqa, &atqa_size);
 160                 if (atqa == 0x0004)
 161                         *size = 1024;
 162                 else if (atqa == 0x0002)
 163                         *size = 4096;
 164                 else
 165                         ret = -EIO;
 166                 break;
 167         }
 168
 169         return ret;
 170 }
 171
 172 static struct rfid_protocol_handle *
 173 mfcl_init(struct rfid_layer2_handle *l2h)
 174 {
 175         struct rfid_protocol_handle *ph;
 176
 177         if (l2h->l2->id != RFID_LAYER2_ISO14443A)
 178                 return NULL;
 179
 180         if (l2h->uid_len != 4)
 181                 return NULL;
 182
 183         ph = malloc_protocol_handle(sizeof(struct rfid_protocol_handle));
 184         return ph;
 185 }
 186
 187 static int mfcl_fini(struct rfid_protocol_handle *ph)
 188 {
 189         free_protocol_handle(ph);
 190         return 0;
 191 }
 192
 193 const struct rfid_protocol rfid_protocol_mfcl = {
 194         .id     = RFID_PROTOCOL_MIFARE_CLASSIC,
 195         .name   = "Mifare Classic",
 196         .fn     = {
 197                 .init           = &mfcl_init,
 198                 .read           = &mfcl_read,
 199                 .write          = &mfcl_write,
 200                 .fini           = &mfcl_fini,
 201                 .getopt         = &mfcl_getopt,
 202         },
 203 };
 204
 205 int mfcl_set_key(struct rfid_protocol_handle *ph, unsigned char *key)
 206 {
 207         if (!ph->l2h->rh->reader->mifare_classic.setkey)
 208                 return -ENODEV;
 209
 210         return ph->l2h->rh->reader->mifare_classic.setkey(ph->l2h->rh, key);
 211 }
 212
 213 int mfcl_auth(struct rfid_protocol_handle *ph, u_int8_t cmd, u_int8_t block)
 214 {
 215         u_int32_t serno = *((u_int32_t *)ph->l2h->uid);
 216
 217         if (!ph->l2h->rh->reader->mifare_classic.auth)
 218                 return -ENODEV;
 219
 220         return ph->l2h->rh->reader->mifare_classic.auth(ph->l2h->rh, cmd,
 221                                                        serno, block);
 222 }