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