drivers/nfc/pn533.c

   1 /*
   2  * Copyright (C) 2011 Instituto Nokia de Tecnologia
   3  *
   4  * Authors:
   5  *    Lauro Ramos Venancio <lauro.venancio@openbossa.org>
   6  *    Aloisio Almeida Jr <aloisio.almeida@openbossa.org>
   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 as published by
  10  * the Free Software Foundation; either version 2 of the License, or
  11  * (at your option) any later version.
  12  *
  13  * This program is distributed in the hope that it will be useful,
  14  * but WITHOUT ANY WARRANTY; without even the implied warranty of
  15  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  16  * GNU General Public License for more details.
  17  *
  18  * You should have received a copy of the GNU General Public License
  19  * along with this program; if not, write to the
  20  * Free Software Foundation, Inc.,
  21  * 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA.
  22  */
  23
  24 #include <linux/device.h>
  25 #include <linux/kernel.h>
  26 #include <linux/module.h>
  27 #include <linux/slab.h>
  28 #include <linux/usb.h>
  29 #include <linux/nfc.h>
  30 #include <linux/netdevice.h>
  31 #include <net/nfc/nfc.h>
  32
  33 #define VERSION "0.1"
  34
  35 #define PN533_VENDOR_ID 0x4CC
  36 #define PN533_PRODUCT_ID 0x2533
  37
  38 #define SCM_VENDOR_ID 0x4E6
  39 #define SCL3711_PRODUCT_ID 0x5591
  40
  41 #define SONY_VENDOR_ID         0x054c
  42 #define PASORI_PRODUCT_ID      0x02e1
  43
  44 #define PN533_QUIRKS_TYPE_A          BIT(0)
  45 #define PN533_QUIRKS_TYPE_F          BIT(1)
  46 #define PN533_QUIRKS_DEP             BIT(2)
  47 #define PN533_QUIRKS_RAW_EXCHANGE    BIT(3)
  48
  49 #define PN533_DEVICE_STD    0x1
  50 #define PN533_DEVICE_PASORI 0x2
  51
  52 #define PN533_ALL_PROTOCOLS (NFC_PROTO_JEWEL_MASK | NFC_PROTO_MIFARE_MASK |\
  53                              NFC_PROTO_FELICA_MASK | NFC_PROTO_ISO14443_MASK |\
  54                              NFC_PROTO_NFC_DEP_MASK |\
  55                              NFC_PROTO_ISO14443_B_MASK)
  56
  57 #define PN533_NO_TYPE_B_PROTOCOLS (NFC_PROTO_JEWEL_MASK | \
  58                                    NFC_PROTO_MIFARE_MASK | \
  59                                    NFC_PROTO_FELICA_MASK | \
  60                                    NFC_PROTO_ISO14443_MASK | \
  61                                    NFC_PROTO_NFC_DEP_MASK)
  62
  63 static const struct usb_device_id pn533_table[] = {
  64         { .match_flags          = USB_DEVICE_ID_MATCH_DEVICE,
  65           .idVendor             = PN533_VENDOR_ID,
  66           .idProduct            = PN533_PRODUCT_ID,
  67           .driver_info          = PN533_DEVICE_STD,
  68         },
  69         { .match_flags          = USB_DEVICE_ID_MATCH_DEVICE,
  70           .idVendor             = SCM_VENDOR_ID,
  71           .idProduct            = SCL3711_PRODUCT_ID,
  72           .driver_info          = PN533_DEVICE_STD,
  73         },
  74         { .match_flags          = USB_DEVICE_ID_MATCH_DEVICE,
  75           .idVendor             = SONY_VENDOR_ID,
  76           .idProduct            = PASORI_PRODUCT_ID,
  77           .driver_info          = PN533_DEVICE_PASORI,
  78         },
  79         { }
  80 };
  81 MODULE_DEVICE_TABLE(usb, pn533_table);
  82
  83 /* How much time we spend listening for initiators */
  84 #define PN533_LISTEN_TIME 2
  85
  86 /* frame definitions */
  87 #define PN533_FRAME_TAIL_SIZE 2
  88 #define PN533_FRAME_SIZE(f) (sizeof(struct pn533_frame) + f->datalen + \
  89                                 PN533_FRAME_TAIL_SIZE)
  90 #define PN533_FRAME_ACK_SIZE (sizeof(struct pn533_frame) + 1)
  91 #define PN533_FRAME_CHECKSUM(f) (f->data[f->datalen])
  92 #define PN533_FRAME_POSTAMBLE(f) (f->data[f->datalen + 1])
  93
  94 /* start of frame */
  95 #define PN533_SOF 0x00FF
  96
  97 /* frame identifier: in/out/error */
  98 #define PN533_FRAME_IDENTIFIER(f) (f->data[0])
  99 #define PN533_DIR_OUT 0xD4
 100 #define PN533_DIR_IN 0xD5
 101
 102 /* PN533 Commands */
 103 #define PN533_FRAME_CMD(f) (f->data[1])
 104 #define PN533_FRAME_CMD_PARAMS_PTR(f) (&f->data[2])
 105 #define PN533_FRAME_CMD_PARAMS_LEN(f) (f->datalen - 2)
 106
 107 #define PN533_CMD_GET_FIRMWARE_VERSION 0x02
 108 #define PN533_CMD_RF_CONFIGURATION 0x32
 109 #define PN533_CMD_IN_DATA_EXCHANGE 0x40
 110 #define PN533_CMD_IN_COMM_THRU     0x42
 111 #define PN533_CMD_IN_LIST_PASSIVE_TARGET 0x4A
 112 #define PN533_CMD_IN_ATR 0x50
 113 #define PN533_CMD_IN_RELEASE 0x52
 114 #define PN533_CMD_IN_JUMP_FOR_DEP 0x56
 115
 116 #define PN533_CMD_TG_INIT_AS_TARGET 0x8c
 117 #define PN533_CMD_TG_GET_DATA 0x86
 118 #define PN533_CMD_TG_SET_DATA 0x8e
 119
 120 #define PN533_CMD_RESPONSE(cmd) (cmd + 1)
 121
 122 /* PN533 Return codes */
 123 #define PN533_CMD_RET_MASK 0x3F
 124 #define PN533_CMD_MI_MASK 0x40
 125 #define PN533_CMD_RET_SUCCESS 0x00
 126
 127 /* PN533 status codes */
 128 #define PN533_STATUS_TARGET_RELEASED 0x29
 129
 130 struct pn533;
 131
 132 typedef int (*pn533_cmd_complete_t) (struct pn533 *dev, void *arg,
 133                                         u8 *params, int params_len);
 134
 135 /* structs for pn533 commands */
 136
 137 /* PN533_CMD_GET_FIRMWARE_VERSION */
 138 struct pn533_fw_version {
 139         u8 ic;
 140         u8 ver;
 141         u8 rev;
 142         u8 support;
 143 };
 144
 145 /* PN533_CMD_RF_CONFIGURATION */
 146 #define PN533_CFGITEM_TIMING 0x02
 147 #define PN533_CFGITEM_MAX_RETRIES 0x05
 148 #define PN533_CFGITEM_PASORI 0x82
 149
 150 #define PN533_CONFIG_TIMING_102 0xb
 151 #define PN533_CONFIG_TIMING_204 0xc
 152 #define PN533_CONFIG_TIMING_409 0xd
 153 #define PN533_CONFIG_TIMING_819 0xe
 154
 155 #define PN533_CONFIG_MAX_RETRIES_NO_RETRY 0x00
 156 #define PN533_CONFIG_MAX_RETRIES_ENDLESS 0xFF
 157
 158 struct pn533_config_max_retries {
 159         u8 mx_rty_atr;
 160         u8 mx_rty_psl;
 161         u8 mx_rty_passive_act;
 162 } __packed;
 163
 164 struct pn533_config_timing {
 165         u8 rfu;
 166         u8 atr_res_timeout;
 167         u8 dep_timeout;
 168 } __packed;
 169
 170 /* PN533_CMD_IN_LIST_PASSIVE_TARGET */
 171
 172 /* felica commands opcode */
 173 #define PN533_FELICA_OPC_SENSF_REQ 0
 174 #define PN533_FELICA_OPC_SENSF_RES 1
 175 /* felica SENSF_REQ parameters */
 176 #define PN533_FELICA_SENSF_SC_ALL 0xFFFF
 177 #define PN533_FELICA_SENSF_RC_NO_SYSTEM_CODE 0
 178 #define PN533_FELICA_SENSF_RC_SYSTEM_CODE 1
 179 #define PN533_FELICA_SENSF_RC_ADVANCED_PROTOCOL 2
 180
 181 /* type B initiator_data values */
 182 #define PN533_TYPE_B_AFI_ALL_FAMILIES 0
 183 #define PN533_TYPE_B_POLL_METHOD_TIMESLOT 0
 184 #define PN533_TYPE_B_POLL_METHOD_PROBABILISTIC 1
 185
 186 union pn533_cmd_poll_initdata {
 187         struct {
 188                 u8 afi;
 189                 u8 polling_method;
 190         } __packed type_b;
 191         struct {
 192                 u8 opcode;
 193                 __be16 sc;
 194                 u8 rc;
 195                 u8 tsn;
 196         } __packed felica;
 197 };
 198
 199 /* Poll modulations */
 200 enum {
 201         PN533_POLL_MOD_106KBPS_A,
 202         PN533_POLL_MOD_212KBPS_FELICA,
 203         PN533_POLL_MOD_424KBPS_FELICA,
 204         PN533_POLL_MOD_106KBPS_JEWEL,
 205         PN533_POLL_MOD_847KBPS_B,
 206         PN533_LISTEN_MOD,
 207
 208         __PN533_POLL_MOD_AFTER_LAST,
 209 };
 210 #define PN533_POLL_MOD_MAX (__PN533_POLL_MOD_AFTER_LAST - 1)
 211
 212 struct pn533_poll_modulations {
 213         struct {
 214                 u8 maxtg;
 215                 u8 brty;
 216                 union pn533_cmd_poll_initdata initiator_data;
 217         } __packed data;
 218         u8 len;
 219 };
 220
 221 const struct pn533_poll_modulations poll_mod[] = {
 222         [PN533_POLL_MOD_106KBPS_A] = {
 223                 .data = {
 224                         .maxtg = 1,
 225                         .brty = 0,
 226                 },
 227                 .len = 2,
 228         },
 229         [PN533_POLL_MOD_212KBPS_FELICA] = {
 230                 .data = {
 231                         .maxtg = 1,
 232                         .brty = 1,
 233                         .initiator_data.felica = {
 234                                 .opcode = PN533_FELICA_OPC_SENSF_REQ,
 235                                 .sc = PN533_FELICA_SENSF_SC_ALL,
 236                                 .rc = PN533_FELICA_SENSF_RC_NO_SYSTEM_CODE,
 237                                 .tsn = 0,
 238                         },
 239                 },
 240                 .len = 7,
 241         },
 242         [PN533_POLL_MOD_424KBPS_FELICA] = {
 243                 .data = {
 244                         .maxtg = 1,
 245                         .brty = 2,
 246                         .initiator_data.felica = {
 247                                 .opcode = PN533_FELICA_OPC_SENSF_REQ,
 248                                 .sc = PN533_FELICA_SENSF_SC_ALL,
 249                                 .rc = PN533_FELICA_SENSF_RC_NO_SYSTEM_CODE,
 250                                 .tsn = 0,
 251                         },
 252                  },
 253                 .len = 7,
 254         },
 255         [PN533_POLL_MOD_106KBPS_JEWEL] = {
 256                 .data = {
 257                         .maxtg = 1,
 258                         .brty = 4,
 259                 },
 260                 .len = 2,
 261         },
 262         [PN533_POLL_MOD_847KBPS_B] = {
 263                 .data = {
 264                         .maxtg = 1,
 265                         .brty = 8,
 266                         .initiator_data.type_b = {
 267                                 .afi = PN533_TYPE_B_AFI_ALL_FAMILIES,
 268                                 .polling_method =
 269                                         PN533_TYPE_B_POLL_METHOD_TIMESLOT,
 270                         },
 271                 },
 272                 .len = 3,
 273         },
 274         [PN533_LISTEN_MOD] = {
 275                 .len = 0,
 276         },
 277 };
 278
 279 /* PN533_CMD_IN_ATR */
 280
 281 struct pn533_cmd_activate_param {
 282         u8 tg;
 283         u8 next;
 284 } __packed;
 285
 286 struct pn533_cmd_activate_response {
 287         u8 status;
 288         u8 nfcid3t[10];
 289         u8 didt;
 290         u8 bst;
 291         u8 brt;
 292         u8 to;
 293         u8 ppt;
 294         /* optional */
 295         u8 gt[];
 296 } __packed;
 297
 298 /* PN533_CMD_IN_JUMP_FOR_DEP */
 299 struct pn533_cmd_jump_dep {
 300         u8 active;
 301         u8 baud;
 302         u8 next;
 303         u8 data[];
 304 } __packed;
 305
 306 struct pn533_cmd_jump_dep_response {
 307         u8 status;
 308         u8 tg;
 309         u8 nfcid3t[10];
 310         u8 didt;
 311         u8 bst;
 312         u8 brt;
 313         u8 to;
 314         u8 ppt;
 315         /* optional */
 316         u8 gt[];
 317 } __packed;
 318
 319
 320 /* PN533_TG_INIT_AS_TARGET */
 321 #define PN533_INIT_TARGET_PASSIVE 0x1
 322 #define PN533_INIT_TARGET_DEP 0x2
 323
 324 #define PN533_INIT_TARGET_RESP_FRAME_MASK 0x3
 325 #define PN533_INIT_TARGET_RESP_ACTIVE     0x1
 326 #define PN533_INIT_TARGET_RESP_DEP        0x4
 327
 328 struct pn533_cmd_init_target {
 329         u8 mode;
 330         u8 mifare[6];
 331         u8 felica[18];
 332         u8 nfcid3[10];
 333         u8 gb_len;
 334         u8 gb[];
 335 } __packed;
 336
 337 struct pn533_cmd_init_target_response {
 338         u8 mode;
 339         u8 cmd[];
 340 } __packed;
 341
 342 struct pn533 {
 343         struct usb_device *udev;
 344         struct usb_interface *interface;
 345         struct nfc_dev *nfc_dev;
 346
 347         struct urb *out_urb;
 348         int out_maxlen;
 349         struct pn533_frame *out_frame;
 350
 351         struct urb *in_urb;
 352         int in_maxlen;
 353         struct pn533_frame *in_frame;
 354
 355         struct sk_buff_head resp_q;
 356
 357         struct workqueue_struct *wq;
 358         struct work_struct cmd_work;
 359         struct work_struct cmd_complete_work;
 360         struct work_struct poll_work;
 361         struct work_struct mi_work;
 362         struct work_struct tg_work;
 363         struct timer_list listen_timer;
 364         struct pn533_frame *wq_in_frame;
 365         int wq_in_error;
 366         int cancel_listen;
 367
 368         pn533_cmd_complete_t cmd_complete;
 369         void *cmd_complete_arg;
 370         struct mutex cmd_lock;
 371         u8 cmd;
 372
 373         struct pn533_poll_modulations *poll_mod_active[PN533_POLL_MOD_MAX + 1];
 374         u8 poll_mod_count;
 375         u8 poll_mod_curr;
 376         u32 poll_protocols;
 377         u32 listen_protocols;
 378
 379         u8 *gb;
 380         size_t gb_len;
 381
 382         u8 tgt_available_prots;
 383         u8 tgt_active_prot;
 384         u8 tgt_mode;
 385
 386         u32 device_type;
 387
 388         struct list_head cmd_queue;
 389         u8 cmd_pending;
 390 };
 391
 392 struct pn533_cmd {
 393         struct list_head queue;
 394         struct pn533_frame *out_frame;
 395         struct pn533_frame *in_frame;
 396         int in_frame_len;
 397         pn533_cmd_complete_t cmd_complete;
 398         void *arg;
 399         gfp_t flags;
 400 };
 401
 402 struct pn533_frame {
 403         u8 preamble;
 404         __be16 start_frame;
 405         u8 datalen;
 406         u8 datalen_checksum;
 407         u8 data[];
 408 } __packed;
 409
 410 /* The rule: value + checksum = 0 */
 411 static inline u8 pn533_checksum(u8 value)
 412 {
 413         return ~value + 1;
 414 }
 415
 416 /* The rule: sum(data elements) + checksum = 0 */
 417 static u8 pn533_data_checksum(u8 *data, int datalen)
 418 {
 419         u8 sum = 0;
 420         int i;
 421
 422         for (i = 0; i < datalen; i++)
 423                 sum += data[i];
 424
 425         return pn533_checksum(sum);
 426 }
 427
 428 /**
 429  * pn533_tx_frame_ack - create a ack frame
 430  * @frame:      The frame to be set as ack
 431  *
 432  * Ack is different type of standard frame. As a standard frame, it has
 433  * preamble and start_frame. However the checksum of this frame must fail,
 434  * i.e. datalen + datalen_checksum must NOT be zero. When the checksum test
 435  * fails and datalen = 0 and datalen_checksum = 0xFF, the frame is a ack.
 436  * After datalen_checksum field, the postamble is placed.
 437  */
 438 static void pn533_tx_frame_ack(struct pn533_frame *frame)
 439 {
 440         frame->preamble = 0;
 441         frame->start_frame = cpu_to_be16(PN533_SOF);
 442         frame->datalen = 0;
 443         frame->datalen_checksum = 0xFF;
 444         /* data[0] is used as postamble */
 445         frame->data[0] = 0;
 446 }
 447
 448 static void pn533_tx_frame_init(struct pn533_frame *frame, u8 cmd)
 449 {
 450         frame->preamble = 0;
 451         frame->start_frame = cpu_to_be16(PN533_SOF);
 452         PN533_FRAME_IDENTIFIER(frame) = PN533_DIR_OUT;
 453         PN533_FRAME_CMD(frame) = cmd;
 454         frame->datalen = 2;
 455 }
 456
 457 static void pn533_tx_frame_finish(struct pn533_frame *frame)
 458 {
 459         frame->datalen_checksum = pn533_checksum(frame->datalen);
 460
 461         PN533_FRAME_CHECKSUM(frame) =
 462                 pn533_data_checksum(frame->data, frame->datalen);
 463
 464         PN533_FRAME_POSTAMBLE(frame) = 0;
 465 }
 466
 467 static bool pn533_rx_frame_is_valid(struct pn533_frame *frame)
 468 {
 469         u8 checksum;
 470
 471         if (frame->start_frame != cpu_to_be16(PN533_SOF))
 472                 return false;
 473
 474         checksum = pn533_checksum(frame->datalen);
 475         if (checksum != frame->datalen_checksum)
 476                 return false;
 477
 478         checksum = pn533_data_checksum(frame->data, frame->datalen);
 479         if (checksum != PN533_FRAME_CHECKSUM(frame))
 480                 return false;
 481
 482         return true;
 483 }
 484
 485 static bool pn533_rx_frame_is_ack(struct pn533_frame *frame)
 486 {
 487         if (frame->start_frame != cpu_to_be16(PN533_SOF))
 488                 return false;
 489
 490         if (frame->datalen != 0 || frame->datalen_checksum != 0xFF)
 491                 return false;
 492
 493         return true;
 494 }
 495
 496 static bool pn533_rx_frame_is_cmd_response(struct pn533_frame *frame, u8 cmd)
 497 {
 498         return (PN533_FRAME_CMD(frame) == PN533_CMD_RESPONSE(cmd));
 499 }
 500
 501
 502 static void pn533_wq_cmd_complete(struct work_struct *work)
 503 {
 504         struct pn533 *dev = container_of(work, struct pn533, cmd_complete_work);
 505         struct pn533_frame *in_frame;
 506         int rc;
 507
 508         in_frame = dev->wq_in_frame;
 509
 510         if (dev->wq_in_error)
 511                 rc = dev->cmd_complete(dev, dev->cmd_complete_arg, NULL,
 512                                                         dev->wq_in_error);
 513         else
 514                 rc = dev->cmd_complete(dev, dev->cmd_complete_arg,
 515                                         PN533_FRAME_CMD_PARAMS_PTR(in_frame),
 516                                         PN533_FRAME_CMD_PARAMS_LEN(in_frame));
 517
 518         if (rc != -EINPROGRESS)
 519                 queue_work(dev->wq, &dev->cmd_work);
 520 }
 521
 522 static void pn533_recv_response(struct urb *urb)
 523 {
 524         struct pn533 *dev = urb->context;
 525         struct pn533_frame *in_frame;
 526
 527         dev->wq_in_frame = NULL;
 528
 529         switch (urb->status) {
 530         case 0:
 531                 /* success */
 532                 break;
 533         case -ECONNRESET:
 534         case -ENOENT:
 535         case -ESHUTDOWN:
 536                 nfc_dev_dbg(&dev->interface->dev, "Urb shutting down with"
 537                                                 " status: %d", urb->status);
 538                 dev->wq_in_error = urb->status;
 539                 goto sched_wq;
 540         default:
 541                 nfc_dev_err(&dev->interface->dev, "Nonzero urb status received:"
 542                                                         " %d", urb->status);
 543                 dev->wq_in_error = urb->status;
 544                 goto sched_wq;
 545         }
 546
 547         in_frame = dev->in_urb->transfer_buffer;
 548
 549         if (!pn533_rx_frame_is_valid(in_frame)) {
 550                 nfc_dev_err(&dev->interface->dev, "Received an invalid frame");
 551                 dev->wq_in_error = -EIO;
 552                 goto sched_wq;
 553         }
 554
 555         if (!pn533_rx_frame_is_cmd_response(in_frame, dev->cmd)) {
 556                 nfc_dev_err(&dev->interface->dev, "The received frame is not "
 557                                                 "response to the last command");
 558                 dev->wq_in_error = -EIO;
 559                 goto sched_wq;
 560         }
 561
 562         nfc_dev_dbg(&dev->interface->dev, "Received a valid frame");
 563         dev->wq_in_error = 0;
 564         dev->wq_in_frame = in_frame;
 565
 566 sched_wq:
 567         queue_work(dev->wq, &dev->cmd_complete_work);
 568 }
 569
 570 static int pn533_submit_urb_for_response(struct pn533 *dev, gfp_t flags)
 571 {
 572         dev->in_urb->complete = pn533_recv_response;
 573
 574         return usb_submit_urb(dev->in_urb, flags);
 575 }
 576
 577 static void pn533_recv_ack(struct urb *urb)
 578 {
 579         struct pn533 *dev = urb->context;
 580         struct pn533_frame *in_frame;
 581         int rc;
 582
 583         switch (urb->status) {
 584         case 0:
 585                 /* success */
 586                 break;
 587         case -ECONNRESET:
 588         case -ENOENT:
 589         case -ESHUTDOWN:
 590                 nfc_dev_dbg(&dev->interface->dev, "Urb shutting down with"
 591                                                 " status: %d", urb->status);
 592                 dev->wq_in_error = urb->status;
 593                 goto sched_wq;
 594         default:
 595                 nfc_dev_err(&dev->interface->dev, "Nonzero urb status received:"
 596                                                         " %d", urb->status);
 597                 dev->wq_in_error = urb->status;
 598                 goto sched_wq;
 599         }
 600
 601         in_frame = dev->in_urb->transfer_buffer;
 602
 603         if (!pn533_rx_frame_is_ack(in_frame)) {
 604                 nfc_dev_err(&dev->interface->dev, "Received an invalid ack");
 605                 dev->wq_in_error = -EIO;
 606                 goto sched_wq;
 607         }
 608
 609         nfc_dev_dbg(&dev->interface->dev, "Received a valid ack");
 610
 611         rc = pn533_submit_urb_for_response(dev, GFP_ATOMIC);
 612         if (rc) {
 613                 nfc_dev_err(&dev->interface->dev, "usb_submit_urb failed with"
 614                                                         " result %d", rc);
 615                 dev->wq_in_error = rc;
 616                 goto sched_wq;
 617         }
 618
 619         return;
 620
 621 sched_wq:
 622         dev->wq_in_frame = NULL;
 623         queue_work(dev->wq, &dev->cmd_complete_work);
 624 }
 625
 626 static int pn533_submit_urb_for_ack(struct pn533 *dev, gfp_t flags)
 627 {
 628         dev->in_urb->complete = pn533_recv_ack;
 629
 630         return usb_submit_urb(dev->in_urb, flags);
 631 }
 632
 633 static int pn533_send_ack(struct pn533 *dev, gfp_t flags)
 634 {
 635         int rc;
 636
 637         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
 638
 639         pn533_tx_frame_ack(dev->out_frame);
 640
 641         dev->out_urb->transfer_buffer = dev->out_frame;
 642         dev->out_urb->transfer_buffer_length = PN533_FRAME_ACK_SIZE;
 643         rc = usb_submit_urb(dev->out_urb, flags);
 644
 645         return rc;
 646 }
 647
 648 static int __pn533_send_cmd_frame_async(struct pn533 *dev,
 649                                         struct pn533_frame *out_frame,
 650                                         struct pn533_frame *in_frame,
 651                                         int in_frame_len,
 652                                         pn533_cmd_complete_t cmd_complete,
 653                                         void *arg, gfp_t flags)
 654 {
 655         int rc;
 656
 657         nfc_dev_dbg(&dev->interface->dev, "Sending command 0x%x",
 658                                                 PN533_FRAME_CMD(out_frame));
 659
 660         dev->cmd = PN533_FRAME_CMD(out_frame);
 661         dev->cmd_complete = cmd_complete;
 662         dev->cmd_complete_arg = arg;
 663
 664         dev->out_urb->transfer_buffer = out_frame;
 665         dev->out_urb->transfer_buffer_length =
 666                                 PN533_FRAME_SIZE(out_frame);
 667
 668         dev->in_urb->transfer_buffer = in_frame;
 669         dev->in_urb->transfer_buffer_length = in_frame_len;
 670
 671         rc = usb_submit_urb(dev->out_urb, flags);
 672         if (rc)
 673                 return rc;
 674
 675         rc = pn533_submit_urb_for_ack(dev, flags);
 676         if (rc)
 677                 goto error;
 678
 679         return 0;
 680
 681 error:
 682         usb_unlink_urb(dev->out_urb);
 683         return rc;
 684 }
 685
 686 static void pn533_wq_cmd(struct work_struct *work)
 687 {
 688         struct pn533 *dev = container_of(work, struct pn533, cmd_work);
 689         struct pn533_cmd *cmd;
 690
 691         mutex_lock(&dev->cmd_lock);
 692
 693         if (list_empty(&dev->cmd_queue)) {
 694                 dev->cmd_pending = 0;
 695                 mutex_unlock(&dev->cmd_lock);
 696                 return;
 697         }
 698
 699         cmd = list_first_entry(&dev->cmd_queue, struct pn533_cmd, queue);
 700
 701         list_del(&cmd->queue);
 702
 703         mutex_unlock(&dev->cmd_lock);
 704
 705         __pn533_send_cmd_frame_async(dev, cmd->out_frame, cmd->in_frame,
 706                                      cmd->in_frame_len, cmd->cmd_complete,
 707                                      cmd->arg, cmd->flags);
 708
 709         kfree(cmd);
 710 }
 711
 712 static int pn533_send_cmd_frame_async(struct pn533 *dev,
 713                                         struct pn533_frame *out_frame,
 714                                         struct pn533_frame *in_frame,
 715                                         int in_frame_len,
 716                                         pn533_cmd_complete_t cmd_complete,
 717                                         void *arg, gfp_t flags)
 718 {
 719         struct pn533_cmd *cmd;
 720         int rc = 0;
 721
 722         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
 723
 724         mutex_lock(&dev->cmd_lock);
 725
 726         if (!dev->cmd_pending) {
 727                 rc = __pn533_send_cmd_frame_async(dev, out_frame, in_frame,
 728                                                   in_frame_len, cmd_complete,
 729                                                   arg, flags);
 730                 if (!rc)
 731                         dev->cmd_pending = 1;
 732
 733                 goto unlock;
 734         }
 735
 736         nfc_dev_dbg(&dev->interface->dev, "%s Queueing command", __func__);
 737
 738         cmd = kzalloc(sizeof(struct pn533_cmd), flags);
 739         if (!cmd) {
 740                 rc = -ENOMEM;
 741                 goto unlock;
 742         }
 743
 744         INIT_LIST_HEAD(&cmd->queue);
 745         cmd->out_frame = out_frame;
 746         cmd->in_frame = in_frame;
 747         cmd->in_frame_len = in_frame_len;
 748         cmd->cmd_complete = cmd_complete;
 749         cmd->arg = arg;
 750         cmd->flags = flags;
 751
 752         list_add_tail(&cmd->queue, &dev->cmd_queue);
 753
 754 unlock:
 755         mutex_unlock(&dev->cmd_lock);
 756
 757         return rc;
 758 }
 759
 760 struct pn533_sync_cmd_response {
 761         int rc;
 762         struct completion done;
 763 };
 764
 765 static int pn533_sync_cmd_complete(struct pn533 *dev, void *_arg,
 766                                         u8 *params, int params_len)
 767 {
 768         struct pn533_sync_cmd_response *arg = _arg;
 769
 770         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
 771
 772         arg->rc = 0;
 773
 774         if (params_len < 0) /* error */
 775                 arg->rc = params_len;
 776
 777         complete(&arg->done);
 778
 779         return 0;
 780 }
 781
 782 static int pn533_send_cmd_frame_sync(struct pn533 *dev,
 783                                                 struct pn533_frame *out_frame,
 784                                                 struct pn533_frame *in_frame,
 785                                                 int in_frame_len)
 786 {
 787         int rc;
 788         struct pn533_sync_cmd_response arg;
 789
 790         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
 791
 792         init_completion(&arg.done);
 793
 794         rc = pn533_send_cmd_frame_async(dev, out_frame, in_frame, in_frame_len,
 795                                 pn533_sync_cmd_complete, &arg, GFP_KERNEL);
 796         if (rc)
 797                 return rc;
 798
 799         wait_for_completion(&arg.done);
 800
 801         return arg.rc;
 802 }
 803
 804 static void pn533_send_complete(struct urb *urb)
 805 {
 806         struct pn533 *dev = urb->context;
 807
 808         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
 809
 810         switch (urb->status) {
 811         case 0:
 812                 /* success */
 813                 break;
 814         case -ECONNRESET:
 815         case -ENOENT:
 816         case -ESHUTDOWN:
 817                 nfc_dev_dbg(&dev->interface->dev, "Urb shutting down with"
 818                                                 " status: %d", urb->status);
 819                 break;
 820         default:
 821                 nfc_dev_dbg(&dev->interface->dev, "Nonzero urb status received:"
 822                                                         " %d", urb->status);
 823         }
 824 }
 825
 826 struct pn533_target_type_a {
 827         __be16 sens_res;
 828         u8 sel_res;
 829         u8 nfcid_len;
 830         u8 nfcid_data[];
 831 } __packed;
 832
 833
 834 #define PN533_TYPE_A_SENS_RES_NFCID1(x) ((u8)((be16_to_cpu(x) & 0x00C0) >> 6))
 835 #define PN533_TYPE_A_SENS_RES_SSD(x) ((u8)((be16_to_cpu(x) & 0x001F) >> 0))
 836 #define PN533_TYPE_A_SENS_RES_PLATCONF(x) ((u8)((be16_to_cpu(x) & 0x0F00) >> 8))
 837
 838 #define PN533_TYPE_A_SENS_RES_SSD_JEWEL 0x00
 839 #define PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL 0x0C
 840
 841 #define PN533_TYPE_A_SEL_PROT(x) (((x) & 0x60) >> 5)
 842 #define PN533_TYPE_A_SEL_CASCADE(x) (((x) & 0x04) >> 2)
 843
 844 #define PN533_TYPE_A_SEL_PROT_MIFARE 0
 845 #define PN533_TYPE_A_SEL_PROT_ISO14443 1
 846 #define PN533_TYPE_A_SEL_PROT_DEP 2
 847 #define PN533_TYPE_A_SEL_PROT_ISO14443_DEP 3
 848
 849 static bool pn533_target_type_a_is_valid(struct pn533_target_type_a *type_a,
 850                                                         int target_data_len)
 851 {
 852         u8 ssd;
 853         u8 platconf;
 854
 855         if (target_data_len < sizeof(struct pn533_target_type_a))
 856                 return false;
 857
 858         /* The lenght check of nfcid[] and ats[] are not being performed because
 859            the values are not being used */
 860
 861         /* Requirement 4.6.3.3 from NFC Forum Digital Spec */
 862         ssd = PN533_TYPE_A_SENS_RES_SSD(type_a->sens_res);
 863         platconf = PN533_TYPE_A_SENS_RES_PLATCONF(type_a->sens_res);
 864
 865         if ((ssd == PN533_TYPE_A_SENS_RES_SSD_JEWEL &&
 866                         platconf != PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL) ||
 867                         (ssd != PN533_TYPE_A_SENS_RES_SSD_JEWEL &&
 868                         platconf == PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL))
 869                 return false;
 870
 871         /* Requirements 4.8.2.1, 4.8.2.3, 4.8.2.5 and 4.8.2.7 from NFC Forum */
 872         if (PN533_TYPE_A_SEL_CASCADE(type_a->sel_res) != 0)
 873                 return false;
 874
 875         return true;
 876 }
 877
 878 static int pn533_target_found_type_a(struct nfc_target *nfc_tgt, u8 *tgt_data,
 879                                                         int tgt_data_len)
 880 {
 881         struct pn533_target_type_a *tgt_type_a;
 882
 883         tgt_type_a = (struct pn533_target_type_a *) tgt_data;
 884
 885         if (!pn533_target_type_a_is_valid(tgt_type_a, tgt_data_len))
 886                 return -EPROTO;
 887
 888         switch (PN533_TYPE_A_SEL_PROT(tgt_type_a->sel_res)) {
 889         case PN533_TYPE_A_SEL_PROT_MIFARE:
 890                 nfc_tgt->supported_protocols = NFC_PROTO_MIFARE_MASK;
 891                 break;
 892         case PN533_TYPE_A_SEL_PROT_ISO14443:
 893                 nfc_tgt->supported_protocols = NFC_PROTO_ISO14443_MASK;
 894                 break;
 895         case PN533_TYPE_A_SEL_PROT_DEP:
 896                 nfc_tgt->supported_protocols = NFC_PROTO_NFC_DEP_MASK;
 897                 break;
 898         case PN533_TYPE_A_SEL_PROT_ISO14443_DEP:
 899                 nfc_tgt->supported_protocols = NFC_PROTO_ISO14443_MASK |
 900                                                         NFC_PROTO_NFC_DEP_MASK;
 901                 break;
 902         }
 903
 904         nfc_tgt->sens_res = be16_to_cpu(tgt_type_a->sens_res);
 905         nfc_tgt->sel_res = tgt_type_a->sel_res;
 906         nfc_tgt->nfcid1_len = tgt_type_a->nfcid_len;
 907         memcpy(nfc_tgt->nfcid1, tgt_type_a->nfcid_data, nfc_tgt->nfcid1_len);
 908
 909         return 0;
 910 }
 911
 912 struct pn533_target_felica {
 913         u8 pol_res;
 914         u8 opcode;
 915         u8 nfcid2[8];
 916         u8 pad[8];
 917         /* optional */
 918         u8 syst_code[];
 919 } __packed;
 920
 921 #define PN533_FELICA_SENSF_NFCID2_DEP_B1 0x01
 922 #define PN533_FELICA_SENSF_NFCID2_DEP_B2 0xFE
 923
 924 static bool pn533_target_felica_is_valid(struct pn533_target_felica *felica,
 925                                                         int target_data_len)
 926 {
 927         if (target_data_len < sizeof(struct pn533_target_felica))
 928                 return false;
 929
 930         if (felica->opcode != PN533_FELICA_OPC_SENSF_RES)
 931                 return false;
 932
 933         return true;
 934 }
 935
 936 static int pn533_target_found_felica(struct nfc_target *nfc_tgt, u8 *tgt_data,
 937                                                         int tgt_data_len)
 938 {
 939         struct pn533_target_felica *tgt_felica;
 940
 941         tgt_felica = (struct pn533_target_felica *) tgt_data;
 942
 943         if (!pn533_target_felica_is_valid(tgt_felica, tgt_data_len))
 944                 return -EPROTO;
 945
 946         if (tgt_felica->nfcid2[0] == PN533_FELICA_SENSF_NFCID2_DEP_B1 &&
 947                                         tgt_felica->nfcid2[1] ==
 948                                         PN533_FELICA_SENSF_NFCID2_DEP_B2)
 949                 nfc_tgt->supported_protocols = NFC_PROTO_NFC_DEP_MASK;
 950         else
 951                 nfc_tgt->supported_protocols = NFC_PROTO_FELICA_MASK;
 952
 953         memcpy(nfc_tgt->sensf_res, &tgt_felica->opcode, 9);
 954         nfc_tgt->sensf_res_len = 9;
 955
 956         return 0;
 957 }
 958
 959 struct pn533_target_jewel {
 960         __be16 sens_res;
 961         u8 jewelid[4];
 962 } __packed;
 963
 964 static bool pn533_target_jewel_is_valid(struct pn533_target_jewel *jewel,
 965                                                         int target_data_len)
 966 {
 967         u8 ssd;
 968         u8 platconf;
 969
 970         if (target_data_len < sizeof(struct pn533_target_jewel))
 971                 return false;
 972
 973         /* Requirement 4.6.3.3 from NFC Forum Digital Spec */
 974         ssd = PN533_TYPE_A_SENS_RES_SSD(jewel->sens_res);
 975         platconf = PN533_TYPE_A_SENS_RES_PLATCONF(jewel->sens_res);
 976
 977         if ((ssd == PN533_TYPE_A_SENS_RES_SSD_JEWEL &&
 978                         platconf != PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL) ||
 979                         (ssd != PN533_TYPE_A_SENS_RES_SSD_JEWEL &&
 980                         platconf == PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL))
 981                 return false;
 982
 983         return true;
 984 }
 985
 986 static int pn533_target_found_jewel(struct nfc_target *nfc_tgt, u8 *tgt_data,
 987                                                         int tgt_data_len)
 988 {
 989         struct pn533_target_jewel *tgt_jewel;
 990
 991         tgt_jewel = (struct pn533_target_jewel *) tgt_data;
 992
 993         if (!pn533_target_jewel_is_valid(tgt_jewel, tgt_data_len))
 994                 return -EPROTO;
 995
 996         nfc_tgt->supported_protocols = NFC_PROTO_JEWEL_MASK;
 997         nfc_tgt->sens_res = be16_to_cpu(tgt_jewel->sens_res);
 998         nfc_tgt->nfcid1_len = 4;
 999         memcpy(nfc_tgt->nfcid1, tgt_jewel->jewelid, nfc_tgt->nfcid1_len);
1000
1001         return 0;
1002 }
1003
1004 struct pn533_type_b_prot_info {
1005         u8 bitrate;
1006         u8 fsci_type;
1007         u8 fwi_adc_fo;
1008 } __packed;
1009
1010 #define PN533_TYPE_B_PROT_FCSI(x) (((x) & 0xF0) >> 4)
1011 #define PN533_TYPE_B_PROT_TYPE(x) (((x) & 0x0F) >> 0)
1012 #define PN533_TYPE_B_PROT_TYPE_RFU_MASK 0x8
1013
1014 struct pn533_type_b_sens_res {
1015         u8 opcode;
1016         u8 nfcid[4];
1017         u8 appdata[4];
1018         struct pn533_type_b_prot_info prot_info;
1019 } __packed;
1020
1021 #define PN533_TYPE_B_OPC_SENSB_RES 0x50
1022
1023 struct pn533_target_type_b {
1024         struct pn533_type_b_sens_res sensb_res;
1025         u8 attrib_res_len;
1026         u8 attrib_res[];
1027 } __packed;
1028
1029 static bool pn533_target_type_b_is_valid(struct pn533_target_type_b *type_b,
1030                                                         int target_data_len)
1031 {
1032         if (target_data_len < sizeof(struct pn533_target_type_b))
1033                 return false;
1034
1035         if (type_b->sensb_res.opcode != PN533_TYPE_B_OPC_SENSB_RES)
1036                 return false;
1037
1038         if (PN533_TYPE_B_PROT_TYPE(type_b->sensb_res.prot_info.fsci_type) &
1039                                                 PN533_TYPE_B_PROT_TYPE_RFU_MASK)
1040                 return false;
1041
1042         return true;
1043 }
1044
1045 static int pn533_target_found_type_b(struct nfc_target *nfc_tgt, u8 *tgt_data,
1046                                                         int tgt_data_len)
1047 {
1048         struct pn533_target_type_b *tgt_type_b;
1049
1050         tgt_type_b = (struct pn533_target_type_b *) tgt_data;
1051
1052         if (!pn533_target_type_b_is_valid(tgt_type_b, tgt_data_len))
1053                 return -EPROTO;
1054
1055         nfc_tgt->supported_protocols = NFC_PROTO_ISO14443_B_MASK;
1056
1057         return 0;
1058 }
1059
1060 struct pn533_poll_response {
1061         u8 nbtg;
1062         u8 tg;
1063         u8 target_data[];
1064 } __packed;
1065
1066 static int pn533_target_found(struct pn533 *dev,
1067                         struct pn533_poll_response *resp, int resp_len)
1068 {
1069         int target_data_len;
1070         struct nfc_target nfc_tgt;
1071         int rc;
1072
1073         nfc_dev_dbg(&dev->interface->dev, "%s - modulation=%d", __func__,
1074                                                         dev->poll_mod_curr);
1075
1076         if (resp->tg != 1)
1077                 return -EPROTO;
1078
1079         memset(&nfc_tgt, 0, sizeof(struct nfc_target));
1080
1081         target_data_len = resp_len - sizeof(struct pn533_poll_response);
1082
1083         switch (dev->poll_mod_curr) {
1084         case PN533_POLL_MOD_106KBPS_A:
1085                 rc = pn533_target_found_type_a(&nfc_tgt, resp->target_data,
1086                                                         target_data_len);
1087                 break;
1088         case PN533_POLL_MOD_212KBPS_FELICA:
1089         case PN533_POLL_MOD_424KBPS_FELICA:
1090                 rc = pn533_target_found_felica(&nfc_tgt, resp->target_data,
1091                                                         target_data_len);
1092                 break;
1093         case PN533_POLL_MOD_106KBPS_JEWEL:
1094                 rc = pn533_target_found_jewel(&nfc_tgt, resp->target_data,
1095                                                         target_data_len);
1096                 break;
1097         case PN533_POLL_MOD_847KBPS_B:
1098                 rc = pn533_target_found_type_b(&nfc_tgt, resp->target_data,
1099                                                         target_data_len);
1100                 break;
1101         default:
1102                 nfc_dev_err(&dev->interface->dev, "Unknown current poll"
1103                                                                 " modulation");
1104                 return -EPROTO;
1105         }
1106
1107         if (rc)
1108                 return rc;
1109
1110         if (!(nfc_tgt.supported_protocols & dev->poll_protocols)) {
1111                 nfc_dev_dbg(&dev->interface->dev, "The target found does not"
1112                                                 " have the desired protocol");
1113                 return -EAGAIN;
1114         }
1115
1116         nfc_dev_dbg(&dev->interface->dev, "Target found - supported protocols: "
1117                                         "0x%x", nfc_tgt.supported_protocols);
1118
1119         dev->tgt_available_prots = nfc_tgt.supported_protocols;
1120
1121         nfc_targets_found(dev->nfc_dev, &nfc_tgt, 1);
1122
1123         return 0;
1124 }
1125
1126 static inline void pn533_poll_next_mod(struct pn533 *dev)
1127 {
1128         dev->poll_mod_curr = (dev->poll_mod_curr + 1) % dev->poll_mod_count;
1129 }
1130
1131 static void pn533_poll_reset_mod_list(struct pn533 *dev)
1132 {
1133         dev->poll_mod_count = 0;
1134 }
1135
1136 static void pn533_poll_add_mod(struct pn533 *dev, u8 mod_index)
1137 {
1138         dev->poll_mod_active[dev->poll_mod_count] =
1139                 (struct pn533_poll_modulations *) &poll_mod[mod_index];
1140         dev->poll_mod_count++;
1141 }
1142
1143 static void pn533_poll_create_mod_list(struct pn533 *dev,
1144                                        u32 im_protocols, u32 tm_protocols)
1145 {
1146         pn533_poll_reset_mod_list(dev);
1147
1148         if (im_protocols & NFC_PROTO_MIFARE_MASK
1149             || im_protocols & NFC_PROTO_ISO14443_MASK
1150             || im_protocols & NFC_PROTO_NFC_DEP_MASK)
1151                 pn533_poll_add_mod(dev, PN533_POLL_MOD_106KBPS_A);
1152
1153         if (im_protocols & NFC_PROTO_FELICA_MASK
1154             || im_protocols & NFC_PROTO_NFC_DEP_MASK) {
1155                 pn533_poll_add_mod(dev, PN533_POLL_MOD_212KBPS_FELICA);
1156                 pn533_poll_add_mod(dev, PN533_POLL_MOD_424KBPS_FELICA);
1157         }
1158
1159         if (im_protocols & NFC_PROTO_JEWEL_MASK)
1160                 pn533_poll_add_mod(dev, PN533_POLL_MOD_106KBPS_JEWEL);
1161
1162         if (im_protocols & NFC_PROTO_ISO14443_B_MASK)
1163                 pn533_poll_add_mod(dev, PN533_POLL_MOD_847KBPS_B);
1164
1165         if (tm_protocols)
1166                 pn533_poll_add_mod(dev, PN533_LISTEN_MOD);
1167 }
1168
1169 static int pn533_start_poll_complete(struct pn533 *dev, void *arg,
1170                                      u8 *params, int params_len)
1171 {
1172         struct pn533_poll_response *resp;
1173         int rc;
1174
1175         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1176
1177         resp = (struct pn533_poll_response *) params;
1178         if (resp->nbtg) {
1179                 rc = pn533_target_found(dev, resp, params_len);
1180
1181                 /* We must stop the poll after a valid target found */
1182                 if (rc == 0) {
1183                         pn533_poll_reset_mod_list(dev);
1184                         return 0;
1185                 }
1186         }
1187
1188         return -EAGAIN;
1189 }
1190
1191 static int pn533_init_target_frame(struct pn533_frame *frame,
1192                                    u8 *gb, size_t gb_len)
1193 {
1194         struct pn533_cmd_init_target *cmd;
1195         size_t cmd_len;
1196         u8 felica_params[18] = {0x1, 0xfe, /* DEP */
1197                                 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, /* random */
1198                                 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
1199                                 0xff, 0xff}; /* System code */
1200         u8 mifare_params[6] = {0x1, 0x1, /* SENS_RES */
1201                                0x0, 0x0, 0x0,
1202                                0x40}; /* SEL_RES for DEP */
1203
1204         cmd_len = sizeof(struct pn533_cmd_init_target) + gb_len + 1;
1205         cmd = kzalloc(cmd_len, GFP_KERNEL);
1206         if (cmd == NULL)
1207                 return -ENOMEM;
1208
1209         pn533_tx_frame_init(frame, PN533_CMD_TG_INIT_AS_TARGET);
1210
1211         /* DEP support only */
1212         cmd->mode |= PN533_INIT_TARGET_DEP;
1213
1214         /* Felica params */
1215         memcpy(cmd->felica, felica_params, 18);
1216         get_random_bytes(cmd->felica + 2, 6);
1217
1218         /* NFCID3 */
1219         memset(cmd->nfcid3, 0, 10);
1220         memcpy(cmd->nfcid3, cmd->felica, 8);
1221
1222         /* MIFARE params */
1223         memcpy(cmd->mifare, mifare_params, 6);
1224
1225         /* General bytes */
1226         cmd->gb_len = gb_len;
1227         memcpy(cmd->gb, gb, gb_len);
1228
1229         /* Len Tk */
1230         cmd->gb[gb_len] = 0;
1231
1232         memcpy(PN533_FRAME_CMD_PARAMS_PTR(frame), cmd, cmd_len);
1233
1234         frame->datalen += cmd_len;
1235
1236         pn533_tx_frame_finish(frame);
1237
1238         kfree(cmd);
1239
1240         return 0;
1241 }
1242
1243 #define PN533_CMD_DATAEXCH_HEAD_LEN (sizeof(struct pn533_frame) + 3)
1244 #define PN533_CMD_DATAEXCH_DATA_MAXLEN 262
1245 static int pn533_tm_get_data_complete(struct pn533 *dev, void *arg,
1246                                       u8 *params, int params_len)
1247 {
1248         struct sk_buff *skb_resp = arg;
1249         struct pn533_frame *in_frame = (struct pn533_frame *) skb_resp->data;
1250
1251         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1252
1253         if (params_len < 0) {
1254                 nfc_dev_err(&dev->interface->dev,
1255                             "Error %d when starting as a target",
1256                             params_len);
1257
1258                 return params_len;
1259         }
1260
1261         if (params_len > 0 && params[0] != 0) {
1262                 nfc_tm_deactivated(dev->nfc_dev);
1263
1264                 dev->tgt_mode = 0;
1265
1266                 kfree_skb(skb_resp);
1267                 return 0;
1268         }
1269
1270         skb_put(skb_resp, PN533_FRAME_SIZE(in_frame));
1271         skb_pull(skb_resp, PN533_CMD_DATAEXCH_HEAD_LEN);
1272         skb_trim(skb_resp, skb_resp->len - PN533_FRAME_TAIL_SIZE);
1273
1274         return nfc_tm_data_received(dev->nfc_dev, skb_resp);
1275 }
1276
1277 static void pn533_wq_tg_get_data(struct work_struct *work)
1278 {
1279         struct pn533 *dev = container_of(work, struct pn533, tg_work);
1280         struct pn533_frame *in_frame;
1281         struct sk_buff *skb_resp;
1282         size_t skb_resp_len;
1283
1284         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1285
1286         skb_resp_len = PN533_CMD_DATAEXCH_HEAD_LEN +
1287                 PN533_CMD_DATAEXCH_DATA_MAXLEN +
1288                 PN533_FRAME_TAIL_SIZE;
1289
1290         skb_resp = nfc_alloc_recv_skb(skb_resp_len, GFP_KERNEL);
1291         if (!skb_resp)
1292                 return;
1293
1294         in_frame = (struct pn533_frame *)skb_resp->data;
1295
1296         pn533_tx_frame_init(dev->out_frame, PN533_CMD_TG_GET_DATA);
1297         pn533_tx_frame_finish(dev->out_frame);
1298
1299         pn533_send_cmd_frame_async(dev, dev->out_frame, in_frame,
1300                                    skb_resp_len,
1301                                    pn533_tm_get_data_complete,
1302                                    skb_resp, GFP_KERNEL);
1303
1304         return;
1305 }
1306
1307 #define ATR_REQ_GB_OFFSET 17
1308 static int pn533_init_target_complete(struct pn533 *dev, void *arg,
1309                                       u8 *params, int params_len)
1310 {
1311         struct pn533_cmd_init_target_response *resp;
1312         u8 frame, comm_mode = NFC_COMM_PASSIVE, *gb;
1313         size_t gb_len;
1314         int rc;
1315
1316         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1317
1318         if (params_len < 0) {
1319                 nfc_dev_err(&dev->interface->dev,
1320                             "Error %d when starting as a target",
1321                             params_len);
1322
1323                 return params_len;
1324         }
1325
1326         if (params_len < ATR_REQ_GB_OFFSET + 1)
1327                 return -EINVAL;
1328
1329         resp = (struct pn533_cmd_init_target_response *) params;
1330
1331         nfc_dev_dbg(&dev->interface->dev, "Target mode 0x%x param len %d\n",
1332                     resp->mode, params_len);
1333
1334         frame = resp->mode & PN533_INIT_TARGET_RESP_FRAME_MASK;
1335         if (frame == PN533_INIT_TARGET_RESP_ACTIVE)
1336                 comm_mode = NFC_COMM_ACTIVE;
1337
1338         /* Again, only DEP */
1339         if ((resp->mode & PN533_INIT_TARGET_RESP_DEP) == 0)
1340                 return -EOPNOTSUPP;
1341
1342         gb = resp->cmd + ATR_REQ_GB_OFFSET;
1343         gb_len = params_len - (ATR_REQ_GB_OFFSET + 1);
1344
1345         rc = nfc_tm_activated(dev->nfc_dev, NFC_PROTO_NFC_DEP_MASK,
1346                               comm_mode, gb, gb_len);
1347         if (rc < 0) {
1348                 nfc_dev_err(&dev->interface->dev,
1349                             "Error when signaling target activation");
1350                 return rc;
1351         }
1352
1353         dev->tgt_mode = 1;
1354
1355         queue_work(dev->wq, &dev->tg_work);
1356
1357         return 0;
1358 }
1359
1360 static void pn533_listen_mode_timer(unsigned long data)
1361 {
1362         struct pn533 *dev = (struct pn533 *) data;
1363
1364         nfc_dev_dbg(&dev->interface->dev, "Listen mode timeout");
1365
1366         /* An ack will cancel the last issued command (poll) */
1367         pn533_send_ack(dev, GFP_ATOMIC);
1368
1369         dev->cancel_listen = 1;
1370
1371         pn533_poll_next_mod(dev);
1372
1373         queue_work(dev->wq, &dev->poll_work);
1374 }
1375
1376 static int pn533_poll_complete(struct pn533 *dev, void *arg,
1377                                u8 *params, int params_len)
1378 {
1379         struct pn533_poll_modulations *cur_mod;
1380         int rc;
1381
1382         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1383
1384         if (params_len == -ENOENT) {
1385                 if (dev->poll_mod_count != 0)
1386                         return 0;
1387
1388                 nfc_dev_err(&dev->interface->dev,
1389                             "Polling operation has been stopped");
1390
1391                 goto stop_poll;
1392         }
1393
1394         if (params_len < 0) {
1395                 nfc_dev_err(&dev->interface->dev,
1396                             "Error %d when running poll", params_len);
1397
1398                 goto stop_poll;
1399         }
1400
1401         cur_mod = dev->poll_mod_active[dev->poll_mod_curr];
1402
1403         if (cur_mod->len == 0) {
1404                 del_timer(&dev->listen_timer);
1405
1406                 return pn533_init_target_complete(dev, arg, params, params_len);
1407         } else {
1408                 rc = pn533_start_poll_complete(dev, arg, params, params_len);
1409                 if (!rc)
1410                         return rc;
1411         }
1412
1413         pn533_poll_next_mod(dev);
1414
1415         queue_work(dev->wq, &dev->poll_work);
1416
1417         return 0;
1418
1419 stop_poll:
1420         pn533_poll_reset_mod_list(dev);
1421         dev->poll_protocols = 0;
1422         return 0;
1423 }
1424
1425 static void pn533_build_poll_frame(struct pn533 *dev,
1426                                    struct pn533_frame *frame,
1427                                    struct pn533_poll_modulations *mod)
1428 {
1429         nfc_dev_dbg(&dev->interface->dev, "mod len %d\n", mod->len);
1430
1431         if (mod->len == 0) {
1432                 /* Listen mode */
1433                 pn533_init_target_frame(frame, dev->gb, dev->gb_len);
1434         } else {
1435                 /* Polling mode */
1436                 pn533_tx_frame_init(frame, PN533_CMD_IN_LIST_PASSIVE_TARGET);
1437
1438                 memcpy(PN533_FRAME_CMD_PARAMS_PTR(frame), &mod->data, mod->len);
1439                 frame->datalen += mod->len;
1440
1441                 pn533_tx_frame_finish(frame);
1442         }
1443 }
1444
1445 static int pn533_send_poll_frame(struct pn533 *dev)
1446 {
1447         struct pn533_poll_modulations *cur_mod;
1448         int rc;
1449
1450         cur_mod = dev->poll_mod_active[dev->poll_mod_curr];
1451
1452         pn533_build_poll_frame(dev, dev->out_frame, cur_mod);
1453
1454         rc = pn533_send_cmd_frame_async(dev, dev->out_frame, dev->in_frame,
1455                                 dev->in_maxlen, pn533_poll_complete,
1456                                 NULL, GFP_KERNEL);
1457         if (rc)
1458                 nfc_dev_err(&dev->interface->dev, "Polling loop error %d", rc);
1459
1460         return rc;
1461 }
1462
1463 static void pn533_wq_poll(struct work_struct *work)
1464 {
1465         struct pn533 *dev = container_of(work, struct pn533, poll_work);
1466         struct pn533_poll_modulations *cur_mod;
1467         int rc;
1468
1469         cur_mod = dev->poll_mod_active[dev->poll_mod_curr];
1470
1471         nfc_dev_dbg(&dev->interface->dev,
1472                     "%s cancel_listen %d modulation len %d",
1473                     __func__, dev->cancel_listen, cur_mod->len);
1474
1475         if (dev->cancel_listen == 1) {
1476                 dev->cancel_listen = 0;
1477                 usb_kill_urb(dev->in_urb);
1478         }
1479
1480         rc = pn533_send_poll_frame(dev);
1481         if (rc)
1482                 return;
1483
1484         if (cur_mod->len == 0 && dev->poll_mod_count > 1)
1485                 mod_timer(&dev->listen_timer, jiffies + PN533_LISTEN_TIME * HZ);
1486
1487         return;
1488 }
1489
1490 static int pn533_start_poll(struct nfc_dev *nfc_dev,
1491                             u32 im_protocols, u32 tm_protocols)
1492 {
1493         struct pn533 *dev = nfc_get_drvdata(nfc_dev);
1494
1495         nfc_dev_dbg(&dev->interface->dev,
1496                     "%s: im protocols 0x%x tm protocols 0x%x",
1497                     __func__, im_protocols, tm_protocols);
1498
1499         if (dev->tgt_active_prot) {
1500                 nfc_dev_err(&dev->interface->dev,
1501                             "Cannot poll with a target already activated");
1502                 return -EBUSY;
1503         }
1504
1505         if (dev->tgt_mode) {
1506                 nfc_dev_err(&dev->interface->dev,
1507                             "Cannot poll while already being activated");
1508                 return -EBUSY;
1509         }
1510
1511         if (tm_protocols) {
1512                 dev->gb = nfc_get_local_general_bytes(nfc_dev, &dev->gb_len);
1513                 if (dev->gb == NULL)
1514                         tm_protocols = 0;
1515         }
1516
1517         dev->poll_mod_curr = 0;
1518         pn533_poll_create_mod_list(dev, im_protocols, tm_protocols);
1519         dev->poll_protocols = im_protocols;
1520         dev->listen_protocols = tm_protocols;
1521
1522         return pn533_send_poll_frame(dev);
1523 }
1524
1525 static void pn533_stop_poll(struct nfc_dev *nfc_dev)
1526 {
1527         struct pn533 *dev = nfc_get_drvdata(nfc_dev);
1528
1529         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1530
1531         del_timer(&dev->listen_timer);
1532
1533         if (!dev->poll_mod_count) {
1534                 nfc_dev_dbg(&dev->interface->dev, "Polling operation was not"
1535                                                                 " running");
1536                 return;
1537         }
1538
1539         /* An ack will cancel the last issued command (poll) */
1540         pn533_send_ack(dev, GFP_KERNEL);
1541
1542         /* prevent pn533_start_poll_complete to issue a new poll meanwhile */
1543         usb_kill_urb(dev->in_urb);
1544
1545         pn533_poll_reset_mod_list(dev);
1546 }
1547
1548 static int pn533_activate_target_nfcdep(struct pn533 *dev)
1549 {
1550         struct pn533_cmd_activate_param param;
1551         struct pn533_cmd_activate_response *resp;
1552         u16 gt_len;
1553         int rc;
1554
1555         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1556
1557         pn533_tx_frame_init(dev->out_frame, PN533_CMD_IN_ATR);
1558
1559         param.tg = 1;
1560         param.next = 0;
1561         memcpy(PN533_FRAME_CMD_PARAMS_PTR(dev->out_frame), &param,
1562                                 sizeof(struct pn533_cmd_activate_param));
1563         dev->out_frame->datalen += sizeof(struct pn533_cmd_activate_param);
1564
1565         pn533_tx_frame_finish(dev->out_frame);
1566
1567         rc = pn533_send_cmd_frame_sync(dev, dev->out_frame, dev->in_frame,
1568                                                                 dev->in_maxlen);
1569         if (rc)
1570                 return rc;
1571
1572         resp = (struct pn533_cmd_activate_response *)
1573                                 PN533_FRAME_CMD_PARAMS_PTR(dev->in_frame);
1574         rc = resp->status & PN533_CMD_RET_MASK;
1575         if (rc != PN533_CMD_RET_SUCCESS)
1576                 return -EIO;
1577
1578         /* ATR_RES general bytes are located at offset 16 */
1579         gt_len = PN533_FRAME_CMD_PARAMS_LEN(dev->in_frame) - 16;
1580         rc = nfc_set_remote_general_bytes(dev->nfc_dev, resp->gt, gt_len);
1581
1582         return rc;
1583 }
1584
1585 static int pn533_activate_target(struct nfc_dev *nfc_dev,
1586                                  struct nfc_target *target, u32 protocol)
1587 {
1588         struct pn533 *dev = nfc_get_drvdata(nfc_dev);
1589         int rc;
1590
1591         nfc_dev_dbg(&dev->interface->dev, "%s - protocol=%u", __func__,
1592                                                                 protocol);
1593
1594         if (dev->poll_mod_count) {
1595                 nfc_dev_err(&dev->interface->dev, "Cannot activate while"
1596                                                                 " polling");
1597                 return -EBUSY;
1598         }
1599
1600         if (dev->tgt_active_prot) {
1601                 nfc_dev_err(&dev->interface->dev, "There is already an active"
1602                                                                 " target");
1603                 return -EBUSY;
1604         }
1605
1606         if (!dev->tgt_available_prots) {
1607                 nfc_dev_err(&dev->interface->dev, "There is no available target"
1608                                                                 " to activate");
1609                 return -EINVAL;
1610         }
1611
1612         if (!(dev->tgt_available_prots & (1 << protocol))) {
1613                 nfc_dev_err(&dev->interface->dev, "The target does not support"
1614                                         " the requested protocol %u", protocol);
1615                 return -EINVAL;
1616         }
1617
1618         if (protocol == NFC_PROTO_NFC_DEP) {
1619                 rc = pn533_activate_target_nfcdep(dev);
1620                 if (rc) {
1621                         nfc_dev_err(&dev->interface->dev, "Error %d when"
1622                                                 " activating target with"
1623                                                 " NFC_DEP protocol", rc);
1624                         return rc;
1625                 }
1626         }
1627
1628         dev->tgt_active_prot = protocol;
1629         dev->tgt_available_prots = 0;
1630
1631         return 0;
1632 }
1633
1634 static void pn533_deactivate_target(struct nfc_dev *nfc_dev,
1635                                     struct nfc_target *target)
1636 {
1637         struct pn533 *dev = nfc_get_drvdata(nfc_dev);
1638         u8 tg;
1639         u8 status;
1640         int rc;
1641
1642         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1643
1644         if (!dev->tgt_active_prot) {
1645                 nfc_dev_err(&dev->interface->dev, "There is no active target");
1646                 return;
1647         }
1648
1649         dev->tgt_active_prot = 0;
1650
1651         skb_queue_purge(&dev->resp_q);
1652
1653         pn533_tx_frame_init(dev->out_frame, PN533_CMD_IN_RELEASE);
1654
1655         tg = 1;
1656         memcpy(PN533_FRAME_CMD_PARAMS_PTR(dev->out_frame), &tg, sizeof(u8));
1657         dev->out_frame->datalen += sizeof(u8);
1658
1659         pn533_tx_frame_finish(dev->out_frame);
1660
1661         rc = pn533_send_cmd_frame_sync(dev, dev->out_frame, dev->in_frame,
1662                                                                 dev->in_maxlen);
1663         if (rc) {
1664                 nfc_dev_err(&dev->interface->dev, "Error when sending release"
1665                                                 " command to the controller");
1666                 return;
1667         }
1668
1669         status = PN533_FRAME_CMD_PARAMS_PTR(dev->in_frame)[0];
1670         rc = status & PN533_CMD_RET_MASK;
1671         if (rc != PN533_CMD_RET_SUCCESS)
1672                 nfc_dev_err(&dev->interface->dev, "Error 0x%x when releasing"
1673                                                         " the target", rc);
1674
1675         return;
1676 }
1677
1678
1679 static int pn533_in_dep_link_up_complete(struct pn533 *dev, void *arg,
1680                                                 u8 *params, int params_len)
1681 {
1682         struct pn533_cmd_jump_dep *cmd;
1683         struct pn533_cmd_jump_dep_response *resp;
1684         struct nfc_target nfc_target;
1685         u8 target_gt_len;
1686         int rc;
1687
1688         if (params_len == -ENOENT) {
1689                 nfc_dev_dbg(&dev->interface->dev, "");
1690                 return 0;
1691         }
1692
1693         if (params_len < 0) {
1694                 nfc_dev_err(&dev->interface->dev,
1695                                 "Error %d when bringing DEP link up",
1696                                                                 params_len);
1697                 return 0;
1698         }
1699
1700         if (dev->tgt_available_prots &&
1701             !(dev->tgt_available_prots & (1 << NFC_PROTO_NFC_DEP))) {
1702                 nfc_dev_err(&dev->interface->dev,
1703                         "The target does not support DEP");
1704                 return -EINVAL;
1705         }
1706
1707         resp = (struct pn533_cmd_jump_dep_response *) params;
1708         cmd = (struct pn533_cmd_jump_dep *) arg;
1709         rc = resp->status & PN533_CMD_RET_MASK;
1710         if (rc != PN533_CMD_RET_SUCCESS) {
1711                 nfc_dev_err(&dev->interface->dev,
1712                                 "Bringing DEP link up failed %d", rc);
1713                 return 0;
1714         }
1715
1716         if (!dev->tgt_available_prots) {
1717                 nfc_dev_dbg(&dev->interface->dev, "Creating new target");
1718
1719                 nfc_target.supported_protocols = NFC_PROTO_NFC_DEP_MASK;
1720                 nfc_target.nfcid1_len = 10;
1721                 memcpy(nfc_target.nfcid1, resp->nfcid3t, nfc_target.nfcid1_len);
1722                 rc = nfc_targets_found(dev->nfc_dev, &nfc_target, 1);
1723                 if (rc)
1724                         return 0;
1725
1726                 dev->tgt_available_prots = 0;
1727         }
1728
1729         dev->tgt_active_prot = NFC_PROTO_NFC_DEP;
1730
1731         /* ATR_RES general bytes are located at offset 17 */
1732         target_gt_len = PN533_FRAME_CMD_PARAMS_LEN(dev->in_frame) - 17;
1733         rc = nfc_set_remote_general_bytes(dev->nfc_dev,
1734                                                 resp->gt, target_gt_len);
1735         if (rc == 0)
1736                 rc = nfc_dep_link_is_up(dev->nfc_dev,
1737                                                 dev->nfc_dev->targets[0].idx,
1738                                                 !cmd->active, NFC_RF_INITIATOR);
1739
1740         return 0;
1741 }
1742
1743 static int pn533_mod_to_baud(struct pn533 *dev)
1744 {
1745         switch (dev->poll_mod_curr) {
1746         case PN533_POLL_MOD_106KBPS_A:
1747                 return 0;
1748         case PN533_POLL_MOD_212KBPS_FELICA:
1749                 return 1;
1750         case PN533_POLL_MOD_424KBPS_FELICA:
1751                 return 2;
1752         default:
1753                 return -EINVAL;
1754         }
1755 }
1756
1757 #define PASSIVE_DATA_LEN 5
1758 static int pn533_dep_link_up(struct nfc_dev *nfc_dev, struct nfc_target *target,
1759                              u8 comm_mode, u8* gb, size_t gb_len)
1760 {
1761         struct pn533 *dev = nfc_get_drvdata(nfc_dev);
1762         struct pn533_cmd_jump_dep *cmd;
1763         u8 cmd_len, *data_ptr;
1764         u8 passive_data[PASSIVE_DATA_LEN] = {0x00, 0xff, 0xff, 0x00, 0x3};
1765         int rc, baud;
1766
1767         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1768
1769         if (dev->poll_mod_count) {
1770                 nfc_dev_err(&dev->interface->dev,
1771                                 "Cannot bring the DEP link up while polling");
1772                 return -EBUSY;
1773         }
1774
1775         if (dev->tgt_active_prot) {
1776                 nfc_dev_err(&dev->interface->dev,
1777                                 "There is already an active target");
1778                 return -EBUSY;
1779         }
1780
1781         baud = pn533_mod_to_baud(dev);
1782         if (baud < 0) {
1783                 nfc_dev_err(&dev->interface->dev,
1784                             "Invalid curr modulation %d", dev->poll_mod_curr);
1785                 return baud;
1786         }
1787
1788         cmd_len = sizeof(struct pn533_cmd_jump_dep) + gb_len;
1789         if (comm_mode == NFC_COMM_PASSIVE)
1790                 cmd_len += PASSIVE_DATA_LEN;
1791
1792         cmd = kzalloc(cmd_len, GFP_KERNEL);
1793         if (cmd == NULL)
1794                 return -ENOMEM;
1795
1796         pn533_tx_frame_init(dev->out_frame, PN533_CMD_IN_JUMP_FOR_DEP);
1797
1798         cmd->active = !comm_mode;
1799         cmd->next = 0;
1800         cmd->baud = baud;
1801         data_ptr = cmd->data;
1802         if (comm_mode == NFC_COMM_PASSIVE && cmd->baud > 0) {
1803                 memcpy(data_ptr, passive_data, PASSIVE_DATA_LEN);
1804                 cmd->next |= 1;
1805                 data_ptr += PASSIVE_DATA_LEN;
1806         }
1807
1808         if (gb != NULL && gb_len > 0) {
1809                 cmd->next |= 4; /* We have some Gi */
1810                 memcpy(data_ptr, gb, gb_len);
1811         } else {
1812                 cmd->next = 0;
1813         }
1814
1815         memcpy(PN533_FRAME_CMD_PARAMS_PTR(dev->out_frame), cmd, cmd_len);
1816         dev->out_frame->datalen += cmd_len;
1817
1818         pn533_tx_frame_finish(dev->out_frame);
1819
1820         rc = pn533_send_cmd_frame_async(dev, dev->out_frame, dev->in_frame,
1821                                 dev->in_maxlen, pn533_in_dep_link_up_complete,
1822                                 cmd, GFP_KERNEL);
1823         if (rc < 0)
1824                 kfree(cmd);
1825
1826         return rc;
1827 }
1828
1829 static int pn533_dep_link_down(struct nfc_dev *nfc_dev)
1830 {
1831         struct pn533 *dev = nfc_get_drvdata(nfc_dev);
1832
1833         pn533_poll_reset_mod_list(dev);
1834
1835         if (dev->tgt_mode || dev->tgt_active_prot) {
1836                 pn533_send_ack(dev, GFP_KERNEL);
1837                 usb_kill_urb(dev->in_urb);
1838         }
1839
1840         dev->tgt_active_prot = 0;
1841         dev->tgt_mode = 0;
1842
1843         skb_queue_purge(&dev->resp_q);
1844
1845         return 0;
1846 }
1847
1848 static int pn533_build_tx_frame(struct pn533 *dev, struct sk_buff *skb,
1849                                 bool target)
1850 {
1851         int payload_len = skb->len;
1852         struct pn533_frame *out_frame;
1853         u8 tg;
1854
1855         nfc_dev_dbg(&dev->interface->dev, "%s - Sending %d bytes", __func__,
1856                                                                 payload_len);
1857
1858         if (payload_len > PN533_CMD_DATAEXCH_DATA_MAXLEN) {
1859                 /* TODO: Implement support to multi-part data exchange */
1860                 nfc_dev_err(&dev->interface->dev, "Data length greater than the"
1861                                                 " max allowed: %d",
1862                                                 PN533_CMD_DATAEXCH_DATA_MAXLEN);
1863                 return -ENOSYS;
1864         }
1865
1866         if (target == true) {
1867                 switch (dev->device_type) {
1868                 case PN533_DEVICE_PASORI:
1869                         if (dev->tgt_active_prot == NFC_PROTO_FELICA) {
1870                                 skb_push(skb, PN533_CMD_DATAEXCH_HEAD_LEN - 1);
1871                                 out_frame = (struct pn533_frame *) skb->data;
1872                                 pn533_tx_frame_init(out_frame,
1873                                                     PN533_CMD_IN_COMM_THRU);
1874
1875                                 break;
1876                         }
1877
1878                 default:
1879                         skb_push(skb, PN533_CMD_DATAEXCH_HEAD_LEN);
1880                         out_frame = (struct pn533_frame *) skb->data;
1881                         pn533_tx_frame_init(out_frame,
1882                                             PN533_CMD_IN_DATA_EXCHANGE);
1883                         tg = 1;
1884                         memcpy(PN533_FRAME_CMD_PARAMS_PTR(out_frame),
1885                                &tg, sizeof(u8));
1886                         out_frame->datalen += sizeof(u8);
1887
1888                         break;
1889                 }
1890
1891         } else {
1892                 skb_push(skb, PN533_CMD_DATAEXCH_HEAD_LEN - 1);
1893                 out_frame = (struct pn533_frame *) skb->data;
1894                 pn533_tx_frame_init(out_frame, PN533_CMD_TG_SET_DATA);
1895         }
1896
1897
1898         /* The data is already in the out_frame, just update the datalen */
1899         out_frame->datalen += payload_len;
1900
1901         pn533_tx_frame_finish(out_frame);
1902         skb_put(skb, PN533_FRAME_TAIL_SIZE);
1903
1904         return 0;
1905 }
1906
1907 struct pn533_data_exchange_arg {
1908         struct sk_buff *skb_resp;
1909         struct sk_buff *skb_out;
1910         data_exchange_cb_t cb;
1911         void *cb_context;
1912 };
1913
1914 static struct sk_buff *pn533_build_response(struct pn533 *dev)
1915 {
1916         struct sk_buff *skb, *tmp, *t;
1917         unsigned int skb_len = 0, tmp_len = 0;
1918
1919         nfc_dev_dbg(&dev->interface->dev, "%s\n", __func__);
1920
1921         if (skb_queue_empty(&dev->resp_q))
1922                 return NULL;
1923
1924         if (skb_queue_len(&dev->resp_q) == 1) {
1925                 skb = skb_dequeue(&dev->resp_q);
1926                 goto out;
1927         }
1928
1929         skb_queue_walk_safe(&dev->resp_q, tmp, t)
1930                 skb_len += tmp->len;
1931
1932         nfc_dev_dbg(&dev->interface->dev, "%s total length %d\n",
1933                     __func__, skb_len);
1934
1935         skb = alloc_skb(skb_len, GFP_KERNEL);
1936         if (skb == NULL)
1937                 goto out;
1938
1939         skb_put(skb, skb_len);
1940
1941         skb_queue_walk_safe(&dev->resp_q, tmp, t) {
1942                 memcpy(skb->data + tmp_len, tmp->data, tmp->len);
1943                 tmp_len += tmp->len;
1944         }
1945
1946 out:
1947         skb_queue_purge(&dev->resp_q);
1948
1949         return skb;
1950 }
1951
1952 static int pn533_data_exchange_complete(struct pn533 *dev, void *_arg,
1953                                                 u8 *params, int params_len)
1954 {
1955         struct pn533_data_exchange_arg *arg = _arg;
1956         struct sk_buff *skb = NULL, *skb_resp = arg->skb_resp;
1957         struct pn533_frame *in_frame = (struct pn533_frame *) skb_resp->data;
1958         int err = 0;
1959         u8 status;
1960         u8 cmd_ret;
1961
1962         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
1963
1964         dev_kfree_skb(arg->skb_out);
1965
1966         if (params_len < 0) { /* error */
1967                 err = params_len;
1968                 goto error;
1969         }
1970
1971         status = params[0];
1972
1973         cmd_ret = status & PN533_CMD_RET_MASK;
1974         if (cmd_ret != PN533_CMD_RET_SUCCESS) {
1975                 nfc_dev_err(&dev->interface->dev, "PN533 reported error %d when"
1976                                                 " exchanging data", cmd_ret);
1977                 err = -EIO;
1978                 goto error;
1979         }
1980
1981         skb_put(skb_resp, PN533_FRAME_SIZE(in_frame));
1982         skb_pull(skb_resp, PN533_CMD_DATAEXCH_HEAD_LEN);
1983         skb_trim(skb_resp, skb_resp->len - PN533_FRAME_TAIL_SIZE);
1984         skb_queue_tail(&dev->resp_q, skb_resp);
1985
1986         if (status & PN533_CMD_MI_MASK) {
1987                 queue_work(dev->wq, &dev->mi_work);
1988                 return -EINPROGRESS;
1989         }
1990
1991         skb = pn533_build_response(dev);
1992         if (skb == NULL)
1993                 goto error;
1994
1995         arg->cb(arg->cb_context, skb, 0);
1996         kfree(arg);
1997         return 0;
1998
1999 error:
2000         skb_queue_purge(&dev->resp_q);
2001         dev_kfree_skb(skb_resp);
2002         arg->cb(arg->cb_context, NULL, err);
2003         kfree(arg);
2004         return 0;
2005 }
2006
2007 static int pn533_transceive(struct nfc_dev *nfc_dev,
2008                             struct nfc_target *target, struct sk_buff *skb,
2009                             data_exchange_cb_t cb, void *cb_context)
2010 {
2011         struct pn533 *dev = nfc_get_drvdata(nfc_dev);
2012         struct pn533_frame *out_frame, *in_frame;
2013         struct pn533_data_exchange_arg *arg;
2014         struct sk_buff *skb_resp;
2015         int skb_resp_len;
2016         int rc;
2017
2018         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
2019
2020         if (!dev->tgt_active_prot) {
2021                 nfc_dev_err(&dev->interface->dev, "Cannot exchange data if"
2022                                                 " there is no active target");
2023                 rc = -EINVAL;
2024                 goto error;
2025         }
2026
2027         rc = pn533_build_tx_frame(dev, skb, true);
2028         if (rc)
2029                 goto error;
2030
2031         skb_resp_len = PN533_CMD_DATAEXCH_HEAD_LEN +
2032                         PN533_CMD_DATAEXCH_DATA_MAXLEN +
2033                         PN533_FRAME_TAIL_SIZE;
2034
2035         skb_resp = nfc_alloc_recv_skb(skb_resp_len, GFP_KERNEL);
2036         if (!skb_resp) {
2037                 rc = -ENOMEM;
2038                 goto error;
2039         }
2040
2041         in_frame = (struct pn533_frame *) skb_resp->data;
2042         out_frame = (struct pn533_frame *) skb->data;
2043
2044         arg = kmalloc(sizeof(struct pn533_data_exchange_arg), GFP_KERNEL);
2045         if (!arg) {
2046                 rc = -ENOMEM;
2047                 goto free_skb_resp;
2048         }
2049
2050         arg->skb_resp = skb_resp;
2051         arg->skb_out = skb;
2052         arg->cb = cb;
2053         arg->cb_context = cb_context;
2054
2055         rc = pn533_send_cmd_frame_async(dev, out_frame, in_frame, skb_resp_len,
2056                                         pn533_data_exchange_complete, arg,
2057                                         GFP_KERNEL);
2058         if (rc) {
2059                 nfc_dev_err(&dev->interface->dev, "Error %d when trying to"
2060                                                 " perform data_exchange", rc);
2061                 goto free_arg;
2062         }
2063
2064         return 0;
2065
2066 free_arg:
2067         kfree(arg);
2068 free_skb_resp:
2069         kfree_skb(skb_resp);
2070 error:
2071         kfree_skb(skb);
2072         return rc;
2073 }
2074
2075 static int pn533_tm_send_complete(struct pn533 *dev, void *arg,
2076                                   u8 *params, int params_len)
2077 {
2078         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
2079
2080         if (params_len < 0) {
2081                 nfc_dev_err(&dev->interface->dev,
2082                             "Error %d when sending data",
2083                             params_len);
2084
2085                 return params_len;
2086         }
2087
2088         if (params_len > 0 && params[0] != 0) {
2089                 nfc_tm_deactivated(dev->nfc_dev);
2090
2091                 dev->tgt_mode = 0;
2092
2093                 return 0;
2094         }
2095
2096         queue_work(dev->wq, &dev->tg_work);
2097
2098         return 0;
2099 }
2100
2101 static int pn533_tm_send(struct nfc_dev *nfc_dev, struct sk_buff *skb)
2102 {
2103         struct pn533 *dev = nfc_get_drvdata(nfc_dev);
2104         struct pn533_frame *out_frame;
2105         int rc;
2106
2107         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
2108
2109         rc = pn533_build_tx_frame(dev, skb, false);
2110         if (rc)
2111                 goto error;
2112
2113         out_frame = (struct pn533_frame *) skb->data;
2114
2115         rc = pn533_send_cmd_frame_async(dev, out_frame, dev->in_frame,
2116                                         dev->in_maxlen, pn533_tm_send_complete,
2117                                         NULL, GFP_KERNEL);
2118         if (rc) {
2119                 nfc_dev_err(&dev->interface->dev,
2120                             "Error %d when trying to send data", rc);
2121                 goto error;
2122         }
2123
2124         return 0;
2125
2126 error:
2127         kfree_skb(skb);
2128
2129         return rc;
2130 }
2131
2132 static void pn533_wq_mi_recv(struct work_struct *work)
2133 {
2134         struct pn533 *dev = container_of(work, struct pn533, mi_work);
2135         struct sk_buff *skb_cmd;
2136         struct pn533_data_exchange_arg *arg = dev->cmd_complete_arg;
2137         struct pn533_frame *out_frame, *in_frame;
2138         struct sk_buff *skb_resp;
2139         int skb_resp_len;
2140         int rc;
2141
2142         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
2143
2144         /* This is a zero payload size skb */
2145         skb_cmd = alloc_skb(PN533_CMD_DATAEXCH_HEAD_LEN + PN533_FRAME_TAIL_SIZE,
2146                             GFP_KERNEL);
2147         if (skb_cmd == NULL)
2148                 goto error_cmd;
2149
2150         skb_reserve(skb_cmd, PN533_CMD_DATAEXCH_HEAD_LEN);
2151
2152         rc = pn533_build_tx_frame(dev, skb_cmd, true);
2153         if (rc)
2154                 goto error_frame;
2155
2156         skb_resp_len = PN533_CMD_DATAEXCH_HEAD_LEN +
2157                         PN533_CMD_DATAEXCH_DATA_MAXLEN +
2158                         PN533_FRAME_TAIL_SIZE;
2159         skb_resp = alloc_skb(skb_resp_len, GFP_KERNEL);
2160         if (!skb_resp) {
2161                 rc = -ENOMEM;
2162                 goto error_frame;
2163         }
2164
2165         in_frame = (struct pn533_frame *) skb_resp->data;
2166         out_frame = (struct pn533_frame *) skb_cmd->data;
2167
2168         arg->skb_resp = skb_resp;
2169         arg->skb_out = skb_cmd;
2170
2171         rc = __pn533_send_cmd_frame_async(dev, out_frame, in_frame,
2172                                           skb_resp_len,
2173                                           pn533_data_exchange_complete,
2174                                           dev->cmd_complete_arg, GFP_KERNEL);
2175         if (!rc)
2176                 return;
2177
2178         nfc_dev_err(&dev->interface->dev, "Error %d when trying to"
2179                                                 " perform data_exchange", rc);
2180
2181         kfree_skb(skb_resp);
2182
2183 error_frame:
2184         kfree_skb(skb_cmd);
2185
2186 error_cmd:
2187         pn533_send_ack(dev, GFP_KERNEL);
2188
2189         kfree(arg);
2190
2191         queue_work(dev->wq, &dev->cmd_work);
2192 }
2193
2194 static int pn533_set_configuration(struct pn533 *dev, u8 cfgitem, u8 *cfgdata,
2195                                                                 u8 cfgdata_len)
2196 {
2197         int rc;
2198         u8 *params;
2199
2200         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
2201
2202         pn533_tx_frame_init(dev->out_frame, PN533_CMD_RF_CONFIGURATION);
2203
2204         params = PN533_FRAME_CMD_PARAMS_PTR(dev->out_frame);
2205         params[0] = cfgitem;
2206         memcpy(&params[1], cfgdata, cfgdata_len);
2207         dev->out_frame->datalen += (1 + cfgdata_len);
2208
2209         pn533_tx_frame_finish(dev->out_frame);
2210
2211         rc = pn533_send_cmd_frame_sync(dev, dev->out_frame, dev->in_frame,
2212                                                                 dev->in_maxlen);
2213
2214         return rc;
2215 }
2216
2217 static int pn533_fw_reset(struct pn533 *dev)
2218 {
2219         int rc;
2220         u8 *params;
2221
2222         nfc_dev_dbg(&dev->interface->dev, "%s", __func__);
2223
2224         pn533_tx_frame_init(dev->out_frame, 0x18);
2225
2226         params = PN533_FRAME_CMD_PARAMS_PTR(dev->out_frame);
2227         params[0] = 0x1;
2228         dev->out_frame->datalen += 1;
2229
2230         pn533_tx_frame_finish(dev->out_frame);
2231
2232         rc = pn533_send_cmd_frame_sync(dev, dev->out_frame, dev->in_frame,
2233                                        dev->in_maxlen);
2234
2235         return rc;
2236 }
2237
2238 static struct nfc_ops pn533_nfc_ops = {
2239         .dev_up = NULL,
2240         .dev_down = NULL,
2241         .dep_link_up = pn533_dep_link_up,
2242         .dep_link_down = pn533_dep_link_down,
2243         .start_poll = pn533_start_poll,
2244         .stop_poll = pn533_stop_poll,
2245         .activate_target = pn533_activate_target,
2246         .deactivate_target = pn533_deactivate_target,
2247         .im_transceive = pn533_transceive,
2248         .tm_send = pn533_tm_send,
2249 };
2250
2251 static int pn533_setup(struct pn533 *dev)
2252 {
2253         struct pn533_config_max_retries max_retries;
2254         struct pn533_config_timing timing;
2255         u8 pasori_cfg[3] = {0x08, 0x01, 0x08};
2256         int rc;
2257
2258         switch (dev->device_type) {
2259         case PN533_DEVICE_STD:
2260                 max_retries.mx_rty_atr = PN533_CONFIG_MAX_RETRIES_ENDLESS;
2261                 max_retries.mx_rty_psl = 2;
2262                 max_retries.mx_rty_passive_act =
2263                         PN533_CONFIG_MAX_RETRIES_NO_RETRY;
2264
2265                 timing.rfu = PN533_CONFIG_TIMING_102;
2266                 timing.atr_res_timeout = PN533_CONFIG_TIMING_204;
2267                 timing.dep_timeout = PN533_CONFIG_TIMING_409;
2268
2269                 break;
2270
2271         case PN533_DEVICE_PASORI:
2272                 max_retries.mx_rty_atr = 0x2;
2273                 max_retries.mx_rty_psl = 0x1;
2274                 max_retries.mx_rty_passive_act =
2275                         PN533_CONFIG_MAX_RETRIES_NO_RETRY;
2276
2277                 timing.rfu = PN533_CONFIG_TIMING_102;
2278                 timing.atr_res_timeout = PN533_CONFIG_TIMING_102;
2279                 timing.dep_timeout = PN533_CONFIG_TIMING_204;
2280
2281                 break;
2282
2283         default:
2284                 nfc_dev_err(&dev->interface->dev, "Unknown device type %d\n",
2285                             dev->device_type);
2286                 return -EINVAL;
2287         }
2288
2289         rc = pn533_set_configuration(dev, PN533_CFGITEM_MAX_RETRIES,
2290                                      (u8 *)&max_retries, sizeof(max_retries));
2291         if (rc) {
2292                 nfc_dev_err(&dev->interface->dev,
2293                             "Error on setting MAX_RETRIES config");
2294                 return rc;
2295         }
2296
2297
2298         rc = pn533_set_configuration(dev, PN533_CFGITEM_TIMING,
2299                                      (u8 *)&timing, sizeof(timing));
2300         if (rc) {
2301                 nfc_dev_err(&dev->interface->dev,
2302                             "Error on setting RF timings");
2303                 return rc;
2304         }
2305
2306         switch (dev->device_type) {
2307         case PN533_DEVICE_STD:
2308                 break;
2309
2310         case PN533_DEVICE_PASORI:
2311                 pn533_fw_reset(dev);
2312
2313                 rc = pn533_set_configuration(dev, PN533_CFGITEM_PASORI,
2314                                              pasori_cfg, 3);
2315                 if (rc) {
2316                         nfc_dev_err(&dev->interface->dev,
2317                                     "Error while settings PASORI config");
2318                         return rc;
2319                 }
2320
2321                 pn533_fw_reset(dev);
2322
2323                 break;
2324         }
2325
2326         return 0;
2327 }
2328
2329 static int pn533_probe(struct usb_interface *interface,
2330                         const struct usb_device_id *id)
2331 {
2332         struct pn533_fw_version *fw_ver;
2333         struct pn533 *dev;
2334         struct usb_host_interface *iface_desc;
2335         struct usb_endpoint_descriptor *endpoint;
2336         int in_endpoint = 0;
2337         int out_endpoint = 0;
2338         int rc = -ENOMEM;
2339         int i;
2340         u32 protocols;
2341
2342         dev = kzalloc(sizeof(*dev), GFP_KERNEL);
2343         if (!dev)
2344                 return -ENOMEM;
2345
2346         dev->udev = usb_get_dev(interface_to_usbdev(interface));
2347         dev->interface = interface;
2348         mutex_init(&dev->cmd_lock);
2349
2350         iface_desc = interface->cur_altsetting;
2351         for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
2352                 endpoint = &iface_desc->endpoint[i].desc;
2353
2354                 if (!in_endpoint && usb_endpoint_is_bulk_in(endpoint)) {
2355                         dev->in_maxlen = le16_to_cpu(endpoint->wMaxPacketSize);
2356                         in_endpoint = endpoint->bEndpointAddress;
2357                 }
2358
2359                 if (!out_endpoint && usb_endpoint_is_bulk_out(endpoint)) {
2360                         dev->out_maxlen =
2361                                 le16_to_cpu(endpoint->wMaxPacketSize);
2362                         out_endpoint = endpoint->bEndpointAddress;
2363                 }
2364         }
2365
2366         if (!in_endpoint || !out_endpoint) {
2367                 nfc_dev_err(&interface->dev, "Could not find bulk-in or"
2368                                                         " bulk-out endpoint");
2369                 rc = -ENODEV;
2370                 goto error;
2371         }
2372
2373         dev->in_frame = kmalloc(dev->in_maxlen, GFP_KERNEL);
2374         dev->in_urb = usb_alloc_urb(0, GFP_KERNEL);
2375         dev->out_frame = kmalloc(dev->out_maxlen, GFP_KERNEL);
2376         dev->out_urb = usb_alloc_urb(0, GFP_KERNEL);
2377
2378         if (!dev->in_frame || !dev->out_frame ||
2379                 !dev->in_urb || !dev->out_urb)
2380                 goto error;
2381
2382         usb_fill_bulk_urb(dev->in_urb, dev->udev,
2383                         usb_rcvbulkpipe(dev->udev, in_endpoint),
2384                         NULL, 0, NULL, dev);
2385         usb_fill_bulk_urb(dev->out_urb, dev->udev,
2386                         usb_sndbulkpipe(dev->udev, out_endpoint),
2387                         NULL, 0,
2388                         pn533_send_complete, dev);
2389
2390         INIT_WORK(&dev->cmd_work, pn533_wq_cmd);
2391         INIT_WORK(&dev->cmd_complete_work, pn533_wq_cmd_complete);
2392         INIT_WORK(&dev->mi_work, pn533_wq_mi_recv);
2393         INIT_WORK(&dev->tg_work, pn533_wq_tg_get_data);
2394         INIT_WORK(&dev->poll_work, pn533_wq_poll);
2395         dev->wq = alloc_ordered_workqueue("pn533", 0);
2396         if (dev->wq == NULL)
2397                 goto error;
2398
2399         init_timer(&dev->listen_timer);
2400         dev->listen_timer.data = (unsigned long) dev;
2401         dev->listen_timer.function = pn533_listen_mode_timer;
2402
2403         skb_queue_head_init(&dev->resp_q);
2404
2405         INIT_LIST_HEAD(&dev->cmd_queue);
2406
2407         usb_set_intfdata(interface, dev);
2408
2409         pn533_tx_frame_init(dev->out_frame, PN533_CMD_GET_FIRMWARE_VERSION);
2410         pn533_tx_frame_finish(dev->out_frame);
2411
2412         rc = pn533_send_cmd_frame_sync(dev, dev->out_frame, dev->in_frame,
2413                                                                 dev->in_maxlen);
2414         if (rc)
2415                 goto destroy_wq;
2416
2417         fw_ver = (struct pn533_fw_version *)
2418                                 PN533_FRAME_CMD_PARAMS_PTR(dev->in_frame);
2419         nfc_dev_info(&dev->interface->dev, "NXP PN533 firmware ver %d.%d now"
2420                                         " attached", fw_ver->ver, fw_ver->rev);
2421
2422         dev->device_type = id->driver_info;
2423         switch (dev->device_type) {
2424         case PN533_DEVICE_STD:
2425                 protocols = PN533_ALL_PROTOCOLS;
2426                 break;
2427
2428         case PN533_DEVICE_PASORI:
2429                 protocols = PN533_NO_TYPE_B_PROTOCOLS;
2430                 break;
2431
2432         default:
2433                 nfc_dev_err(&dev->interface->dev, "Unknown device type %d\n",
2434                             dev->device_type);
2435                 rc = -EINVAL;
2436                 goto destroy_wq;
2437         }
2438
2439         dev->nfc_dev = nfc_allocate_device(&pn533_nfc_ops, protocols,
2440                                            PN533_CMD_DATAEXCH_HEAD_LEN,
2441                                            PN533_FRAME_TAIL_SIZE);
2442         if (!dev->nfc_dev)
2443                 goto destroy_wq;
2444
2445         nfc_set_parent_dev(dev->nfc_dev, &interface->dev);
2446         nfc_set_drvdata(dev->nfc_dev, dev);
2447
2448         rc = nfc_register_device(dev->nfc_dev);
2449         if (rc)
2450                 goto free_nfc_dev;
2451
2452         rc = pn533_setup(dev);
2453         if (rc)
2454                 goto unregister_nfc_dev;
2455
2456         return 0;
2457
2458 unregister_nfc_dev:
2459         nfc_unregister_device(dev->nfc_dev);
2460
2461 free_nfc_dev:
2462         nfc_free_device(dev->nfc_dev);
2463
2464 destroy_wq:
2465         destroy_workqueue(dev->wq);
2466 error:
2467         kfree(dev->in_frame);
2468         usb_free_urb(dev->in_urb);
2469         kfree(dev->out_frame);
2470         usb_free_urb(dev->out_urb);
2471         kfree(dev);
2472         return rc;
2473 }
2474
2475 static void pn533_disconnect(struct usb_interface *interface)
2476 {
2477         struct pn533 *dev;
2478         struct pn533_cmd *cmd, *n;
2479
2480         dev = usb_get_intfdata(interface);
2481         usb_set_intfdata(interface, NULL);
2482
2483         nfc_unregister_device(dev->nfc_dev);
2484         nfc_free_device(dev->nfc_dev);
2485
2486         usb_kill_urb(dev->in_urb);
2487         usb_kill_urb(dev->out_urb);
2488
2489         destroy_workqueue(dev->wq);
2490
2491         skb_queue_purge(&dev->resp_q);
2492
2493         del_timer(&dev->listen_timer);
2494
2495         list_for_each_entry_safe(cmd, n, &dev->cmd_queue, queue) {
2496                 list_del(&cmd->queue);
2497                 kfree(cmd);
2498         }
2499
2500         kfree(dev->in_frame);
2501         usb_free_urb(dev->in_urb);
2502         kfree(dev->out_frame);
2503         usb_free_urb(dev->out_urb);
2504         kfree(dev);
2505
2506         nfc_dev_info(&interface->dev, "NXP PN533 NFC device disconnected");
2507 }
2508
2509 static struct usb_driver pn533_driver = {
2510         .name =         "pn533",
2511         .probe =        pn533_probe,
2512         .disconnect =   pn533_disconnect,
2513         .id_table =     pn533_table,
2514 };
2515
2516 module_usb_driver(pn533_driver);
2517
2518 MODULE_AUTHOR("Lauro Ramos Venancio <lauro.venancio@openbossa.org>,"
2519                         " Aloisio Almeida Jr <aloisio.almeida@openbossa.org>");
2520 MODULE_DESCRIPTION("PN533 usb driver ver " VERSION);
2521 MODULE_VERSION(VERSION);
2522 MODULE_LICENSE("GPL");