2 /* Mifare Classic implementation, PCD side.
4 * (C) 2005-2008 by Harald Welte <laforge@gnumonks.org>
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
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.
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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
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>
33 #include <librfid/rfid_reader.h>
35 #include "rfid_iso14443_common.h"
38 #define MIFARE_UL_CMD_WRITE 0xA2
39 #define MIFARE_UL_CMD_READ 0x30
41 #define MIFARE_CL_READ_FWT 250
42 #define MIFARE_CL_WRITE_FWT 600
45 mfcl_read(struct rfid_protocol_handle *ph, unsigned int page,
46 unsigned char *rx_data, unsigned int *rx_len)
48 unsigned char rx_buf[16];
49 unsigned int real_rx_len = sizeof(rx_buf);
53 if (page > MIFARE_CL_PAGE_MAX)
56 tx[0] = MIFARE_CL_CMD_READ;
59 ret = rfid_layer2_transceive(ph->l2h, RFID_MIFARE_FRAME, tx,
60 sizeof(tx), rx_buf, &real_rx_len,
61 MIFARE_CL_READ_FWT, 0);
66 if (real_rx_len == 1 && *rx_buf == 0x04)
69 if (real_rx_len < *rx_len)
70 *rx_len = real_rx_len;
72 memcpy(rx_data, rx_buf, *rx_len);
78 mfcl_write(struct rfid_protocol_handle *ph, unsigned int page,
79 unsigned char *tx_data, unsigned int tx_len)
83 unsigned int rx_len = sizeof(rx);
86 if (page > MIFARE_CL_PAGE_MAX)
92 tx[0] = MIFARE_CL_CMD_WRITE16;
95 ret = rfid_layer2_transceive(ph->l2h, RFID_MIFARE_FRAME, tx, 2, rx,
96 &rx_len, MIFARE_CL_WRITE_FWT, 0);
100 ret = rfid_layer2_transceive(ph->l2h, RFID_MIFARE_FRAME, tx_data,
102 MIFARE_CL_WRITE_FWT, 0);
106 if (rx[0] != MIFARE_UL_RESP_ACK)
113 mfcl_getopt(struct rfid_protocol_handle *ph, int optname, void *optval,
114 unsigned int *optlen)
119 unsigned int atqa_size = sizeof(atqa);
120 unsigned int sak_size = sizeof(sak);
121 unsigned int *size = optval;
124 case RFID_OPT_PROTO_SIZE:
125 if (*optlen < sizeof(*size))
127 *optlen = sizeof(*size);
129 rfid_layer2_getopt(ph->l2h, RFID_OPT_14443A_ATQA,
131 rfid_layer2_getopt(ph->l2h, RFID_OPT_14443A_SAK,
133 if (atqa[0] == 0x04 && atqa[1] == 0x00) {
139 } else if (atqa[0] == 0x02 && atqa[1] == 0x00)
149 static struct rfid_protocol_handle *
150 mfcl_init(struct rfid_layer2_handle *l2h)
152 struct rfid_protocol_handle *ph;
154 if (l2h->l2->id != RFID_LAYER2_ISO14443A)
157 if (l2h->uid_len != 4)
160 ph = malloc_protocol_handle(sizeof(struct rfid_protocol_handle));
164 static int mfcl_fini(struct rfid_protocol_handle *ph)
166 free_protocol_handle(ph);
170 const struct rfid_protocol rfid_protocol_mfcl = {
171 .id = RFID_PROTOCOL_MIFARE_CLASSIC,
172 .name = "Mifare Classic",
176 .write = &mfcl_write,
178 .getopt = &mfcl_getopt,
182 int mfcl_set_key(struct rfid_protocol_handle *ph, unsigned char *key)
184 if (!ph->l2h->rh->reader->mifare_classic.setkey)
187 return ph->l2h->rh->reader->mifare_classic.setkey(ph->l2h->rh, key);
190 int mfcl_set_key_ee(struct rfid_protocol_handle *ph, unsigned int addr)
192 if (!ph->l2h->rh->reader->mifare_classic.setkey_ee)
195 return ph->l2h->rh->reader->mifare_classic.setkey_ee(ph->l2h->rh, addr);
198 int mfcl_auth(struct rfid_protocol_handle *ph, u_int8_t cmd, u_int8_t block)
200 u_int32_t serno = *((u_int32_t *)ph->l2h->uid);
202 if (!ph->l2h->rh->reader->mifare_classic.auth)
205 return ph->l2h->rh->reader->mifare_classic.auth(ph->l2h->rh, cmd,
209 int mfcl_block2sector(u_int8_t block)
211 if (block < MIFARE_CL_SMALL_SECTORS * MIFARE_CL_BLOCKS_P_SECTOR_1k)
212 return block/MIFARE_CL_BLOCKS_P_SECTOR_1k;
214 return (block - MIFARE_CL_SMALL_SECTORS * MIFARE_CL_BLOCKS_P_SECTOR_1k)
215 / MIFARE_CL_BLOCKS_P_SECTOR_4k;
218 int mfcl_sector2block(u_int8_t sector)
220 if (sector < MIFARE_CL_SMALL_SECTORS)
221 return sector * MIFARE_CL_BLOCKS_P_SECTOR_1k;
222 else if (sector < MIFARE_CL_SMALL_SECTORS + MIFARE_CL_LARGE_SECTORS)
223 return MIFARE_CL_SMALL_SECTORS * MIFARE_CL_BLOCKS_P_SECTOR_1k +
224 (sector - MIFARE_CL_SMALL_SECTORS) * MIFARE_CL_BLOCKS_P_SECTOR_4k;
229 int mfcl_sector_blocks(u_int8_t sector)
231 if (sector < MIFARE_CL_SMALL_SECTORS)
232 return MIFARE_CL_BLOCKS_P_SECTOR_1k;
233 else if (sector < MIFARE_CL_SMALL_SECTORS + MIFARE_CL_LARGE_SECTORS)
234 return MIFARE_CL_BLOCKS_P_SECTOR_4k;