projects / librfid / blobdiff
? search:
summary | shortlog | log | commit | commitdiff | tree
raw | inline | side by side
* support for mingw (Petr Stetiar)
[librfid] / src / rfid_asic_rc632.c
diff --git a/src/rfid_asic_rc632.c b/src/rfid_asic_rc632.c
index 05ed2cd..0ba4dc5 100644 (file)
--- a/src/rfid_asic_rc632.c
+++ b/src/rfid_asic_rc632.c
@@ -1,6 +1,6 @@
 /* Generic Philips CL RC632 Routines
  *
- * (C) Harald Welte <laforge@gnumonks.org>
+ * (C) 2005-2006 Harald Welte <laforge@gnumonks.org>
  *
  */
 
@@ -16,7 +16,7 @@
  *
  *  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
  */
 
 #include <unistd.h>
@@ -35,13 +35,15 @@
 
 #include "rfid_iso14443_common.h"
 #include "rc632.h"
-//#include "rc632_14443a.h"
 
+#ifdef  __MINGW32__
+#include "usleep.h"
+#endif/*__MINGW32__*/
 
-#define RC632_TMO_AUTH1        14000
+#define RC632_TMO_AUTH1        140
 
 #define ENTER()                DEBUGP("entering\n")
-struct rfid_asic rc632;
+const struct rfid_asic rc632;
 
 /* Register and FIFO Access functions */
 static int 
@@ -402,7 +404,7 @@ rc632_transceive(struct rfid_asic_handle *handle,
                                return ret;
 
                        cur_tx_len = 64 - fifo_fill;
-                       printf("refilling tx fifo with %u bytes\n", cur_tx_len);
+                       //printf("refilling tx fifo with %u bytes\n", cur_tx_len);
                } else
                        cur_tx_len = 0;
 
