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