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

   1 /* Generic Philips CL RC632 Routines
   2  *
   3  * (C) 2005-2006 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., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA
  20  */
  21
  22 #include <unistd.h>
  23 #include <stdlib.h>
  24 #include <string.h>
  25 #include <errno.h>
  26 #include <limits.h>
  27 #include <sys/types.h>
  28
  29 #include <librfid/rfid.h>
  30 #include <librfid/rfid_asic.h>
  31 #include <librfid/rfid_asic_rc632.h>
  32 #include <librfid/rfid_reader_cm5121.h>
  33 #include <librfid/rfid_layer2_iso14443a.h>
  34 #include <librfid/rfid_protocol_mifare_classic.h>
  35
  36 #include "rfid_iso14443_common.h"
  37 #include "rc632.h"
  38
  39 #ifdef  __MINGW32__
  40 #include "usleep.h"
  41 #endif/*__MINGW32__*/
  42
  43 #define RC632_TMO_AUTH1 140
  44
  45 #define ENTER()         DEBUGP("entering\n")
  46 const struct rfid_asic rc632;
  47
  48 /* Register and FIFO Access functions */
  49 static int
  50 rc632_reg_write(struct rfid_asic_handle *handle,
  51                 u_int8_t reg,
  52                 u_int8_t val)
  53 {
  54         return handle->rath->rat->priv.rc632.fn.reg_write(handle->rath, reg, val);
  55 }
  56
  57 static int
  58 rc632_reg_read(struct rfid_asic_handle *handle,
  59                u_int8_t reg,
  60                u_int8_t *val)
  61 {
  62         return handle->rath->rat->priv.rc632.fn.reg_read(handle->rath, reg, val);
  63 }
  64
  65 static int
  66 rc632_fifo_write(struct rfid_asic_handle *handle,
  67                  u_int8_t len,
  68                  const u_int8_t *buf,
  69                  u_int8_t flags)
  70 {
  71         return handle->rath->rat->priv.rc632.fn.fifo_write(handle->rath,
  72                                                            len, buf, flags);
  73 }
  74
  75 static int
  76 rc632_fifo_read(struct rfid_asic_handle *handle,
  77                 u_int8_t len,
  78                 u_int8_t *buf)
  79 {
  80         return handle->rath->rat->priv.rc632.fn.fifo_read(handle->rath, len, buf);
  81 }
  82
  83
  84 static int
  85 rc632_set_bits(struct rfid_asic_handle *handle,
  86                 u_int8_t reg,
  87                 u_int8_t val)
  88 {
  89         int ret;
  90         u_int8_t tmp;
  91
  92         ret = rc632_reg_read(handle, reg, &tmp);
  93         if (ret < 0)
  94                 return -1;
  95
  96         /* if bits are already set, no need to set them again */
  97         if ((tmp & val) == val)
  98                 return 0;
  99
 100         return rc632_reg_write(handle, reg, (tmp|val)&0xff);
 101 }
 102 static int
 103 rc632_set_bit_mask(struct rfid_asic_handle *handle,
 104                    u_int8_t reg, u_int8_t mask, u_int8_t val)
 105 {
 106         int ret;
 107         u_int8_t tmp;
 108
 109         ret = rc632_reg_read(handle, reg, &tmp);
 110         if (ret < 0)
 111                 return ret;
 112
 113         /* if bits are already like we want them, abort */
 114         if ((tmp & mask) == val)
 115                 return 0;
 116
 117         return rc632_reg_write(handle, reg, (tmp & ~mask)|(val & mask));
 118 }
 119
 120 static int
 121 rc632_clear_bits(struct rfid_asic_handle *handle,
 122                  u_int8_t reg,
 123                  u_int8_t val)
 124 {
 125         int ret;
 126         u_int8_t tmp;
 127
 128         ret = rc632_reg_read(handle, reg, &tmp);
 129         if (ret < 0) {
 130                 DEBUGP("error during reg_read(%p, %d):%d\n",
 131                         handle, reg, ret);
 132                 return -1;
 133         }
 134         /* if bits are already cleared, no need to clear them again */
 135         if ((tmp & val) == 0)
 136                 return 0;
 137
 138         return rc632_reg_write(handle, reg, (tmp & ~val)&0xff);
 139 }
 140
 141 static int
 142 rc632_turn_on_rf(struct rfid_asic_handle *handle)
 143 {
 144         ENTER();
 145         return rc632_set_bits(handle, RC632_REG_TX_CONTROL, 0x03);
 146 }
 147
 148 static int
 149 rc632_turn_off_rf(struct rfid_asic_handle *handle)
 150 {
 151         ENTER();
 152         return rc632_clear_bits(handle, RC632_REG_TX_CONTROL, 0x03);
 153 }
 154
 155 static int
 156 rc632_power_up(struct rfid_asic_handle *handle)
 157 {
 158         ENTER();
 159         return rc632_clear_bits(handle, RC632_REG_CONTROL,
 160                                 RC632_CONTROL_POWERDOWN);
 161 }
 162
 163 static int
 164 rc632_power_down(struct rfid_asic_handle *handle)
 165 {
 166         return rc632_set_bits(handle, RC632_REG_CONTROL,
 167                               RC632_CONTROL_POWERDOWN);
 168 }
 169
 170 /* calculate best 8bit prescaler and divisor for given usec timeout */
 171 static int best_prescaler(u_int64_t timeout, u_int8_t *prescaler,
 172                           u_int8_t *divisor)
 173 {
 174         u_int8_t best_prescaler, best_divisor, i;
 175         int64_t smallest_diff;
 176
 177         smallest_diff = LLONG_MAX;
 178         best_prescaler = 0;
 179
 180         for (i = 0; i < 21; i++) {
 181                 u_int64_t clk, tmp_div, res;
 182                 int64_t diff;
 183                 clk = 13560000 / (1 << i);
 184                 tmp_div = (clk * timeout) / 1000000;
 185                 tmp_div++;
 186
 187                 if ((tmp_div > 0xff) || (tmp_div > clk))
 188                         continue;
 189
 190                 res = 1000000 / (clk / tmp_div);
 191                 diff = res - timeout;
 192
 193                 if (diff < 0)
 194                         continue;
 195
 196                 if (diff < smallest_diff) {
 197                         best_prescaler = i;
 198                         best_divisor = tmp_div;
 199                         smallest_diff = diff;
 200                 }
 201         }
 202
 203         *prescaler = best_prescaler;
 204         *divisor = best_divisor;
 205
 206         DEBUGP("timeout %u usec, prescaler = %u, divisor = %u\n",
 207                 timeout, best_prescaler, best_divisor);
 208
 209         return 0;
 210 }
 211
 212 static int
 213 rc632_timer_set(struct rfid_asic_handle *handle,
 214                 u_int64_t timeout)
 215 {
 216         int ret;
 217         u_int8_t prescaler, divisor;
 218
 219         ret = best_prescaler(timeout, &prescaler, &divisor);
 220
 221         ret = rc632_reg_write(handle, RC632_REG_TIMER_CLOCK,
 222                               prescaler & 0x1f);
 223         if (ret < 0)
 224                 return ret;
 225
 226         ret = rc632_reg_write(handle, RC632_REG_TIMER_CONTROL,
 227                               RC632_TMR_START_TX_END|RC632_TMR_STOP_RX_BEGIN);
 228
 229         /* clear timer irq bit */
 230         ret = rc632_set_bits(handle, RC632_REG_INTERRUPT_RQ, RC632_IRQ_TIMER);
 231
 232         ret |= rc632_reg_write(handle, RC632_REG_TIMER_RELOAD, divisor);
 233
 234         return ret;
 235 }
 236
 237 /* Wait until RC632 is idle or TIMER IRQ has happened */
 238 static int rc632_wait_idle_timer(struct rfid_asic_handle *handle)
 239 {
 240         int ret;
 241         u_int8_t irq, cmd;
 242
 243         while (1) {
 244                 rc632_reg_read(handle, RC632_REG_PRIMARY_STATUS, &irq);
 245                 rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &irq);
 246                 ret = rc632_reg_read(handle, RC632_REG_INTERRUPT_RQ, &irq);
 247                 if (ret < 0)
 248                         return ret;
 249
 250                 /* FIXME: currently we're lazy:  If we actually received
 251                  * something even after the timer expired, we accept it */
 252                 if (irq & RC632_IRQ_TIMER && !(irq & RC632_IRQ_RX)) {
 253                         u_int8_t foo;
 254                         rc632_reg_read(handle, RC632_REG_PRIMARY_STATUS, &foo);
 255                         if (foo & 0x04)
 256                                 rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &foo);
 257
 258                         return -110;
 259                 }
 260
 261                 ret = rc632_reg_read(handle, RC632_REG_COMMAND, &cmd);
 262                 if (ret < 0)
 263                         return ret;
 264
 265                 if (cmd == 0)
 266                         return 0;
 267
 268                 /* poll every millisecond */
 269                 usleep(1000);
 270         }
 271 }
 272
 273 /* Stupid RC632 implementations don't evaluate interrupts but poll the
 274  * command register for "status idle" */
 275 static int
 276 rc632_wait_idle(struct rfid_asic_handle *handle, u_int64_t timeout)
 277 {
 278         u_int8_t cmd = 0xff;
 279         int ret, cycles = 0;
 280 #define USLEEP_PER_CYCLE        128
 281
 282         while (cmd != 0) {
 283                 ret = rc632_reg_read(handle, RC632_REG_COMMAND, &cmd);
 284                 if (ret < 0)
 285                         return ret;
 286
 287                 if (cmd == 0) {
 288                         /* FIXME: read second time ?? */
 289                         return 0;
 290                 }
 291
 292                 {
 293                         u_int8_t foo;
 294                         rc632_reg_read(handle, RC632_REG_PRIMARY_STATUS, &foo);
 295                         if (foo & 0x04)
 296                                 rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &foo);
 297                 }
 298
 299                 /* Abort after some timeout */
 300                 if (cycles > timeout*100/USLEEP_PER_CYCLE) {
 301                         return -ETIMEDOUT;
 302                 }
 303
 304                 cycles++;
 305                 usleep(USLEEP_PER_CYCLE);
 306         }
 307
 308         return 0;
 309 }
 310
 311 static int
 312 rc632_transmit(struct rfid_asic_handle *handle,
 313                 const u_int8_t *buf,
 314                 u_int8_t len,
 315                 u_int64_t timeout)
 316 {
 317         int ret, cur_len;
 318         const u_int8_t *cur_buf = buf;
 319
 320         if (len > 64)
 321                 cur_len = 64;
 322         else
 323                 cur_len = len;
 324
 325         do {
 326                 ret = rc632_fifo_write(handle, cur_len, cur_buf, 0x03);
 327                 if (ret < 0)
 328                         return ret;
 329
 330                 if (cur_buf == buf)  {
 331                         /* only start transmit first time */
 332                         ret = rc632_reg_write(handle, RC632_REG_COMMAND,
 333                                               RC632_CMD_TRANSMIT);
 334                         if (ret < 0)
 335                                 return ret;
 336                 }
 337
 338                 cur_buf += cur_len;
 339                 if (cur_buf < buf + len) {
 340                         cur_len = buf - cur_buf;
 341                         if (cur_len > 64)
 342                                 cur_len = 64;
 343                 } else
 344                         cur_len = 0;
 345
 346         } while (cur_len);
 347
 348         return rc632_wait_idle(handle, timeout);
 349 }
 350
 351 static int
 352 tcl_toggle_pcb(struct rfid_asic_handle *handle)
 353 {
 354         // FIXME: toggle something between 0x0a and 0x0b
 355         return 0;
 356 }
 357
 358 static int
 359 rc632_transceive(struct rfid_asic_handle *handle,
 360                  const u_int8_t *tx_buf,
 361                  u_int8_t tx_len,
 362                  u_int8_t *rx_buf,
 363                  u_int8_t *rx_len,
 364                  u_int64_t timer,
 365                  unsigned int toggle)
 366 {
 367         int ret, cur_tx_len;
 368         u_int8_t rx_avail;
 369         const u_int8_t *cur_tx_buf = tx_buf;
 370
 371         DEBUGP("timer = %u\n", timer);
 372
 373         if (tx_len > 64)
 374                 cur_tx_len = 64;
 375         else
 376                 cur_tx_len = tx_len;
 377
 378         ret = rc632_timer_set(handle, timer*10);
 379         if (ret < 0)
 380                 return ret;
 381
 382         ret = rc632_reg_write(handle, RC632_REG_COMMAND, 0x00);
 383         /* clear all interrupts */
 384         ret = rc632_reg_write(handle, RC632_REG_INTERRUPT_RQ, 0x7f);
 385
 386         do {
 387                 ret = rc632_fifo_write(handle, cur_tx_len, cur_tx_buf, 0x03);
 388                 if (ret < 0)
 389                         return ret;
 390
 391                 if (cur_tx_buf == tx_buf) {
 392                         ret = rc632_reg_write(handle, RC632_REG_COMMAND,
 393                                               RC632_CMD_TRANSCEIVE);
 394                         if (ret < 0)
 395                                 return ret;
 396                 }
 397
 398                 cur_tx_buf += cur_tx_len;
 399                 if (cur_tx_buf < tx_buf + tx_len) {
 400                         u_int8_t fifo_fill;
 401                         ret = rc632_reg_read(handle, RC632_REG_FIFO_LENGTH,
 402                                              &fifo_fill);
 403                         if (ret < 0)
 404                                 return ret;
 405
 406                         cur_tx_len = 64 - fifo_fill;
 407                         //printf("refilling tx fifo with %u bytes\n", cur_tx_len);
 408                 } else
 409                         cur_tx_len = 0;
 410
 411         } while (cur_tx_len);
 412
 413         if (toggle == 1)
 414                 tcl_toggle_pcb(handle);
 415
 416         //ret = rc632_wait_idle_timer(handle);
 417         ret = rc632_wait_idle(handle, timer);
 418         if (ret < 0)
 419                 return ret;
 420
 421         ret = rc632_reg_read(handle, RC632_REG_FIFO_LENGTH, &rx_avail);
 422         if (ret < 0)
 423                 return ret;
 424
 425         if (rx_avail > *rx_len) {
 426                 //printf("rx_avail(%d) > rx_len(%d), JFYI\n", rx_avail, *rx_len);
 427         } else if (*rx_len > rx_avail)
 428                 *rx_len = rx_avail;
 429
 430         if (rx_avail == 0) {
 431                 u_int8_t tmp;
 432
 433                 DEBUGP("rx_len == 0\n");
 434
 435                 rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &tmp);
 436                 rc632_reg_read(handle, RC632_REG_CHANNEL_REDUNDANCY, &tmp);
 437
 438                 return -1;
 439         }
 440
 441         return rc632_fifo_read(handle, *rx_len, rx_buf);
 442         /* FIXME: discard addidional bytes in FIFO */
 443 }
 444
 445 static int
 446 rc632_read_eeprom(struct rfid_asic_handle *handle)
 447 {
 448         u_int8_t recvbuf[60];
 449         u_int8_t sndbuf[3];
 450         int ret;
 451
 452         sndbuf[0] = 0x00;
 453         sndbuf[1] = 0x00;
 454         sndbuf[2] = 0x3c;
 455
 456         ret = rc632_fifo_write(handle, 3, sndbuf, 0x03);
 457         if (ret < 0)
 458                 return ret;
 459
 460         ret = rc632_reg_write(handle, RC632_REG_COMMAND, RC632_CMD_READ_E2);
 461         if (ret < 0)
 462                 return ret;
 463
 464         usleep(20000);
 465
 466         ret = rc632_fifo_read(handle, sizeof(recvbuf), recvbuf);
 467         if (ret < 0)
 468                 return ret;
 469
 470         // FIXME: do something with eeprom contents
 471         return ret;
 472 }
 473
 474 static int
 475 rc632_calc_crc16_from(struct rfid_asic_handle *handle)
 476 {
 477         u_int8_t sndbuf[2] = { 0x01, 0x02 };
 478         u_int8_t crc_lsb = 0x00 , crc_msb = 0x00;
 479         int ret;
 480
 481         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_LSB, 0x12);
 482         if (ret < 0)
 483                 return ret;
 484
 485         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_MSB, 0xe0);
 486         if (ret < 0)
 487                 return ret;
 488
 489         ret = rc632_fifo_write(handle, sizeof(sndbuf), sndbuf, 3);
 490         if (ret < 0)
 491                 return ret;
 492
 493         ret = rc632_reg_write(handle, RC632_REG_COMMAND, RC632_CMD_CALC_CRC);
 494         if (ret < 0)
 495                 return ret;
 496
 497         usleep(10000);  // FIXME: no checking for cmd completion?
 498
 499         ret = rc632_reg_read(handle, RC632_REG_CRC_RESULT_LSB, &crc_lsb);
 500         if (ret < 0)
 501                 return ret;
 502
 503         ret = rc632_reg_read(handle, RC632_REG_CRC_RESULT_MSB, &crc_msb);
 504         if (ret < 0)
 505                 return ret;
 506
 507         // FIXME: what to do with crc result?
 508         return ret;
 509 }
 510
 511
 512 int
 513 rc632_register_dump(struct rfid_asic_handle *handle, u_int8_t *buf)
 514 {
 515         int ret = 0;
 516         u_int8_t i;
 517
 518         for (i = 0; i <= 0x3f; i++)
 519                 ret |= rc632_reg_read(handle, i, &buf[i]);
 520
 521         return ret;
 522 }
 523
 524 /* generic FIFO access functions (if no more efficient ones provided by
 525  * transport driver) */
 526
 527 static int
 528 generic_fifo_write()
 529 {
 530         // FIXME: implementation (not needed for CM 5121)
 531         return -1;
 532 }
 533
 534 static int
 535 generic_fifo_read()
 536 {
 537         // FIXME: implementation (not neded for CM 5121)
 538         return -1;
 539 }
 540
 541 static int
 542 rc632_init(struct rfid_asic_handle *ah)
 543 {
 544         int ret;
 545
 546         /* switch off rf (make sure PICCs are reset at init time) */
 547         ret = rc632_power_down(ah);
 548         if (ret < 0)
 549                 return ret;
 550
 551         usleep(10000);
 552
 553         /* switch on rf */
 554         ret = rc632_power_up(ah);
 555         if (ret < 0)
 556                 return ret;
 557
 558         /* disable register paging */
 559         ret = rc632_reg_write(ah, 0x00, 0x00);
 560         if (ret < 0)
 561                 return ret;
 562
 563         /* set some sane default values */
 564         ret = rc632_reg_write(ah, 0x11, 0x5b);
 565         if (ret < 0)
 566                 return ret;
 567
 568         /* switch off rf */
 569         ret = rc632_turn_off_rf(ah);
 570         if (ret < 0)
 571                 return ret;
 572
 573         usleep(100000);
 574
 575         /* switch on rf */
 576         ret = rc632_turn_on_rf(ah);
 577         if (ret < 0)
 578                 return ret;
 579
 580         return 0;
 581 }
 582
 583 static int
 584 rc632_fini(struct rfid_asic_handle *ah)
 585 {
 586         int ret;
 587
 588         /* switch off rf */
 589         ret = rc632_turn_off_rf(ah);
 590         if (ret < 0)
 591                 return ret;
 592
 593         ret = rc632_power_down(ah);
 594         if (ret < 0)
 595                 return ret;
 596
 597         return 0;
 598 }
 599
 600 struct rfid_asic_handle *
 601 rc632_open(struct rfid_asic_transport_handle *th)
 602 {
 603         struct rfid_asic_handle *h;
 604
 605         h = malloc_asic_handle(sizeof(*h));
 606         if (!h)
 607                 return NULL;
 608         memset(h, 0, sizeof(*h));
 609
 610         h->asic = (void*)&rc632;
 611         h->rath = th;
 612         h->fc = h->asic->fc;
 613         /* FIXME: this is only cm5121 specific, since the latency
 614          * down to the RC632 FIFO is too long to refill during TX/RX */
 615         h->mtu = h->mru = 64;
 616
 617         if (rc632_init(h) < 0) {
 618                 free_asic_handle(h);
 619                 return NULL;
 620         }
 621
 622         return h;
 623 }
 624
 625 void
 626 rc632_close(struct rfid_asic_handle *h)
 627 {
 628         rc632_fini(h);
 629         free_asic_handle(h);
 630 }
 631
 632
 633 /*
 634  * Philips CL RC632 primitives for ISO 14443-A compliant PICC's
 635  *
 636  * (C) 2005-2006 by Harald Welte <laforge@gnumonks.org>
 637  *
 638  */
 639
 640 static int
 641 rc632_iso14443a_init(struct rfid_asic_handle *handle)
 642 {
 643         int ret;
 644
 645         // FIXME: some fifo work (drain fifo?)
 646
 647         /* flush fifo (our way) */
 648         ret = rc632_reg_write(handle, RC632_REG_CONTROL,
 649                               RC632_CONTROL_FIFO_FLUSH);
 650
 651         ret = rc632_reg_write(handle, RC632_REG_TX_CONTROL,
 652                         (RC632_TXCTRL_TX1_RF_EN |
 653                          RC632_TXCTRL_TX2_RF_EN |
 654                          RC632_TXCTRL_TX2_INV |
 655                          RC632_TXCTRL_FORCE_100_ASK |
 656                          RC632_TXCTRL_MOD_SRC_INT));
 657         if (ret < 0)
 658                 return ret;
 659
 660         ret = rc632_reg_write(handle, RC632_REG_CW_CONDUCTANCE,
 661                                 CM5121_CW_CONDUCTANCE);
 662         if (ret < 0)
 663                 return ret;
 664
 665         /* Since FORCE_100_ASK is set (cf mc073930.pdf), this line may be left out? */
 666         ret = rc632_reg_write(handle, RC632_REG_MOD_CONDUCTANCE,
 667                                 CM5121_MOD_CONDUCTANCE);
 668         if (ret < 0)
 669                 return ret;
 670
 671         ret = rc632_reg_write(handle, RC632_REG_CODER_CONTROL,
 672                                 (RC632_CDRCTRL_TXCD_14443A |
 673                                  RC632_CDRCTRL_RATE_106K));
 674         if (ret < 0)
 675                 return ret;
 676
 677         ret = rc632_reg_write(handle, RC632_REG_MOD_WIDTH, 0x13);
 678         if (ret < 0)
 679                 return ret;
 680
 681         ret = rc632_reg_write(handle, RC632_REG_MOD_WIDTH_SOF, 0x3f);
 682         if (ret < 0)
 683                 return ret;
 684
 685         ret = rc632_reg_write(handle, RC632_REG_TYPE_B_FRAMING, 0x00);
 686         if (ret < 0)
 687                 return ret;
 688
 689         ret = rc632_reg_write(handle, RC632_REG_RX_CONTROL1,
 690                               (RC632_RXCTRL1_GAIN_35DB |
 691                                RC632_RXCTRL1_ISO14443 |
 692                                RC632_RXCTRL1_SUBCP_8));
 693         if (ret < 0)
 694                 return ret;
 695
 696         ret = rc632_reg_write(handle, RC632_REG_DECODER_CONTROL,
 697                               (RC632_DECCTRL_MANCHESTER |
 698                                RC632_DECCTRL_RXFR_14443A));
 699         if (ret < 0)
 700                 return ret;
 701
 702         ret = rc632_reg_write(handle, RC632_REG_BIT_PHASE,
 703                                 CM5121_14443A_BITPHASE);
 704         if (ret < 0)
 705                 return ret;
 706
 707         ret = rc632_reg_write(handle, RC632_REG_RX_THRESHOLD,
 708                                 CM5121_14443A_THRESHOLD);
 709         if (ret < 0)
 710                 return ret;
 711
 712         ret = rc632_reg_write(handle, RC632_REG_BPSK_DEM_CONTROL, 0x00);
 713         if (ret < 0)
 714                 return ret;
 715
 716         ret = rc632_reg_write(handle, RC632_REG_RX_CONTROL2,
 717                               (RC632_RXCTRL2_DECSRC_INT |
 718                                RC632_RXCTRL2_CLK_Q));
 719         if (ret < 0)
 720                 return ret;
 721
 722         /* Omnikey proprietary driver has 0x03, but 0x06 is the default reset value ?!? */
 723         ret = rc632_reg_write(handle, RC632_REG_RX_WAIT, 0x06);
 724         if (ret < 0)
 725                 return ret;
 726
 727         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 728                               (RC632_CR_PARITY_ENABLE |
 729                                RC632_CR_PARITY_ODD));
 730         if (ret < 0)
 731                 return ret;
 732
 733         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_LSB, 0x63);
 734         if (ret < 0)
 735                 return ret;
 736
 737         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_MSB, 0x63);
 738         if (ret < 0)
 739                 return ret;
 740
 741         return 0;
 742 }
 743
 744 static int
 745 rc632_iso14443a_fini(struct iso14443a_handle *handle_14443)
 746 {
 747
 748 #if 0
 749         ret = rc632_turn_off_rf(handle);
 750         if (ret < 0)
 751                 return ret;
 752 #endif
 753
 754
 755         return 0;
 756 }
 757
 758
 759 /* issue a 14443-3 A PCD -> PICC command in a short frame, such as REQA, WUPA */
 760 static int
 761 rc632_iso14443a_transceive_sf(struct rfid_asic_handle *handle,
 762                                 u_int8_t cmd,
 763                                 struct iso14443a_atqa *atqa)
 764 {
 765         int ret;
 766         u_int8_t tx_buf[1];
 767         u_int8_t rx_len = 2;
 768
 769         memset(atqa, 0, sizeof(*atqa));
 770
 771         tx_buf[0] = cmd;
 772
 773         /* transfer only 7 bits of last byte in frame */
 774         ret = rc632_reg_write(handle, RC632_REG_BIT_FRAMING, 0x07);
 775         if (ret < 0)
 776                 return ret;
 777
 778         ret = rc632_clear_bits(handle, RC632_REG_CONTROL,
 779                                 RC632_CONTROL_CRYPTO1_ON);
 780         if (ret < 0)
 781                 return ret;
 782
 783 #if 0
 784         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 785                                 (RC632_CR_PARITY_ENABLE |
 786                                  RC632_CR_PARITY_ODD));
 787 #else
 788         ret = rc632_clear_bits(handle, RC632_REG_CHANNEL_REDUNDANCY,
 789                                 RC632_CR_RX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE);
 790
 791 #endif
 792         if (ret < 0)
 793                 return ret;
 794
 795         ret = rc632_transceive(handle, tx_buf, sizeof(tx_buf),
 796                                 (u_int8_t *)atqa, &rx_len,
 797                                 ISO14443A_FDT_ANTICOL_LAST1, 0);
 798         if (ret < 0) {
 799                 DEBUGP("error during rc632_transceive()\n");
 800                 return ret;
 801         }
 802
 803         /* switch back to normal 8bit last byte */
 804         ret = rc632_reg_write(handle, RC632_REG_BIT_FRAMING, 0x00);
 805         if (ret < 0)
 806                 return ret;
 807
 808         if (rx_len != 2) {
 809                 DEBUGP("rx_len(%d) != 2\n", rx_len);
 810                 return -1;
 811         }
 812
 813         return 0;
 814 }
 815
 816 /* transceive regular frame */
 817 static int
 818 rc632_iso14443ab_transceive(struct rfid_asic_handle *handle,
 819                            unsigned int frametype,
 820                            const u_int8_t *tx_buf, unsigned int tx_len,
 821                            u_int8_t *rx_buf, unsigned int *rx_len,
 822                            u_int64_t timeout, unsigned int flags)
 823 {
 824         int ret;
 825         u_int8_t rxl;
 826         u_int8_t channel_red;
 827
 828         if (*rx_len > 0xff)
 829                 rxl = 0xff;
 830         else
 831                 rxl = *rx_len;
 832
 833         memset(rx_buf, 0, *rx_len);
 834
 835         switch (frametype) {
 836         case RFID_14443A_FRAME_REGULAR:
 837         case RFID_MIFARE_FRAME:
 838                 channel_red = RC632_CR_RX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE
 839                                 |RC632_CR_PARITY_ENABLE|RC632_CR_PARITY_ODD;
 840                 break;
 841         case RFID_14443B_FRAME_REGULAR:
 842                 channel_red = RC632_CR_RX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE
 843                                 |RC632_CR_CRC3309;
 844                 break;
 845 #if 0
 846         case RFID_MIFARE_FRAME:
 847                 channel_red = RC632_CR_PARITY_ENABLE|RC632_CR_PARITY_ODD;
 848                 break;
 849 #endif
 850         default:
 851                 return -EINVAL;
 852                 break;
 853         }
 854         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 855                               channel_red);
 856         if (ret < 0)
 857                 return ret;
 858
 859         ret = rc632_transceive(handle, tx_buf, tx_len, rx_buf, &rxl, timeout, 0);
 860         *rx_len = rxl;
 861         if (ret < 0)
 862                 return ret;
 863
 864
 865         return 0;
 866 }
 867
 868 /* transceive anti collission bitframe */
 869 static int
 870 rc632_iso14443a_transceive_acf(struct rfid_asic_handle *handle,
 871                                 struct iso14443a_anticol_cmd *acf,
 872                                 unsigned int *bit_of_col)
 873 {
 874         int ret;
 875         u_int8_t rx_buf[64];
 876         u_int8_t rx_len = sizeof(rx_buf);
 877         u_int8_t rx_align = 0, tx_last_bits, tx_bytes, tx_bytes_total;
 878         u_int8_t boc;
 879         u_int8_t error_flag;
 880         *bit_of_col = ISO14443A_BITOFCOL_NONE;
 881         memset(rx_buf, 0, sizeof(rx_buf));
 882
 883         /* disable mifare cryto */
 884         ret = rc632_clear_bits(handle, RC632_REG_CONTROL,
 885                                 RC632_CONTROL_CRYPTO1_ON);
 886         if (ret < 0)
 887                 return ret;
 888
 889         /* disable CRC summing */
 890 #if 0
 891         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
 892                                 (RC632_CR_PARITY_ENABLE |
 893                                  RC632_CR_PARITY_ODD));
 894 #else
 895         ret = rc632_clear_bits(handle, RC632_REG_CHANNEL_REDUNDANCY,
 896                                 RC632_CR_TX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE);
 897 #endif
 898         if (ret < 0)
 899                 return ret;
 900
 901         tx_last_bits = acf->nvb & 0x07; /* lower nibble indicates bits */
 902         tx_bytes = ( acf->nvb >> 4 ) & 0x07;
 903         if (tx_last_bits) {
 904                 tx_bytes_total = tx_bytes+1;
 905                 rx_align = tx_last_bits & 0x07; /* rx frame complements tx */
 906         }
 907         else
 908                 tx_bytes_total = tx_bytes;
 909
 910         /* set RxAlign and TxLastBits*/
 911         ret = rc632_reg_write(handle, RC632_REG_BIT_FRAMING,
 912                                 (rx_align << 4) | (tx_last_bits));
 913         if (ret < 0)
 914                 return ret;
 915
 916         ret = rc632_transceive(handle, (u_int8_t *)acf, tx_bytes_total,
 917                                 rx_buf, &rx_len, 0x32, 0);
 918         if (ret < 0)
 919                 return ret;
 920
 921         /* bitwise-OR the two halves of the split byte */
 922         acf->uid_bits[tx_bytes-2] = (
 923                   (acf->uid_bits[tx_bytes-2] & (0xff >> (8-tx_last_bits)))
 924                 | rx_buf[0]);
 925
 926         /* copy the rest */
 927         if (rx_len)
 928                 memcpy(&acf->uid_bits[tx_bytes-1], &rx_buf[1], rx_len-1);
 929
 930         /* determine whether there was a collission */
 931         ret = rc632_reg_read(handle, RC632_REG_ERROR_FLAG, &error_flag);
 932         if (ret < 0)
 933                 return ret;
 934
 935         if (error_flag & RC632_ERR_FLAG_COL_ERR) {
 936                 /* retrieve bit of collission */
 937                 ret = rc632_reg_read(handle, RC632_REG_COLL_POS, &boc);
 938                 if (ret < 0)
 939                         return ret;
 940
 941                 /* bit of collission relative to start of part 1 of
 942                  * anticollision frame (!) */
 943                 *bit_of_col = 2*8 + boc;
 944         }
 945
 946         return 0;
 947 }
 948
 949 enum rc632_rate {
 950         RC632_RATE_106  = 0x00,
 951         RC632_RATE_212  = 0x01,
 952         RC632_RATE_424  = 0x02,
 953         RC632_RATE_848  = 0x03,
 954 };
 955
 956 struct rx_config {
 957         u_int8_t        subc_pulses;
 958         u_int8_t        rx_coding;
 959         u_int8_t        rx_threshold;
 960         u_int8_t        bpsk_dem_ctrl;
 961 };
 962
 963 struct tx_config {
 964         u_int8_t        rate;
 965         u_int8_t        mod_width;
 966 };
 967
 968 static struct rx_config rx_configs[] = {
 969         {
 970                 .subc_pulses    = RC632_RXCTRL1_SUBCP_8,
 971                 .rx_coding      = RC632_DECCTRL_MANCHESTER,
 972                 .rx_threshold   = 0x88,
 973                 .bpsk_dem_ctrl  = 0x00,
 974         },
 975         {
 976                 .subc_pulses    = RC632_RXCTRL1_SUBCP_4,
 977                 .rx_coding      = RC632_DECCTRL_BPSK,
 978                 .rx_threshold   = 0x50,
 979                 .bpsk_dem_ctrl  = 0x0c,
 980         },
 981         {
 982                 .subc_pulses    = RC632_RXCTRL1_SUBCP_2,
 983                 .rx_coding      = RC632_DECCTRL_BPSK,
 984                 .rx_threshold   = 0x50,
 985                 .bpsk_dem_ctrl  = 0x0c,
 986         },
 987         {
 988                 .subc_pulses    = RC632_RXCTRL1_SUBCP_1,
 989                 .rx_coding      = RC632_DECCTRL_BPSK,
 990                 .rx_threshold   = 0x50,
 991                 .bpsk_dem_ctrl  = 0x0c,
 992         },
 993 };
 994
 995 static struct tx_config tx_configs[] = {
 996         {
 997                 .rate           = RC632_CDRCTRL_RATE_106K,
 998                 .mod_width      = 0x13,
 999         },
1000         {
1001                 .rate           = RC632_CDRCTRL_RATE_212K,
1002                 .mod_width      = 0x07,
1003         },
1004         {
1005                 .rate           = RC632_CDRCTRL_RATE_424K,
1006                 .mod_width      = 0x03,
1007         },
1008         {
1009                 .rate           = RC632_CDRCTRL_RATE_848K,
1010                 .mod_width      = 0x01,
1011         },
1012 };
1013
1014 static int rc632_iso14443a_set_speed(struct rfid_asic_handle *handle,
1015                                      unsigned int tx, unsigned int rate)
1016 {
1017         int rc;
1018         u_int8_t reg;
1019
1020
1021         if (!tx) {
1022                 /* Rx */
1023                 if (rate > ARRAY_SIZE(rx_configs))
1024                         return -EINVAL;
1025
1026                 rc = rc632_set_bit_mask(handle, RC632_REG_RX_CONTROL1,
1027                                         RC632_RXCTRL1_SUBCP_MASK,
1028                                         rx_configs[rate].subc_pulses);
1029                 if (rc < 0)
1030                         return rc;
1031
1032                 rc = rc632_set_bit_mask(handle, RC632_REG_DECODER_CONTROL,
1033                                         RC632_DECCTRL_BPSK,
1034                                         rx_configs[rate].rx_coding);
1035                 if (rc < 0)
1036                         return rc;
1037
1038                 rc = rc632_reg_write(handle, RC632_REG_RX_THRESHOLD,
1039                                         rx_configs[rate].rx_threshold);
1040                 if (rc < 0)
1041                         return rc;
1042
1043                 if (rx_configs[rate].rx_coding == RC632_DECCTRL_BPSK) {
1044                         rc = rc632_reg_write(handle,
1045                                              RC632_REG_BPSK_DEM_CONTROL,
1046                                              rx_configs[rate].bpsk_dem_ctrl);
1047                         if (rc < 0)
1048                                 return rc;
1049                 }
1050         } else {
1051                 /* Tx */
1052                 if (rate > ARRAY_SIZE(tx_configs))
1053                         return -EINVAL;
1054
1055                 rc = rc632_set_bit_mask(handle, RC632_REG_CODER_CONTROL,
1056                                         RC632_CDRCTRL_RATE_MASK,
1057                                         tx_configs[rate].rate);
1058                 if (rc < 0)
1059                         return rc;
1060
1061                 rc = rc632_reg_write(handle, RC632_REG_MOD_WIDTH,
1062                                      tx_configs[rate].mod_width);
1063                 if (rc < 0)
1064                         return rc;
1065         }
1066
1067         return 0;
1068 }
1069
1070 static int rc632_iso14443b_init(struct rfid_asic_handle *handle)
1071 {
1072         int ret;
1073
1074         // FIXME: some FIFO work
1075
1076         /* flush fifo (our way) */
1077         ret = rc632_reg_write(handle, RC632_REG_CONTROL,
1078                               RC632_CONTROL_FIFO_FLUSH);
1079         if (ret < 0)
1080                 return ret;
1081
1082         ret = rc632_reg_write(handle, RC632_REG_TX_CONTROL,
1083                         (RC632_TXCTRL_TX1_RF_EN |
1084                          RC632_TXCTRL_TX2_RF_EN |
1085                          RC632_TXCTRL_TX2_INV |
1086                          RC632_TXCTRL_MOD_SRC_INT));
1087         if (ret < 0)
1088                 return ret;
1089
1090         ret = rc632_reg_write(handle, RC632_REG_CW_CONDUCTANCE, 0x3f);
1091         if (ret < 0)
1092                 return ret;
1093
1094         ret = rc632_reg_write(handle, RC632_REG_MOD_CONDUCTANCE, 0x04);
1095         if (ret < 0)
1096                 return ret;
1097
1098         ret = rc632_reg_write(handle, RC632_REG_CODER_CONTROL,
1099                               (RC632_CDRCTRL_TXCD_NRZ |
1100                                RC632_CDRCTRL_RATE_14443B));
1101         if (ret < 0)
1102                 return ret;
1103
1104         ret = rc632_reg_write(handle, RC632_REG_MOD_WIDTH, 0x13);
1105         if (ret < 0)
1106                 return ret;
1107
1108         ret = rc632_reg_write(handle, RC632_REG_MOD_WIDTH_SOF, 0x3f);
1109         if (ret < 0)
1110                 return ret;
1111
1112         ret = rc632_reg_write(handle, RC632_REG_TYPE_B_FRAMING,
1113                               (RC632_TBFRAMING_SOF_11L_3H |
1114                                (6 << RC632_TBFRAMING_SPACE_SHIFT) |
1115                                RC632_TBFRAMING_EOF_11));
1116         if (ret < 0)
1117                 return ret;
1118
1119         ret = rc632_reg_write(handle, RC632_REG_RX_CONTROL1,
1120                               (RC632_RXCTRL1_GAIN_35DB |
1121                                RC632_RXCTRL1_ISO14443 |
1122                                RC632_RXCTRL1_SUBCP_8));
1123         if (ret < 0)
1124                 return ret;
1125
1126         ret = rc632_reg_write(handle, RC632_REG_DECODER_CONTROL,
1127                               (RC632_DECCTRL_BPSK |
1128                                RC632_DECCTRL_RXFR_14443B));
1129         if (ret < 0)
1130                 return ret;
1131
1132         ret = rc632_reg_write(handle, RC632_REG_BIT_PHASE,
1133                                 CM5121_14443B_BITPHASE);
1134         if (ret < 0)
1135                 return ret;
1136
1137         ret = rc632_reg_write(handle, RC632_REG_RX_THRESHOLD,
1138                                 CM5121_14443B_THRESHOLD);
1139         if (ret < 0)
1140                 return ret;
1141
1142         ret = rc632_reg_write(handle, RC632_REG_BPSK_DEM_CONTROL,
1143                               ((0x2 & RC632_BPSKD_TAUB_MASK)<<RC632_BPSKD_TAUB_SHIFT |
1144                                (0x3 & RC632_BPSKD_TAUD_MASK)<<RC632_BPSKD_TAUD_SHIFT |
1145                                RC632_BPSKD_FILTER_AMP_DETECT |
1146                                RC632_BPSKD_NO_RX_EOF |
1147                                RC632_BPSKD_NO_RX_EGT));
1148         if (ret < 0)
1149                 return ret;
1150
1151         ret = rc632_reg_write(handle, RC632_REG_RX_CONTROL2,
1152                               (RC632_RXCTRL2_AUTO_PD |
1153                                RC632_RXCTRL2_DECSRC_INT));
1154         if (ret < 0)
1155                 return ret;
1156
1157         ret = rc632_reg_write(handle, RC632_REG_RX_WAIT, 0x03);
1158         if (ret < 0)
1159                 return ret;
1160
1161         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
1162                               (RC632_CR_TX_CRC_ENABLE |
1163                                RC632_CR_RX_CRC_ENABLE |
1164                                RC632_CR_CRC3309));
1165         if (ret < 0)
1166                 return ret;
1167
1168         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_LSB, 0xff);
1169         if (ret < 0)
1170                 return ret;
1171
1172         ret = rc632_reg_write(handle, RC632_REG_CRC_PRESET_MSB, 0xff);
1173         if (ret < 0)
1174                 return ret;
1175
1176         return 0;
1177 }
1178
1179 static int
1180 rc632_iso15693_init(struct rfid_asic_handle *h)
1181 {
1182         int ret;
1183
1184         ret = rc632_reg_write(h, RC632_REG_TX_CONTROL,
1185                                                 (RC632_TXCTRL_MOD_SRC_INT |
1186                                                  RC632_TXCTRL_TX2_INV |
1187                                                  RC632_TXCTRL_TX2_RF_EN |
1188                                                  RC632_TXCTRL_TX1_RF_EN));
1189         if (ret < 0)
1190                 return ret;
1191
1192         ret = rc632_reg_write(h, RC632_REG_CW_CONDUCTANCE, 0x3f);
1193         if (ret < 0)
1194                 return ret;
1195
1196         ret = rc632_reg_write(h, RC632_REG_MOD_CONDUCTANCE, 0x03);
1197         if (ret < 0)
1198                 return ret;
1199
1200         ret = rc632_reg_write(h, RC632_REG_CODER_CONTROL,
1201                                                 (RC632_CDRCTRL_RATE_15693 |
1202                                                  0x03)); /* FIXME */
1203         if (ret < 0)
1204                 return ret;
1205
1206         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH, 0x3f);
1207         if (ret < 0)
1208                 return ret;
1209
1210         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH_SOF, 0x3f);
1211         if (ret < 0)
1212                 return ret;
1213
1214         ret = rc632_reg_write(h, RC632_REG_TYPE_B_FRAMING, 0x00);
1215         if (ret < 0)
1216                 return ret;
1217
1218         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL1,
1219                                                 (RC632_RXCTRL1_SUBCP_16 |
1220                                                  RC632_RXCTRL1_ISO15693 |
1221                                                  RC632_RXCTRL1_GAIN_35DB));
1222         if (ret < 0)
1223                 return ret;
1224
1225         ret = rc632_reg_write(h, RC632_REG_DECODER_CONTROL,
1226                                                 (RC632_DECCTRL_RXFR_15693 |
1227                                                  RC632_DECCTRL_RX_INVERT));
1228         if (ret < 0)
1229                 return ret;
1230
1231         ret = rc632_reg_write(h, RC632_REG_BIT_PHASE, 0xe0);
1232         if (ret < 0)
1233                 return ret;
1234
1235         ret = rc632_reg_write(h, RC632_REG_RX_THRESHOLD, 0xff);
1236         if (ret < 0)
1237                 return ret;
1238
1239         ret = rc632_reg_write(h, RC632_REG_BPSK_DEM_CONTROL, 0x00);
1240         if (ret < 0)
1241                 return ret;
1242
1243         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL2,
1244                                                 (RC632_RXCTRL2_AUTO_PD |
1245                                                  RC632_RXCTRL2_DECSRC_INT));
1246         if (ret < 0)
1247                 return ret;
1248
1249         ret = rc632_reg_write(h, RC632_REG_CHANNEL_REDUNDANCY,
1250                                                 (RC632_CR_CRC3309 |
1251                                                  RC632_CR_RX_CRC_ENABLE |
1252                                                  RC632_CR_TX_CRC_ENABLE));
1253         if (ret < 0)
1254                 return ret;
1255
1256         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_LSB, 0xff);
1257         if (ret < 0)
1258                 return ret;
1259
1260         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_MSB, 0xff);
1261         if (ret < 0)
1262                 return ret;
1263
1264         return 0;
1265 }
1266
1267 static int
1268 rc632_iso15693_icode_init(struct rfid_asic_handle *h)
1269 {
1270         int ret;
1271
1272         ret = rc632_reg_write(h, RC632_REG_TX_CONTROL,
1273                                                 (RC632_TXCTRL_MOD_SRC_INT |
1274                                                  RC632_TXCTRL_TX2_INV |
1275                                                  RC632_TXCTRL_TX2_RF_EN |
1276                                                  RC632_TXCTRL_TX1_RF_EN));
1277         if (ret < 0)
1278                 return ret;
1279
1280         ret = rc632_reg_write(h, RC632_REG_CW_CONDUCTANCE, 0x3f);
1281         if (ret < 0)
1282                 return ret;
1283
1284         ret = rc632_reg_write(h, RC632_REG_MOD_CONDUCTANCE, 0x02);
1285         if (ret < 0)
1286                 return ret;
1287
1288         ret = rc632_reg_write(h, RC632_REG_CODER_CONTROL, 0x2c);
1289         if (ret < 0)
1290                 return ret;
1291
1292         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH, 0x3f);
1293         if (ret < 0)
1294                 return ret;
1295
1296         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH_SOF, 0x3f);
1297         if (ret < 0)
1298                 return ret;
1299
1300         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH_SOF, 0x3f);
1301         if (ret < 0)
1302                 return ret;
1303
1304         ret = rc632_reg_write(h, RC632_REG_TYPE_B_FRAMING, 0x00);
1305         if (ret < 0)
1306                 return ret;
1307
1308         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL1, 0x8b); /* FIXME */
1309         if (ret < 0)
1310                 return ret;
1311
1312         ret = rc632_reg_write(h, RC632_REG_DECODER_CONTROL, 0x00);
1313         if (ret < 0)
1314                 return ret;
1315
1316         ret = rc632_reg_write(h, RC632_REG_BIT_PHASE, 0x52);
1317         if (ret < 0)
1318                 return ret;
1319
1320         ret = rc632_reg_write(h, RC632_REG_RX_THRESHOLD, 0x66);
1321         if (ret < 0)
1322                 return ret;
1323
1324         ret = rc632_reg_write(h, RC632_REG_BPSK_DEM_CONTROL, 0x00);
1325         if (ret < 0)
1326                 return ret;
1327
1328         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL2,
1329                                                 RC632_RXCTRL2_DECSRC_INT);
1330         if (ret < 0)
1331                 return ret;
1332
1333         ret = rc632_reg_write(h, RC632_REG_CHANNEL_REDUNDANCY,
1334                                                 (RC632_CR_RX_CRC_ENABLE |
1335                                                  RC632_CR_TX_CRC_ENABLE));
1336         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_LSB, 0xfe);
1337         if (ret < 0)
1338                 return ret;
1339
1340         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_MSB, 0xff);
1341         if (ret < 0)
1342                 return ret;
1343
1344         return 0;
1345 }
1346
1347 static int
1348 rc632_iso15693_icl_init(struct rfid_asic_handle *h)
1349 {
1350         int ret;
1351
1352         /* ICL */
1353
1354         ret = rc632_reg_write(h, RC632_REG_TX_CONTROL,
1355                                                 (RC632_TXCTRL_MOD_SRC_INT |
1356                                                  RC632_TXCTRL_TX2_INV |
1357                                                  RC632_TXCTRL_TX2_RF_EN |
1358                                                  RC632_TXCTRL_TX1_RF_EN));
1359         if (ret < 0)
1360                 return ret;
1361
1362         ret = rc632_reg_write(h, RC632_REG_CW_CONDUCTANCE, 0x3f);
1363         if (ret < 0)
1364                 return ret;
1365
1366         ret = rc632_reg_write(h, RC632_REG_MOD_CONDUCTANCE, 0x11);
1367         if (ret < 0)
1368                 return ret;
1369
1370         ret = rc632_reg_write(h, RC632_REG_CODER_CONTROL,
1371                                                 (RC632_CDRCTRL_RATE_15693 |
1372                                                  RC632_CDRCTRL_TXCD_ICODE_STD |
1373                                                  0x03)); /* FIXME */
1374         if (ret < 0)
1375                 return ret;
1376
1377         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH, 0x3f);
1378         if (ret < 0)
1379                 return ret;
1380
1381         ret = rc632_reg_write(h, RC632_REG_MOD_WIDTH_SOF, 0x3f);
1382         if (ret < 0)
1383                 return ret;
1384         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL1,
1385                                                 (RC632_RXCTRL1_SUBCP_16|
1386                                                  RC632_RXCTRL1_ISO15693|
1387                                                  RC632_RXCTRL1_GAIN_35DB));
1388         if (ret < 0)
1389                 return ret;
1390         ret = rc632_reg_write(h, RC632_REG_DECODER_CONTROL,
1391                                                 (RC632_DECCTRL_RX_INVERT|
1392                                                  RC632_DECCTRL_RXFR_15693));
1393         if (ret < 0)
1394                 return ret;
1395
1396         ret = rc632_reg_write(h, RC632_REG_BIT_PHASE, 0xbd);
1397         if (ret < 0)
1398                 return ret;
1399
1400         ret = rc632_reg_write(h, RC632_REG_RX_THRESHOLD, 0xff);
1401         if (ret < 0)
1402                 return ret;
1403
1404         ret = rc632_reg_write(h, RC632_REG_BPSK_DEM_CONTROL, 0x00);
1405         if (ret < 0)
1406                 return ret;
1407
1408         ret = rc632_reg_write(h, RC632_REG_RX_CONTROL2,
1409                                                 RC632_RXCTRL2_DECSRC_INT);
1410         if (ret < 0)
1411                 return ret;
1412
1413         ret = rc632_reg_write(h, RC632_REG_CHANNEL_REDUNDANCY, 0x00);
1414         if (ret < 0)
1415                 return ret;
1416
1417         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_LSB, 0x12);
1418         if (ret < 0)
1419                 return ret;
1420
1421         ret = rc632_reg_write(h, RC632_REG_CRC_PRESET_MSB, 0xe0);
1422         if (ret < 0)
1423                 return ret;
1424
1425         return 0;
1426 }
1427
1428 struct mifare_authcmd {
1429         u_int8_t auth_cmd;
1430         u_int8_t block_address;
1431         u_int32_t serno;        /* lsb 1 2 msb */
1432 } __attribute__ ((packed));
1433
1434
1435 #define RFID_MIFARE_KEY_LEN 6
1436 #define RFID_MIFARE_KEY_CODED_LEN 12
1437
1438 /* Transform crypto1 key from generic 6byte into rc632 specific 12byte */
1439 static int
1440 rc632_mifare_transform_key(const u_int8_t *key6, u_int8_t *key12)
1441 {
1442         int i;
1443         u_int8_t ln;
1444         u_int8_t hn;
1445
1446         for (i = 0; i < RFID_MIFARE_KEY_LEN; i++) {
1447                 ln = key6[i] & 0x0f;
1448                 hn = key6[i] >> 4;
1449                 key12[i * 2 + 1] = (~ln << 4) | ln;
1450                 key12[i * 2] = (~hn << 4) | hn;
1451         }
1452         return 0;
1453 }
1454
1455 static int
1456 rc632_mifare_set_key(struct rfid_asic_handle *h, const u_int8_t *key)
1457 {
1458         u_int8_t coded_key[RFID_MIFARE_KEY_CODED_LEN];
1459         u_int8_t reg;
1460         int ret;
1461
1462         ret = rc632_mifare_transform_key(key, coded_key);
1463         if (ret < 0)
1464                 return ret;
1465
1466         /* Terminate probably running command */
1467         ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_IDLE);
1468         if (ret < 0)
1469                 return ret;
1470
1471         ret = rc632_fifo_write(h, RFID_MIFARE_KEY_CODED_LEN, coded_key, 0x03);
1472         if (ret < 0)
1473                 return ret;
1474
1475         ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_LOAD_KEY);
1476         if (ret < 0)
1477                 return ret;
1478
1479         ret = rc632_wait_idle(h, RC632_TMO_AUTH1);
1480         if (ret < 0)
1481                 return ret;
1482
1483         ret = rc632_reg_read(h, RC632_REG_ERROR_FLAG, &reg);
1484         if (ret < 0)
1485                 return ret;
1486
1487         if (reg & RC632_ERR_FLAG_KEY_ERR)
1488                 return -EINVAL;
1489
1490         return 0;
1491 }
1492
1493 static int
1494 rc632_mifare_auth(struct rfid_asic_handle *h, u_int8_t cmd, u_int32_t serno,
1495                   u_int8_t block)
1496 {
1497         int ret;
1498         struct mifare_authcmd acmd;
1499         u_int8_t reg;
1500
1501         if (cmd != RFID_CMD_MIFARE_AUTH1A && cmd != RFID_CMD_MIFARE_AUTH1B) {
1502                 DEBUGP("invalid auth command\n");
1503                 return -EINVAL;
1504         }
1505
1506         /* Initialize acmd */
1507         acmd.block_address = block & 0xff;
1508         acmd.auth_cmd = cmd;
1509         //acmd.serno = htonl(serno);
1510         acmd.serno = serno;
1511
1512 #if 1
1513         /* Clear Rx CRC */
1514         ret = rc632_clear_bits(h, RC632_REG_CHANNEL_REDUNDANCY,
1515                                 RC632_CR_RX_CRC_ENABLE);
1516 #else
1517         /* Clear Rx CRC, Set Tx CRC and Odd Parity */
1518         ret = rc632_reg_write(h, RC632_REG_CHANNEL_REDUNDANCY,
1519                                 RC632_CR_TX_CRC_ENABLE | RC632_CR_PARITY_ODD |
1520                                 RC632_CR_PARITY_ENABLE);
1521 #endif
1522         if (ret < 0)
1523                 return ret;
1524
1525         /* Send Authent1 Command */
1526         ret = rc632_fifo_write(h, sizeof(acmd), (unsigned char *)&acmd, 0x03);
1527         if (ret < 0)
1528                 return ret;
1529
1530         ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_AUTHENT1);
1531         if (ret < 0) {
1532                 DEBUGP("error during AUTHENT1");
1533                 return ret;
1534         }
1535
1536         /* Wait until transmitter is idle */
1537         ret = rc632_wait_idle(h, RC632_TMO_AUTH1);
1538         if (ret < 0)
1539                 return ret;
1540
1541         ret = rc632_reg_read(h, RC632_REG_SECONDARY_STATUS, &reg);
1542         if (ret < 0)
1543                 return ret;
1544         if (reg & 0x07) {
1545                 DEBUGP("bitframe?");
1546                 return -EIO;
1547         }
1548
1549         /* Clear Tx CRC */
1550         ret = rc632_clear_bits(h, RC632_REG_CHANNEL_REDUNDANCY,
1551                                 RC632_CR_TX_CRC_ENABLE);
1552         if (ret < 0)
1553                 return ret;
1554
1555         /* Send Authent2 Command */
1556         ret = rc632_reg_write(h, RC632_REG_COMMAND, RC632_CMD_AUTHENT2);
1557         if (ret < 0)
1558                 return ret;
1559
1560         /* Wait until transmitter is idle */
1561         ret = rc632_wait_idle(h, RC632_TMO_AUTH1);
1562         if (ret < 0)
1563                 return ret;
1564
1565         /* Check whether authentication was successful */
1566         ret = rc632_reg_read(h, RC632_REG_CONTROL, &reg);
1567         if (ret < 0)
1568                 return ret;
1569
1570         if (!(reg & RC632_CONTROL_CRYPTO1_ON)) {
1571                 DEBUGP("authentication not successful");
1572                 return -EACCES;
1573         }
1574
1575         return 0;
1576 }
1577
1578 /* transceive regular frame */
1579 static int
1580 rc632_mifare_transceive(struct rfid_asic_handle *handle,
1581                         const u_int8_t *tx_buf, unsigned int tx_len,
1582                         u_int8_t *rx_buf, unsigned int *rx_len,
1583                         u_int64_t timeout, unsigned int flags)
1584 {
1585         int ret;
1586         u_int8_t rxl = *rx_len & 0xff;
1587
1588         DEBUGP("entered\n");
1589         memset(rx_buf, 0, *rx_len);
1590
1591 #if 1
1592         ret = rc632_reg_write(handle, RC632_REG_CHANNEL_REDUNDANCY,
1593                                 (RC632_CR_PARITY_ENABLE |
1594                                  RC632_CR_PARITY_ODD |
1595                                  RC632_CR_TX_CRC_ENABLE |
1596                                  RC632_CR_RX_CRC_ENABLE));
1597 #else
1598         ret = rc632_clear_bits(handle, RC632_REG_CHANNEL_REDUNDANCY,
1599                                 RC632_CR_RX_CRC_ENABLE|RC632_CR_TX_CRC_ENABLE);
1600 #endif
1601         if (ret < 0)
1602                 return ret;
1603
1604         ret = rc632_transceive(handle, tx_buf, tx_len, rx_buf, &rxl, 0x32, 0);
1605         *rx_len = rxl;
1606         if (ret < 0)
1607                 return ret;
1608
1609
1610         return 0;
1611 }
1612
1613 const struct rfid_asic rc632 = {
1614         .name   = "Philips CL RC632",
1615         .fc     = ISO14443_FREQ_CARRIER,
1616         .priv.rc632 = {
1617                 .fn = {
1618                         .power_up = &rc632_power_up,
1619                         .power_down = &rc632_power_down,
1620                         .turn_on_rf = &rc632_turn_on_rf,
1621                         .turn_off_rf = &rc632_turn_off_rf,
1622                         .transceive = &rc632_iso14443ab_transceive,
1623                         .iso14443a = {
1624                                 .init = &rc632_iso14443a_init,
1625                                 .transceive_sf = &rc632_iso14443a_transceive_sf,
1626                                 .transceive_acf = &rc632_iso14443a_transceive_acf,
1627                                 .set_speed = &rc632_iso14443a_set_speed,
1628                         },
1629                         .iso14443b = {
1630                                 .init = &rc632_iso14443b_init,
1631                         },
1632                         .iso15693 = {
1633                                 .init = &rc632_iso15693_init,
1634                         },
1635                         .mifare_classic = {
1636                                 .setkey = &rc632_mifare_set_key,
1637                                 .auth = &rc632_mifare_auth,
1638                         },
1639                 },
1640         },
1641 };