@@ -420,9 +422,9 @@ rc632_transceive(struct rfid_asic_handle *handle,
        if (ret < 0)
                return ret;
 
-       if (rx_avail > *rx_len)
-               printf("rx_avail(%d) > rx_len(%d), JFYI\n", rx_avail, *rx_len);
-       else if (*rx_len > rx_avail)
+       if (rx_avail > *rx_len) {
+               //printf("rx_avail(%d) > rx_len(%d), JFYI\n", rx_avail, *rx_len);
+       } else if (*rx_len > rx_avail)
                *rx_len = rx_avail;
 
        if (rx_avail == 0) {
@@ -566,6 +568,13 @@ rc632_init(struct rfid_asic_handle *ah)
        if (ret < 0)
                return ret;
 
+       /* switch off rf */
+       ret = rc632_turn_off_rf(ah);
+       if (ret < 0)
+               return ret;
+
+       usleep(100000);
+
        /* switch on rf */
        ret = rc632_turn_on_rf(ah);
        if (ret < 0)
@@ -596,12 +605,12 @@ rc632_open(struct rfid_asic_transport_handle *th)
 {
        struct rfid_asic_handle *h;
 
-       h = malloc(sizeof(*h));
+       h = malloc_asic_handle(sizeof(*h));
        if (!h)
                return NULL;
        memset(h, 0, sizeof(*h));
 
-       h->asic = &rc632;
+       h->asic = (void*)&rc632;
        h->rath = th;
        h->fc = h->asic->fc;
        /* FIXME: this is only cm5121 specific, since the latency
@@ -609,7 +618,7 @@ rc632_open(struct rfid_asic_transport_handle *th)
        h->mtu = h->mru = 64;
 
        if (rc632_init(h) < 0) {
-               free(h);
+               free_asic_handle(h);
                return NULL;
        }
 
@@ -620,14 +629,14 @@ void
 rc632_close(struct rfid_asic_handle *h)
 {
        rc632_fini(h);
-       free(h);
+       free_asic_handle(h);
 }
 
 
 /* 
  * Philips CL RC632 primitives for ISO 14443-A compliant PICC's
  *
- * (C) 2005 by Harald Welte <laforge@gnumonks.org>
+ * (C) 2005-2006 by Harald Welte <laforge@gnumonks.org>
  *
  */
 
@@ -639,7 +648,8 @@ rc632_iso14443a_init(struct rfid_asic_handle *handle)
        // FIXME: some fifo work (drain fifo?)
        
        /* flush fifo (our way) */
-       ret = rc632_reg_write(handle, RC632_REG_CONTROL, 0x01);
+       ret = rc632_reg_write(handle, RC632_REG_CONTROL,
+                             RC632_CONTROL_FIFO_FLUSH);
 
        ret = rc632_reg_write(handle, RC632_REG_TX_CONTROL,
                        (RC632_TXCTRL_TX1_RF_EN |
@@ -867,7 +877,7 @@ rc632_iso14443a_transceive_acf(struct rfid_asic_handle *handle,
        int ret;
        u_int8_t rx_buf[64];
        u_int8_t rx_len = sizeof(rx_buf);
-       u_int8_t rx_align = 0, tx_last_bits, tx_bytes;
+       u_int8_t rx_align = 0, tx_last_bits, tx_bytes, tx_bytes_total;
        u_int8_t boc;
        u_int8_t error_flag;
        *bit_of_col = ISO14443A_BITOFCOL_NONE;
@@ -891,14 +901,14 @@ rc632_iso14443a_transceive_acf(struct rfid_asic_handle *handle,
        if (ret < 0)
                return ret;
 
-       tx_last_bits = acf->nvb & 0x0f; /* lower nibble indicates bits */
-       tx_bytes = acf->nvb >> 4;
+       tx_last_bits = acf->nvb & 0x07; /* lower nibble indicates bits */
+       tx_bytes = ( acf->nvb >> 4 ) & 0x07;
        if (tx_last_bits) {
-               tx_bytes++;
-               rx_align = (tx_last_bits+1) % 8;/* rx frame complements tx */
+               tx_bytes_total = tx_bytes+1;
+               rx_align = tx_last_bits & 0x07; /* rx frame complements tx */
        }
-
-       //rx_align = 8 - tx_last_bits;/* rx frame complements tx */
+       else
+               tx_bytes_total = tx_bytes;
 
        /* set RxAlign and TxLastBits*/
        ret = rc632_reg_write(handle, RC632_REG_BIT_FRAMING,
@@ -906,7 +916,7 @@ rc632_iso14443a_transceive_acf(struct rfid_asic_handle *handle,
        if (ret < 0)
                return ret;
 
-       ret = rc632_transceive(handle, (u_int8_t *)acf, tx_bytes,
+       ret = rc632_transceive(handle, (u_int8_t *)acf, tx_bytes_total,
                                rx_buf, &rx_len, 0x32, 0);
        if (ret < 0)
                return ret;
@@ -915,8 +925,10 @@ rc632_iso14443a_transceive_acf(struct rfid_asic_handle *handle,
        acf->uid_bits[tx_bytes-2] = (
                  (acf->uid_bits[tx_bytes-2] & (0xff >> (8-tx_last_bits)))
                | rx_buf[0]);
+       
        /* copy the rest */
-       memcpy(&acf->uid_bits[tx_bytes+1-2], &rx_buf[1], rx_len-1);
+       if(rx_len)
+           memcpy(&acf->uid_bits[tx_bytes-1], &rx_buf[1], rx_len-1);
 
        /* determine whether there was a collission */
        ret = rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &error_flag);
@@ -1065,7 +1077,8 @@ static int rc632_iso14443b_init(struct rfid_asic_handle *handle)
        // FIXME: some FIFO work
        
        /* flush fifo (our way) */
-       ret = rc632_reg_write(handle, RC632_REG_CONTROL, 0x01);
+       ret = rc632_reg_write(handle, RC632_REG_CONTROL,
+                             RC632_CONTROL_FIFO_FLUSH);
        if (ret < 0)
                return ret;
 
@@ -1453,6 +1466,11 @@ rc632_mifare_set_key(struct rfid_asic_handle *h, const u_int8_t *key)
        if (ret < 0)
                return ret;
 
+       /* Terminate probably running command */
+       ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_IDLE);    
+       if (ret < 0)
+               return ret;
+
        ret = rc632_fifo_write(h, RFID_MIFARE_KEY_CODED_LEN, coded_key, 0x03);
        if (ret < 0)
                return ret;
@@ -1483,8 +1501,10 @@ rc632_mifare_auth(struct rfid_asic_handle *h, u_int8_t cmd, u_int32_t serno,
        struct mifare_authcmd acmd;
        u_int8_t reg;
 
-       if (cmd != RFID_CMD_MIFARE_AUTH1A && cmd != RFID_CMD_MIFARE_AUTH1B)
+       if (cmd != RFID_CMD_MIFARE_AUTH1A && cmd != RFID_CMD_MIFARE_AUTH1B) {
+               DEBUGP("invalid auth command\n");
                return -EINVAL;
+       }
 
        /* Initialize acmd */
        acmd.block_address = block & 0xff;
@@ -1492,9 +1512,16 @@ rc632_mifare_auth(struct rfid_asic_handle *h, u_int8_t cmd, u_int32_t serno,
        //acmd.serno = htonl(serno);
        acmd.serno = serno;
 
+#if 1
        /* Clear Rx CRC */
        ret = rc632_clear_bits(h, RC632_REG_CHANNEL_REDUNDANCY,
                                RC632_CR_RX_CRC_ENABLE);
+#else
+       /* Clear Rx CRC, Set Tx CRC and Odd Parity */
+       ret = rc632_reg_write(h, RC632_REG_CHANNEL_REDUNDANCY,
+                               RC632_CR_TX_CRC_ENABLE | RC632_CR_PARITY_ODD |
+                               RC632_CR_PARITY_ENABLE);
+#endif
        if (ret < 0)
                return ret;
 
@@ -1504,8 +1531,10 @@ rc632_mifare_auth(struct rfid_asic_handle *h, u_int8_t cmd, u_int32_t serno,
                return ret;
 
        ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_AUTHENT1);
-       if (ret < 0)
+       if (ret < 0) {
+               DEBUGP("error during AUTHENT1");
                return ret;
+       }
 
        /* Wait until transmitter is idle */
        ret = rc632_wait_idle(h, RC632_TMO_AUTH1);
@@ -1515,8 +1544,10 @@ rc632_mifare_auth(struct rfid_asic_handle *h, u_int8_t cmd, u_int32_t serno,
        ret = rc632_reg_read(h, RC632_REG_SECONDARY_STATUS, &reg);
        if (ret < 0)
                return ret;
-       if (reg & 0x07)
+       if (reg & 0x07) {
+               DEBUGP("bitframe?");
                return -EIO;
+       }
 
        /* Clear Tx CRC */
        ret = rc632_clear_bits(h, RC632_REG_CHANNEL_REDUNDANCY,
@@ -1539,11 +1570,12 @@ rc632_mifare_auth(struct rfid_asic_handle *h, u_int8_t cmd, u_int32_t serno,
        if (ret < 0)
                return ret;
 
-       if (!(reg & RC632_CONTROL_CRYPTO1_ON))
+       if (!(reg & RC632_CONTROL_CRYPTO1_ON)) {
+               DEBUGP("authentication not successful");
                return -EACCES;
+       }
 
        return 0;
-
 }
 
 /* transceive regular frame */
@@ -1581,7 +1613,7 @@ rc632_mifare_transceive(struct rfid_asic_handle *handle,
        return 0; 
 }
 
-struct rfid_asic rc632 = {
+const struct rfid_asic rc632 = {
        .name   = "Philips CL RC632",
        .fc     = ISO14443_FREQ_CARRIER,
        .priv.rc632 = {
Unnamed repository; edit this file 'description' to name the repository.