git.rot13.org Git - librfid/blob - rfid_asic_rc632.c

   1 /* Generic Philips CL RC632 Routines
   2  *
   3  * (C) 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 <unistd.h>
  23 #include <stdlib.h>
  24 #include <string.h>
  25 #include <errno.h>
  26 #include <sys/types.h>
  27
  28 #include <rfid/rfid.h>
  29 #include <rfid/rfid_asic.h>
  30 #include <rfid/rfid_asic_rc632.h>
  31 #include <rfid/rfid_reader_cm5121.h>
  32 #include <rfid/rfid_layer2_iso14443a.h>
  33 #include <rfid/rfid_protocol_mifare_classic.h>
  34
  35 #include "rfid_iso14443_common.h"
  36 #include "rc632.h"
  37 //#include "rc632_14443a.h"
  38
  39
  40 #define RC632_TMO_AUTH1 14000
  41
  42 #define ENTER()         DEBUGP("entering\n")
  43 struct rfid_asic rc632;
  44
  45 /* Register and FIFO Access functions */
  46 int
  47 rc632_reg_write(struct rfid_asic_handle *handle,
  48                 u_int8_t reg,
  49                 u_int8_t val)
  50 {
  51         return handle->rath->rat->priv.rc632.fn.reg_write(handle->rath, reg, val);
  52 }
  53
  54 int
  55 rc632_reg_read(struct rfid_asic_handle *handle,
  56                u_int8_t reg,
  57                u_int8_t *val)
  58 {
  59         return handle->rath->rat->priv.rc632.fn.reg_read(handle->rath, reg, val);
  60 }
  61
  62 int
  63 rc632_fifo_write(struct rfid_asic_handle *handle,
  64                  u_int8_t len,
  65                  const u_int8_t *buf,
  66                  u_int8_t flags)
  67 {
  68         return handle->rath->rat->priv.rc632.fn.fifo_write(handle->rath,
  69                                                            len, buf, flags);
  70 }
  71
  72 int
  73 rc632_fifo_read(struct rfid_asic_handle *handle,
  74                 u_int8_t len,
  75                 u_int8_t *buf)
  76 {
  77         return handle->rath->rat->priv.rc632.fn.fifo_read(handle->rath, len, buf);
  78 }
  79
  80
  81 int
  82 rc632_set_bits(struct rfid_asic_handle *handle,
  83                 u_int8_t reg,
  84                 u_int8_t val)
  85 {
  86         int ret;
  87         u_int8_t tmp;
  88
  89         ret = rc632_reg_read(handle, reg, &tmp);
  90         if (ret < 0)
  91                 return -1;
  92
  93         /* if bits are already set, no need to set them again */
  94         if ((tmp & val) == val)
  95                 return 0;
  96
  97         return rc632_reg_write(handle, reg, (tmp|val)&0xff);
  98 }
  99
 100 int
 101 rc632_clear_bits(struct rfid_asic_handle *handle,
 102                  u_int8_t reg,
 103                  u_int8_t val)
 104 {
 105         int ret;
 106         u_int8_t tmp;
 107
 108         ret = rc632_reg_read(handle, reg, &tmp);
 109         if (ret < 0) {
 110                 DEBUGP("error during reg_read(%p, %d):%d\n",
 111                         handle, reg, ret);
 112                 return -1;
 113         }
 114         /* if bits are already cleared, no need to clear them again */
 115         if ((tmp & val) == 0)
 116                 return 0;
 117
 118         return rc632_reg_write(handle, reg, (tmp & ~val)&0xff);
 119 }
 120
 121
 122
 123 int
 124 rc632_turn_on_rf(struct rfid_asic_handle *handle)
 125 {
 126         ENTER();
 127         return rc632_set_bits(handle, RC632_REG_TX_CONTROL, 0x03);
 128 }
 129
 130 int
 131 rc632_turn_off_rf(struct rfid_asic_handle *handle)
 132 {
 133         ENTER();
 134         return rc632_clear_bits(handle, RC632_REG_TX_CONTROL, 0x03);
 135 }
 136
 137 int
 138 rc632_power_up(struct rfid_asic_handle *handle)
 139 {
 140         ENTER();
 141         return rc632_clear_bits(handle, RC632_REG_CONTROL,
 142                                 RC632_CONTROL_POWERDOWN);
 143 }
 144
 145 int
 146 rc632_power_down(struct rfid_asic_handle *handle)
 147 {
 148         return rc632_set_bits(handle, RC632_REG_CONTROL,
 149                               RC632_CONTROL_POWERDOWN);
 150 }
 151
 152 /* Stupid RC623 implementations don't evaluate interrupts but poll the
 153  * command register for "status idle" */
 154 int
 155 rc632_wait_idle(struct rfid_asic_handle *handle, u_int64_t timeout)
 156 {
 157         u_int8_t cmd = 0xff;
 158         int ret;
 159
 160         while (cmd != 0) {
 161                 ret = rc632_reg_read(handle, RC632_REG_COMMAND, &cmd);
 162                 if (ret < 0)
 163                         return ret;
 164
 165                 if (cmd == 0) {
 166                         /* FIXME: read second time ?? */
 167                         return 0;
 168                 }
 169
 170                 {
 171                         u_int8_t foo;
 172                         rc632_reg_read(handle, RC632_REG_PRIMARY_STATUS, &foo);
 173                         if (foo & 0x04)
 174                                 rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &foo);
 175                 }
 176
 177                 usleep(100);
 178
 179                 /* Fixme: Abort after some timeout */
 180         }
 181
 182         return 0;
 183 }
 184
 185 int
 186 rc632_transmit(struct rfid_asic_handle *handle,
 187                 const u_int8_t *buf,
 188                 u_int8_t len,
 189                 u_int64_t timeout)
 190 {
 191         int ret;
 192
 193         ret = rc632_fifo_write(handle, len, buf, 0x03);
 194         if (ret < 0)
 195                 return ret;
 196
 197         ret = rc632_reg_write(handle, RC632_REG_COMMAND, RC632_CMD_TRANSMIT);
 198         if (ret < 0)
 199                 return ret;
 200
 201         return rc632_wait_idle(handle, timeout);
 202 }
 203
 204 static int
 205 tcl_toggle_pcb(struct rfid_asic_handle *handle)
 206 {
 207         // FIXME: toggle something between 0x0a and 0x0b
 208         return 0;
 209 }
 210
 211 int
 212 rc632_transcieve(struct rfid_asic_handle *handle,
 213                  const u_int8_t *tx_buf,
 214                  u_int8_t tx_len,
 215                  u_int8_t *rx_buf,
 216                  u_int8_t *rx_len,
 217                  unsigned int timer,
 218                  unsigned int toggle)
 219 {
 220         int ret;
 221
 222         ret = rc632_fifo_write(handle, tx_len, tx_buf, 0x03);
 223         if (ret < 0)
 224                 return ret;
 225
 226         ret = rc632_reg_write(handle, RC632_REG_COMMAND, RC632_CMD_TRANSCIEVE);
 227         if (ret < 0)
 228                 return ret;
 229
 230         if (toggle == 1)
 231                 tcl_toggle_pcb(handle);
 232
 233         ret = rc632_wait_idle(handle, timer);
 234         if (ret < 0)
 235                 return ret;
 236
 237         ret = rc632_reg_read(handle, RC632_REG_FIFO_LENGTH, rx_len);
 238         if (ret < 0)
 239                 return ret;
 240
 241         if (*rx_len == 0) {
 242                 u_int8_t tmp;
 243
 244                 DEBUGP("rx_len == 0\n");
 245
 246                 rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &tmp);
 247                 rc632_reg_read(handle, RC632_REG_CHANNEL_REDUNDANCY, &tmp);
 248
 249                 return -1;
 250         }
 251
 252         return rc632_fifo_read(handle, *rx_len, rx_buf);
 253 }
 254
 255 int
 256 rc632_read_eeprom(struct rfid_asic_handle *handle)
 257 {
 258         u_int8_t recvbuf[60];
 259         u_int8_t sndbuf[3];
 260         int ret;
 261
 262         sndbuf[0] = 0x00;
 263         sndbuf[1] = 0x00;
 264         sndbuf[2] = 0x3c;
 265
 266         ret = rc632_fifo_write(handle, 3, sndbuf, 0x03);
 267         if (ret < 0)
 268                 return ret;
 269
 270         ret = rc632_reg_write(handle, RC632_REG_COMMAND, RC632_CMD_READ_E2);
 271         if (ret < 0)
 272                 return ret;
 273
 274         usleep(20000);
 275
 276         ret = rc632_fifo_read(handle, sizeof(recvbuf), recvbuf);
 277         if (ret < 0)
 278                 return ret;
 279
 280         // FIXME: do something with eeprom contents
 281         return ret;
 282 }
 283
 284 int
 285 rc632_calc_crc16_from(struct rfid_asic_handle *handle)
 286 {
 287         u_int8_t sndbuf[2] = { 0x01, 0x02 };
 288         u_int8_t crc_lsb = 0x00 , crc_msb = 0x00;
 289         int ret;
 290
 291         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_LSB, 0x12);
 292         if (ret < 0)
 293                 return ret;
 294
 295         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_MSB, 0xe0);
 296         if (ret < 0)
 297                 return ret;
 298
 299         ret = rc632_fifo_write(handle, sizeof(sndbuf), sndbuf, 3);
 300         if (ret < 0)
 301                 return ret;
 302
 303         ret = rc632_reg_write(handle, RC632_REG_COMMAND, RC632_CMD_CALC_CRC);
 304         if (ret < 0)
 305                 return ret;
 306
 307         usleep(10000);  // FIXME: no checking for cmd completion?
 308
 309         ret = rc632_reg_read(handle, RC632_REG_CRC_RESULT_LSB, &crc_lsb);
 310         if (ret < 0)
 311                 return ret;
 312
 313         ret = rc632_reg_read(handle, RC632_REG_CRC_RESULT_MSB, &crc_msb);
 314         if (ret < 0)
 315                 return ret;
 316
 317         // FIXME: what to do with crc result?
 318         return ret;
 319 }
 320
 321
 322 int
 323 rc632_register_dump(struct rfid_asic_handle *handle, u_int8_t *buf)
 324 {
 325         int ret;
 326         u_int8_t i;
 327
 328         for (i = 0; i <= 0x3f; i++) {
 329                 ret = rc632_reg_read(handle, i, &buf[i]);
 330                 // do we want error checks?
 331         }
 332         return 0;
 333 }
 334
 335
 336
 337 /* generic FIFO access functions (if no more efficient ones provided by
 338  * transport driver) */
 339
 340 static int
 341 generic_fifo_write()
 342 {
 343         // FIXME: implementation (not needed for CM 5121)
 344         return -1;
 345 }
 346
 347 static int
 348 generic_fifo_read()
 349 {
 350         // FIXME: implementation (not neded for CM 5121)
 351         return -1;
 352 }
 353
 354 static int
 355 rc632_init(struct rfid_asic_handle *ah)
 356 {
 357         int ret;
 358
 359         /* switch off rf (make sure PICCs are reset at init time) */
 360         ret = rc632_power_down(ah);
 361         if (ret < 0)
 362                 return ret;
 363
 364         usleep(10000);
 365
 366         /* switch on rf */
 367         ret = rc632_power_up(ah);
 368         if (ret < 0)
 369                 return ret;
 370
 371         /* disable register paging */
 372         ret = rc632_reg_write(ah, 0x00, 0x00);
 373         if (ret < 0)
 374                 return ret;
 375
 376         /* set some sane default values */
 377         ret = rc632_reg_write(ah, 0x11, 0x5b);
 378         if (ret < 0)
 379                 return ret;
 380
 381         /* switch on rf */
 382         ret = rc632_turn_on_rf(ah);
 383         if (ret < 0)
 384                 return ret;
 385
 386         return 0;
 387 }
 388
 389 static int
 390 rc632_fini(struct rfid_asic_handle *ah)
 391 {
 392         int ret;
 393
 394         /* switch off rf */
 395         ret = rc632_turn_off_rf(ah);
 396         if (ret < 0)
 397                 return ret;
 398
 399         ret = rc632_power_down(ah);
 400         if (ret < 0)
 401                 return ret;
 402
 403         return 0;
 404 }
 405
 406 struct rfid_asic_handle *
 407 rc632_open(struct rfid_asic_transport_handle *th)
 408 {
 409         struct rfid_asic_handle *h;
 410
 411         h = malloc(sizeof(*h));
 412         if (!h)
 413                 return NULL;
 414         memset(h, 0, sizeof(*h));
 415
 416         h->asic = &rc632;
 417         h->rath = th;
 418         h->fc = h->asic->fc;
 419         h->mtu = h->mru = 40; /* FIXME */
 420
 421         if (rc632_init(h) < 0) {
 422                 free(h);
 423                 return NULL;
 424         }
 425
 426         return h;
 427 }
 428
 429 void
 430 rc632_close(struct rfid_asic_handle *h)
 431 {
 432         rc632_fini(h);
 433         free(h);
 434 }
 435
 436
 437 /*
 438  * Philips CL RC632 primitives for ISO 14443-A compliant PICC's
 439  *
 440  * (C) 2005 by Harald Welte <laforge@gnumonks.org>
 441  *
 442  */
 443
 444 static int
 445 rc632_iso14443a_init(struct rfid_asic_handle *handle)
 446 {
 447         int ret;
 448
 449         // FIXME: some fifo work (drain fifo?)
 450
 451         /* flush fifo (our way) */
 452         ret = rc632_reg_write(handle, RC632_REG_CONTROL, 0x01);
 453
 454         ret = rc632_reg_write(handle, RC632_REG_TX_CONTROL,
 455                         (RC632_TXCTRL_TX1_RF_EN |
 456                          RC632_TXCTRL_TX2_RF_EN |
 457                          RC632_TXCTRL_TX2_INV |
 458                          RC632_TXCTRL_FORCE_100_ASK |
 459                          RC632_TXCTRL_MOD_SRC_INT));
 460         if (ret < 0)
 461                 return ret;
 462
 463         ret = rc632_reg_write(handle, RC632_REG_CW_CONDUCTANCE,
 464                                 CM5121_CW_CONDUCTANCE);
 465         if (ret < 0)
 466                 return ret;
 467
 468         /* Since FORCE_100_ASK is set (cf mc073930.pdf), this line may be left out? */
 469         ret = rc632_reg_write(handle, RC632_REG_MOD_CONDUCTANCE,
 470                                 CM5121_MOD_CONDUCTANCE);
 471         if (ret < 0)
 472                 return ret;
 473
 474         ret = rc632_reg_write(handle, RC632_REG_CODER_CONTROL,
 475                                 (RC632_CDRCTRL_TXCD_14443A |
 476                                  RC632_CDRCTRL_RATE_106K));
 477         if (ret < 0)
 478                 return ret;
 479
 480         ret = rc632_reg_write(handle, RC632_REG_MOD_WIDTH, 0x13);
 481         if (ret < 0)
 482                 return ret;
 483
 484         ret = rc632_reg_write(handle, RC632_REG_MOD_WIDTH_SOF, 0x3f);
 485         if (ret < 0)
 486                 return ret;
 487
 488         ret = rc632_reg_write(handle, RC632_REG_TYPE_B_FRAMING, 0x00);
 489         if (ret < 0)
 490                 return ret;
 491
 492         ret = rc632_reg_write(handle, RC632_REG_RX_CONTROL1,
 493                               (RC632_RXCTRL1_GAIN_35DB |
 494                                RC632_RXCTRL1_ISO14443 |
 495                                RC632_RXCTRL1_SUBCP_8));
 496         if (ret < 0)
 497                 return ret;
 498
 499         ret = rc632_reg_write(handle, RC632_REG_DECODER_CONTROL,
 500                               (RC632_DECCTRL_MANCHESTER |
 501                                RC632_DECCTRL_RXFR_14443A));
 502         if (ret < 0)
 503                 return ret;
 504
 505         ret = rc632_reg_write(handle, RC632_REG_BIT_PHASE,
 506                                 CM5121_14443A_BITPHASE);
 507         if (ret < 0)
 508                 return ret;
 509
 510         ret = rc632_reg_write(handle, RC632_REG_RX_THRESHOLD,
 511                                 CM5121_14443A_THRESHOLD);
 512         if (ret < 0)
 513                 return ret;
 514
 515         ret = rc632_reg_write(handle, RC632_REG_BPSK_DEM_CONTROL, 0x00);
 516         if (ret < 0)
 517                 return ret;
 518
 519         ret = rc632_reg_write(handle, RC632_REG_RX_CONTROL2,
 520                               (RC632_RXCTRL2_DECSRC_INT |
 521                                RC632_RXCTRL2_CLK_Q));
 522         if (ret < 0)
 523                 return ret;
 524
 525         /* Omnikey proprietary driver has 0x03, but 0x06 is the default reset value ?!? */
 526         ret = rc632_reg_write(handle, RC632_REG_RX_WAIT, 0x06);
 527         if (ret < 0)
 528                 return ret;
 529
 530         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 531                               (RC632_CR_PARITY_ENABLE |
 532                                RC632_CR_PARITY_ODD));
 533         if (ret < 0)
 534                 return ret;
 535
 536         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_LSB, 0x63);
 537         if (ret < 0)
 538                 return ret;
 539
 540         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_MSB, 0x63);
 541         if (ret < 0)
 542                 return ret;
 543
 544         return 0;
 545 }
 546
 547 static int
 548 rc632_iso14443a_fini(struct iso14443a_handle *handle_14443)
 549 {
 550
 551 #if 0
 552         ret = rc632_turn_off_rf(handle);
 553         if (ret < 0)
 554                 return ret;
 555 #endif
 556
 557
 558         return 0;
 559 }
 560
 561
 562 /* issue a 14443-3 A PCD -> PICC command in a short frame, such as REQA, WUPA */
 563 static int
 564 rc632_iso14443a_transcieve_sf(struct rfid_asic_handle *handle,
 565                                 u_int8_t cmd,
 566                                 struct iso14443a_atqa *atqa)
 567 {
 568         int ret;
 569         u_int8_t tx_buf[1];
 570         u_int8_t rx_len = 2;
 571
 572         memset(atqa, 0, sizeof(atqa));
 573
 574         tx_buf[0] = cmd;
 575
 576         /* transfer only 7 bits of last byte in frame */
 577         ret = rc632_reg_write(handle, RC632_REG_BIT_FRAMING, 0x07);
 578         if (ret < 0)
 579                 return ret;
 580
 581
 582         ret = rc632_clear_bits(handle, RC632_REG_CONTROL,
 583                                 RC632_CONTROL_CRYPTO1_ON);
 584         if (ret < 0)
 585                 return ret;
 586
 587 #if 0
 588         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 589                                 (RC632_CR_PARITY_ENABLE |
 590                                  RC632_CR_PARITY_ODD));
 591 #else
 592         ret = rc632_clear_bits(handle, RC632_REG_CHANNEL_REDUNDANCY,
 593                                 RC632_CR_RX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE);
 594
 595 #endif
 596         if (ret < 0)
 597                 return ret;
 598
 599         ret = rc632_transcieve(handle, tx_buf, sizeof(tx_buf),
 600                                 (u_int8_t *)atqa, &rx_len, 0x32, 0);
 601         if (ret < 0) {
 602                 DEBUGP("error during rc632_transcieve()\n");
 603                 return ret;
 604         }
 605
 606         /* switch back to normal 8bit last byte */
 607         ret = rc632_reg_write(handle, RC632_REG_BIT_FRAMING, 0x00);
 608         if (ret < 0)
 609                 return ret;
 610
 611         if (rx_len != 2) {
 612                 DEBUGP("rx_len(%d) != 2\n", rx_len);
 613                 return -1;
 614         }
 615
 616         return 0;
 617 }
 618
 619 /* transcieve regular frame */
 620 static int
 621 rc632_iso14443a_transcieve(struct rfid_asic_handle *handle,
 622                            const u_int8_t *tx_buf, unsigned int tx_len,
 623                            u_int8_t *rx_buf, unsigned int *rx_len,
 624                            u_int64_t timeout, unsigned int flags)
 625 {
 626         int ret;
 627         u_int8_t rxl = *rx_len & 0xff;
 628
 629         DEBUGP("entered\n");
 630         memset(rx_buf, 0, *rx_len);
 631
 632 #if 0
 633         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 634                                 (RC632_CR_PARITY_ENABLE |
 635                                  RC632_CR_PARITY_ODD |
 636                                  RC632_CR_TX_CRC_ENABLE |
 637                                  RC632_CR_RX_CRC_ENABLE));
 638 #endif
 639         ret = rc632_set_bits(handle, RC632_REG_CHANNEL_REDUNDANCY,
 640                                 RC632_CR_TX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE);
 641         if (ret < 0)
 642                 return ret;
 643
 644         ret = rc632_transcieve(handle, tx_buf, tx_len, rx_buf, &rxl, 0x32, 0);
 645         *rx_len = rxl;
 646         if (ret < 0)
 647                 return ret;
 648
 649
 650         return 0;
 651 }
 652
 653 /* transcieve anti collission bitframe */
 654 static int
 655 rc632_iso14443a_transcieve_acf(struct rfid_asic_handle *handle,
 656                                 struct iso14443a_anticol_cmd *acf,
 657                                 unsigned int *bit_of_col)
 658 {
 659         int ret;
 660         u_int8_t rx_buf[64];
 661         u_int8_t rx_len = sizeof(rx_buf);
 662         u_int8_t rx_align = 0, tx_last_bits, tx_bytes;
 663         u_int8_t boc;
 664         u_int8_t error_flag;
 665         *bit_of_col = ISO14443A_BITOFCOL_NONE;
 666         memset(rx_buf, 0, sizeof(rx_buf));
 667
 668         /* disable mifare cryto */
 669         ret = rc632_clear_bits(handle, RC632_REG_CONTROL,
 670                                 RC632_CONTROL_CRYPTO1_ON);
 671         if (ret < 0)
 672                 return ret;
 673
 674         /* disable CRC summing */
 675 #if 0
 676         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 677                                 (RC632_CR_PARITY_ENABLE |
 678                                  RC632_CR_PARITY_ODD));
 679 #else
 680         ret = rc632_clear_bits(handle, RC632_REG_CHANNEL_REDUNDANCY,
 681                                 RC632_CR_TX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE);
 682 #endif
 683         if (ret < 0)
 684                 return ret;
 685
 686         tx_last_bits = acf->nvb & 0x0f; /* lower nibble indicates bits */
 687         tx_bytes = acf->nvb >> 4;
 688         if (tx_last_bits) {
 689                 tx_bytes++;
 690                 rx_align = (tx_last_bits+1) % 8;/* rx frame complements tx */
 691         }
 692
 693         //rx_align = 8 - tx_last_bits;/* rx frame complements tx */
 694
 695         /* set RxAlign and TxLastBits*/
 696         ret = rc632_reg_write(handle, RC632_REG_BIT_FRAMING,
 697                                 (rx_align << 4) | (tx_last_bits));
 698         if (ret < 0)
 699                 return ret;
 700
 701         ret = rc632_transcieve(handle, (u_int8_t *)acf, tx_bytes,
 702                                 rx_buf, &rx_len, 0x32, 0);
 703         if (ret < 0)
 704                 return ret;
 705
 706         /* bitwise-OR the two halves of the split byte */
 707         acf->uid_bits[tx_bytes-2] = (
 708                   (acf->uid_bits[tx_bytes-2] & (0xff >> (8-tx_last_bits)))
 709                 | rx_buf[0]);
 710         /* copy the rest */
 711         memcpy(&acf->uid_bits[tx_bytes+1-2], &rx_buf[1], rx_len-1);
 712
 713         /* determine whether there was a collission */
 714         ret = rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &error_flag);
 715         if (ret < 0)
 716                 return ret;
 717
 718         if (error_flag & RC632_ERR_FLAG_COL_ERR) {
 719                 /* retrieve bit of collission */
 720                 ret = rc632_reg_read(handle, RC632_REG_COLL_POS, &boc);
 721                 if (ret < 0)
 722                         return ret;
 723
 724                 /* bit of collission relative to start of part 1 of
 725                  * anticollision frame (!) */
 726                 *bit_of_col = 2*8 + boc;
 727         }
 728
 729         return 0;
 730 }
 731
 732 static int rc632_iso14443b_init(struct rfid_asic_handle *handle)
 733 {
 734         int ret;
 735
 736         // FIXME: some FIFO work
 737
 738         /* flush fifo (our way) */
 739         ret = rc632_reg_write(handle, RC632_REG_CONTROL, 0x01);
 740         if (ret < 0)
 741                 return ret;
 742
 743         ret = rc632_reg_write(handle, RC632_REG_TX_CONTROL,
 744                         (RC632_TXCTRL_TX1_RF_EN |
 745                          RC632_TXCTRL_TX2_RF_EN |
 746                          RC632_TXCTRL_TX2_INV |
 747                          RC632_TXCTRL_MOD_SRC_INT));
 748         if (ret < 0)
 749                 return ret;
 750
 751         ret = rc632_reg_write(handle, RC632_REG_CW_CONDUCTANCE, 0x3f);
 752         if (ret < 0)
 753                 return ret;
 754
 755         ret = rc632_reg_write(handle, RC632_REG_MOD_CONDUCTANCE, 0x04);
 756         if (ret < 0)
 757                 return ret;
 758
 759         ret = rc632_reg_write(handle, RC632_REG_CODER_CONTROL,
 760                               (RC632_CDRCTRL_TXCD_NRZ |
 761                                RC632_CDRCTRL_RATE_14443B));
 762         if (ret < 0)
 763                 return ret;
 764
 765         ret = rc632_reg_write(handle, RC632_REG_MOD_WIDTH, 0x13);
 766         if (ret < 0)
 767                 return ret;
 768
 769         ret = rc632_reg_write(handle, RC632_REG_MOD_WIDTH_SOF, 0x3f);
 770         if (ret < 0)
 771                 return ret;
 772
 773         ret = rc632_reg_write(handle, RC632_REG_TYPE_B_FRAMING,
 774                               (RC632_TBFRAMING_SOF_11L_3H |
 775                                (6 << RC632_TBFRAMING_SPACE_SHIFT) |
 776                                RC632_TBFRAMING_EOF_11));
 777         if (ret < 0)
 778                 return ret;
 779
 780         ret = rc632_reg_write(handle, RC632_REG_RX_CONTROL1,
 781                               (RC632_RXCTRL1_GAIN_35DB |
 782                                RC632_RXCTRL1_ISO14443 |
 783                                RC632_RXCTRL1_SUBCP_8));
 784         if (ret < 0)
 785                 return ret;
 786
 787         ret = rc632_reg_write(handle, RC632_REG_DECODER_CONTROL,
 788                               (RC632_DECCTRL_BPSK |
 789                                RC632_DECCTRL_RXFR_14443B));
 790         if (ret < 0)
 791                 return ret;
 792
 793         ret = rc632_reg_write(handle, RC632_REG_BIT_PHASE,
 794                                 CM5121_14443B_BITPHASE);
 795         if (ret < 0)
 796                 return ret;
 797
 798         ret = rc632_reg_write(handle, RC632_REG_RX_THRESHOLD,
 799                                 CM5121_14443B_THRESHOLD);
 800         if (ret < 0)
 801                 return ret;
 802
 803         ret = rc632_reg_write(handle, RC632_REG_BPSK_DEM_CONTROL,
 804                               ((0x2 & RC632_BPSKD_TAUB_MASK)<<RC632_BPSKD_TAUB_SHIFT |
 805                                (0x3 & RC632_BPSKD_TAUD_MASK)<<RC632_BPSKD_TAUD_SHIFT |
 806                                RC632_BPSKD_FILTER_AMP_DETECT |
 807                                RC632_BPSKD_NO_RX_EOF |
 808                                RC632_BPSKD_NO_RX_EGT));
 809         if (ret < 0)
 810                 return ret;
 811
 812         ret = rc632_reg_write(handle, RC632_REG_RX_CONTROL2,
 813                               (RC632_RXCTRL2_AUTO_PD |
 814                                RC632_RXCTRL2_DECSRC_INT));
 815         if (ret < 0)
 816                 return ret;
 817
 818         ret = rc632_reg_write(handle, RC632_REG_RX_WAIT, 0x03);
 819         if (ret < 0)
 820                 return ret;
 821
 822         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 823                               (RC632_CR_TX_CRC_ENABLE |
 824                                RC632_CR_RX_CRC_ENABLE |
 825                                RC632_CR_CRC3309));
 826         if (ret < 0)
 827                 return ret;
 828
 829         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_LSB, 0xff);
 830         if (ret < 0)
 831                 return ret;
 832
 833         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_MSB, 0xff);
 834         if (ret < 0)
 835                 return ret;
 836
 837         return 0;
 838 }
 839
 840 static int
 841 rc632_iso15693_init(struct rfid_asic_handle *h)
 842 {
 843         int ret;
 844
 845         ret = rc632_reg_write(h, RC632_REG_TX_CONTROL,
 846                                                 (RC632_TXCTRL_MOD_SRC_INT |
 847                                                  RC632_TXCTRL_TX2_INV |
 848                                                  RC632_TXCTRL_TX2_RF_EN |
 849                                                  RC632_TXCTRL_TX1_RF_EN));
 850         if (ret < 0)
 851                 return ret;
 852
 853         ret = rc632_reg_write(h, RC632_REG_CW_CONDUCTANCE, 0x3f);
 854         if (ret < 0)
 855                 return ret;
 856
 857         ret = rc632_reg_write(h, RC632_REG_MOD_CONDUCTANCE, 0x03);
 858         if (ret < 0)
 859                 return ret;
 860
 861         ret = rc632_reg_write(h, RC632_REG_CODER_CONTROL,
 862                                                 (RC632_CDRCTRL_RATE_15693 |
 863                                                  0x03)); /* FIXME */
 864         if (ret < 0)
 865                 return ret;
 866
 867         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH, 0x3f);
 868         if (ret < 0)
 869                 return ret;
 870
 871         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH_SOF, 0x3f);
 872         if (ret < 0)
 873                 return ret;
 874
 875         ret = rc632_reg_write(h, RC632_REG_TYPE_B_FRAMING, 0x00);
 876         if (ret < 0)
 877                 return ret;
 878
 879         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL1,
 880                                                 (RC632_RXCTRL1_SUBCP_16 |
 881                                                  RC632_RXCTRL1_ISO15693 |
 882                                                  RC632_RXCTRL1_GAIN_35DB));
 883         if (ret < 0)
 884                 return ret;
 885
 886         ret = rc632_reg_write(h, RC632_REG_DECODER_CONTROL,
 887                                                 (RC632_DECCTRL_RXFR_15693 |
 888                                                  RC632_DECCTRL_RX_INVERT));
 889         if (ret < 0)
 890                 return ret;
 891
 892         ret = rc632_reg_write(h, RC632_REG_BIT_PHASE, 0xe0);
 893         if (ret < 0)
 894                 return ret;
 895
 896         ret = rc632_reg_write(h, RC632_REG_RX_THRESHOLD, 0xff);
 897         if (ret < 0)
 898                 return ret;
 899
 900         ret = rc632_reg_write(h, RC632_REG_BPSK_DEM_CONTROL, 0x00);
 901         if (ret < 0)
 902                 return ret;
 903
 904         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL2,
 905                                                 (RC632_RXCTRL2_AUTO_PD |
 906                                                  RC632_RXCTRL2_DECSRC_INT));
 907         if (ret < 0)
 908                 return ret;
 909
 910         ret = rc632_reg_write(h, RC632_REG_CHANNEL_REDUNDANCY,
 911                                                 (RC632_CR_CRC3309 |
 912                                                  RC632_CR_RX_CRC_ENABLE |
 913                                                  RC632_CR_TX_CRC_ENABLE));
 914         if (ret < 0)
 915                 return ret;
 916
 917         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_LSB, 0xff);
 918         if (ret < 0)
 919                 return ret;
 920
 921         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_MSB, 0xff);
 922         if (ret < 0)
 923                 return ret;
 924
 925         return 0;
 926 }
 927
 928 static int
 929 rc632_iso15693_icode_init(struct rfid_asic_handle *h)
 930 {
 931         int ret;
 932
 933         ret = rc632_reg_write(h, RC632_REG_TX_CONTROL,
 934                                                 (RC632_TXCTRL_MOD_SRC_INT |
 935                                                  RC632_TXCTRL_TX2_INV |
 936                                                  RC632_TXCTRL_TX2_RF_EN |
 937                                                  RC632_TXCTRL_TX1_RF_EN));
 938         if (ret < 0)
 939                 return ret;
 940
 941         ret = rc632_reg_write(h, RC632_REG_CW_CONDUCTANCE, 0x3f);
 942         if (ret < 0)
 943                 return ret;
 944
 945         ret = rc632_reg_write(h, RC632_REG_MOD_CONDUCTANCE, 0x02);
 946         if (ret < 0)
 947                 return ret;
 948
 949         ret = rc632_reg_write(h, RC632_REG_CODER_CONTROL, 0x2c);
 950         if (ret < 0)
 951                 return ret;
 952
 953         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH, 0x3f);
 954         if (ret < 0)
 955                 return ret;
 956
 957         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH_SOF, 0x3f);
 958         if (ret < 0)
 959                 return ret;
 960
 961         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH_SOF, 0x3f);
 962         if (ret < 0)
 963                 return ret;
 964
 965         ret = rc632_reg_write(h, RC632_REG_TYPE_B_FRAMING, 0x00);
 966         if (ret < 0)
 967                 return ret;
 968
 969         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL1, 0x8b); /* FIXME */
 970         if (ret < 0)
 971                 return ret;
 972
 973         ret = rc632_reg_write(h, RC632_REG_DECODER_CONTROL, 0x00);
 974         if (ret < 0)
 975                 return ret;
 976
 977         ret = rc632_reg_write(h, RC632_REG_BIT_PHASE, 0x52);
 978         if (ret < 0)
 979                 return ret;
 980
 981         ret = rc632_reg_write(h, RC632_REG_RX_THRESHOLD, 0x66);
 982         if (ret < 0)
 983                 return ret;
 984
 985         ret = rc632_reg_write(h, RC632_REG_BPSK_DEM_CONTROL, 0x00);
 986         if (ret < 0)
 987                 return ret;
 988
 989         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL2,
 990                                                 RC632_RXCTRL2_DECSRC_INT);
 991         if (ret < 0)
 992                 return ret;
 993
 994         ret = rc632_reg_write(h, RC632_REG_CHANNEL_REDUNDANCY,
 995                                                 (RC632_CR_RX_CRC_ENABLE |
 996                                                  RC632_CR_TX_CRC_ENABLE));
 997         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_LSB, 0xfe);
 998         if (ret < 0)
 999                 return ret;
