/* Mifare Ultralight implementation, PCD side. * * (C) 2005 by Harald Welte * */ /* * This program is free software; you can redistribute it and/or modify * 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, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * 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 */ #include #include #include #include #include #include #include #include //#include //#include //#include #include "rfid_iso14443_common.h" #define MIFARE_UL_CMD_WRITE 0xA2 #define MIFARE_UL_CMD_READ 0x30 /* FIXME */ #define MIFARE_UL_READ_FWT 100 #define MIFARE_UL_WRITE_FWT 100 static int mful_read(struct rfid_protocol_handle *ph, unsigned int page, unsigned char *rx_data, unsigned int *rx_len) { unsigned char rx_buf[16]; unsigned int real_rx_len = sizeof(rx_buf); unsigned char tx[2]; int ret; if (page > 7) return -EINVAL; tx[0] = MIFARE_UL_CMD_READ; tx[1] = page & 0xff; ret = ph->l2h->l2->fn.transcieve(ph->l2h, tx, sizeof(tx), rx_buf, &real_rx_len, MIFARE_UL_READ_FWT, 0); if (ret < 0) return ret; if (real_rx_len < *rx_len) *rx_len = real_rx_len; memcpy(rx_data, rx_buf, *rx_len); return ret; } static int mful_write(struct rfid_protocol_handle *ph, unsigned int page, unsigned char *tx_data, unsigned int tx_len) { unsigned int i; unsigned char tx[6]; unsigned char rx[1]; unsigned int rx_len; int ret; if (tx_len != 4 || page > 7) return -EINVAL; tx[0] = MIFARE_UL_CMD_WRITE; tx[1] = page & 0xff; for (i = 0; i < 4; i++) tx[2+i] = tx_data[i]; ret = ph->l2h->l2->fn.transcieve(ph->l2h, tx, sizeof(tx), rx, &rx_len, MIFARE_UL_WRITE_FWT, 0); /* FIXME:look at RX, check for ACK/NAK */ return ret; } static int mful_transcieve(struct rfid_protocol_handle *ph, const unsigned char *tx_data, unsigned int tx_len, unsigned char *rx_data, unsigned int *rx_len, unsigned int timeout, unsigned int flags) { return -EINVAL; } static struct rfid_protocol_handle * mful_init(struct rfid_layer2_handle *l2h) { struct rfid_protocol_handle *ph; ph = malloc(sizeof(struct rfid_protocol_handle)); return ph; } static int mful_fini(struct rfid_protocol_handle *ph) { free(ph); return 0; } struct rfid_protocol rfid_protocol_mful = { .id = RFID_PROTOCOL_MIFARE_UL, .name = "Mifare Ultralight", .fn = { .init = &mful_init, /* .transcieve = &mful_transcieve,*/ .read = &mful_read, .write = &mful_write, .fini = &mful_fini, }, };