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