1000
1001         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_MSB, 0xff);
1002         if (ret < 0)
1003                 return ret;
1004
1005         return 0;
1006 }
1007
1008 static int
1009 rc632_iso15693_icl_init(struct rfid_asic_handle *h)
1010 {
1011         int ret;
1012
1013         /* ICL */
1014
1015         ret = rc632_reg_write(h, RC632_REG_TX_CONTROL,
1016                                                 (RC632_TXCTRL_MOD_SRC_INT |
1017                                                  RC632_TXCTRL_TX2_INV |
1018                                                  RC632_TXCTRL_TX2_RF_EN |
1019                                                  RC632_TXCTRL_TX1_RF_EN));
1020         if (ret < 0)
1021                 return ret;
1022
1023         ret = rc632_reg_write(h, RC632_REG_CW_CONDUCTANCE, 0x3f);
1024         if (ret < 0)
1025                 return ret;
1026
1027         ret = rc632_reg_write(h, RC632_REG_MOD_CONDUCTANCE, 0x11);
1028         if (ret < 0)
1029                 return ret;
1030
1031         ret = rc632_reg_write(h, RC632_REG_CODER_CONTROL,
1032                                                 (RC632_CDRCTRL_RATE_15693 |
1033                                                  RC632_CDRCTRL_TXCD_ICODE_STD |
1034                                                  0x03)); /* FIXME */
1035         if (ret < 0)
1036                 return ret;
1037
1038         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH, 0x3f);
1039         if (ret < 0)
1040                 return ret;
1041
1042         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH_SOF, 0x3f);
1043         if (ret < 0)
1044                 return ret;
1045         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL1,
1046                                                 (RC632_RXCTRL1_SUBCP_16|
1047                                                  RC632_RXCTRL1_ISO15693|
1048                                                  RC632_RXCTRL1_GAIN_35DB));
1049         if (ret < 0)
1050                 return ret;
1051         ret = rc632_reg_write(h, RC632_REG_DECODER_CONTROL,
1052                                                 (RC632_DECCTRL_RX_INVERT|
1053                                                  RC632_DECCTRL_RXFR_15693));
1054         if (ret < 0)
1055                 return ret;
1056
1057         ret = rc632_reg_write(h, RC632_REG_BIT_PHASE, 0xbd);
1058         if (ret < 0)
1059                 return ret;
1060
1061         ret = rc632_reg_write(h, RC632_REG_RX_THRESHOLD, 0xff);
1062         if (ret < 0)
1063                 return ret;
1064
1065         ret = rc632_reg_write(h, RC632_REG_BPSK_DEM_CONTROL, 0x00);
1066         if (ret < 0)
1067                 return ret;
1068
1069         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL2,
1070                                                 RC632_RXCTRL2_DECSRC_INT);
1071         if (ret < 0)
1072                 return ret;
1073
1074         ret = rc632_reg_write(h, RC632_REG_CHANNEL_REDUNDANCY, 0x00);
1075         if (ret < 0)
1076                 return ret;
1077
1078         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_LSB, 0x12);
1079         if (ret < 0)
1080                 return ret;
1081
1082         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_MSB, 0xe0);
1083         if (ret < 0)
1084                 return ret;
1085
1086         return 0;
1087 }
1088
1089 struct mifare_authcmd {
1090         u_int8_t auth_cmd;
1091         u_int8_t block_address;
1092         u_int32_t serno;        /* lsb 1 2 msb */
1093 } __attribute__ ((packed));
1094
1095
1096 #define RFID_MIFARE_KEY_LEN 6
1097 #define RFID_MIFARE_KEY_CODED_LEN 12
1098
1099 /* Transform crypto1 key from generic 6byte into rc632 specific 12byte */
1100 static int
1101 rc632_mifare_transform_key(const u_int8_t *key6, u_int8_t *key12)
1102 {
1103         int i;
1104         u_int8_t ln;
1105         u_int8_t hn;
1106
1107         for (i = 0; i < RFID_MIFARE_KEY_LEN; i++) {
1108                 ln = key6[i] & 0x0f;
1109                 hn = key6[i] >> 4;
1110                 key12[i * 2 + 1] = (~ln << 4) | ln;
1111                 key12[i * 2] = (~hn << 4) | hn;
1112         }
1113         return 0;
1114 }
1115
1116 static int
1117 rc632_mifare_set_key(struct rfid_asic_handle *h, const u_int8_t *key)
1118 {
1119         u_int8_t coded_key[RFID_MIFARE_KEY_CODED_LEN];
1120         int ret;
1121
1122         ret = rc632_mifare_transform_key(key, coded_key);
1123         if (ret < 0)
1124                 return ret;
1125
1126         ret = rc632_fifo_write(h, RFID_MIFARE_KEY_CODED_LEN, coded_key, 0x03);
1127         if (ret < 0)
1128                 return ret;
1129
1130         ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_LOAD_KEY);
1131         if (ret < 0)
1132                 return ret;
1133
1134         ret = rc632_wait_idle(h, RC632_TMO_AUTH1);
1135         if (ret < 0)
1136                 return ret;
1137
1138         return 0;
1139 }
1140
1141 static int
1142 rc632_mifare_auth(struct rfid_asic_handle *h, u_int8_t cmd, u_int32_t serno,
1143                   u_int8_t block)
1144 {
1145         int ret;
1146         struct mifare_authcmd acmd;
1147         u_int8_t reg;
1148
1149         if (cmd != RFID_CMD_MIFARE_AUTH1A && cmd != RFID_CMD_MIFARE_AUTH1B)
1150                 return -EINVAL;
1151
1152         /* Initialize acmd */
1153         acmd.block_address = block & 0xff;
1154         acmd.auth_cmd = cmd;
1155         acmd.serno = serno;
1156
1157         /* Send Authent1 Command */
1158         ret = rc632_fifo_write(h, sizeof(acmd), &acmd, 0x03);
1159         if (ret < 0)
1160                 return ret;
1161
1162         ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_AUTHENT1);
1163         if (ret < 0)
1164                 return ret;
1165
1166         /* Wait until transmitter is idle */
1167         ret = rc632_wait_idle(h, RC632_TMO_AUTH1);
1168         if (ret < 0)
1169                 return ret;
1170
1171         /* Clear Rx/Tx CRC */
1172         ret = rc632_clear_bits(h, RC632_REG_CHANNEL_REDUNDANCY,
1173                                 RC632_CR_RX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE);
1174         if (ret < 0)
1175                 return ret;
1176
1177         /* Send Authent2 Command */
1178         ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_AUTHENT2);
1179         if (ret < 0)
1180                 return ret;
1181
1182         /* Wait until transmitter is idle */
1183         ret = rc632_wait_idle(h, RC632_TMO_AUTH1);
1184         if (ret < 0)
1185                 return ret;
1186
1187         /* Check whether authentication was successful */
1188         ret = rc632_reg_read(h, RC632_REG_CONTROL, &reg);
1189         if (ret < 0)
1190                 return ret;
1191
1192         if (!(reg & RC632_CONTROL_CRYPTO1_ON))
1193                 return -EACCES;
1194
1195         return 0;
1196
1197 }
1198
1199 struct rfid_asic rc632 = {
1200         .name   = "Philips CL RC632",
1201         .fc     = ISO14443_FREQ_CARRIER,
1202         .priv.rc632 = {
1203                 .fn.power_up = &rc632_power_up,
1204                 .fn.power_down = &rc632_power_down,
1205                 .fn.turn_on_rf = &rc632_turn_on_rf,
1206                 .fn.turn_off_rf = &rc632_turn_off_rf,
1207                 .fn.transcieve = &rc632_iso14443a_transcieve,
1208                 .fn.iso14443a = {
1209                         .init = &rc632_iso14443a_init,
1210                         .transcieve_sf = &rc632_iso14443a_transcieve_sf,
1211                         .transcieve_acf = &rc632_iso14443a_transcieve_acf,
1212                 },
1213                 .fn.iso14443b = {
1214                         .init = &rc632_iso14443b_init,
1215                 },
1216                 .fn.iso15693 = {
1217                         .init = &rc632_iso15693_init,
1218                 },
1219                 .fn.mifare_classic = {
1220                         .setkey = &rc632_mifare_set_key,
1221                         .auth = &rc632_mifare_auth,
1222                 },
1223         },
1224 };
1225
1226