net/nfc/core.c

   1 // SPDX-License-Identifier: GPL-2.0-or-later
   2 /*
   3  * Copyright (C) 2011 Instituto Nokia de Tecnologia
   4  *
   5  * Authors:
   6  *    Lauro Ramos Venancio <lauro.venancio@openbossa.org>
   7  *    Aloisio Almeida Jr <aloisio.almeida@openbossa.org>
   8  */
   9
  10 #define pr_fmt(fmt) KBUILD_MODNAME ": %s: " fmt, __func__
  11
  12 #include <linux/init.h>
  13 #include <linux/kernel.h>
  14 #include <linux/module.h>
  15 #include <linux/slab.h>
  16 #include <linux/rfkill.h>
  17 #include <linux/nfc.h>
  18
  19 #include <net/genetlink.h>
  20
  21 #include "nfc.h"
  22
  23 #define VERSION "0.1"
  24
  25 #define NFC_CHECK_PRES_FREQ_MS  2000
  26
  27 int nfc_devlist_generation;
  28 DEFINE_MUTEX(nfc_devlist_mutex);
  29
  30 /* NFC device ID bitmap */
  31 static DEFINE_IDA(nfc_index_ida);
  32
  33 int nfc_fw_download(struct nfc_dev *dev, const char *firmware_name)
  34 {
  35         int rc = 0;
  36
  37         pr_debug("%s do firmware %s\n", dev_name(&dev->dev), firmware_name);
  38
  39         device_lock(&dev->dev);
  40
  41         if (!device_is_registered(&dev->dev)) {
  42                 rc = -ENODEV;
  43                 goto error;
  44         }
  45
  46         if (dev->dev_up) {
  47                 rc = -EBUSY;
  48                 goto error;
  49         }
  50
  51         if (!dev->ops->fw_download) {
  52                 rc = -EOPNOTSUPP;
  53                 goto error;
  54         }
  55
  56         dev->fw_download_in_progress = true;
  57         rc = dev->ops->fw_download(dev, firmware_name);
  58         if (rc)
  59                 dev->fw_download_in_progress = false;
  60
  61 error:
  62         device_unlock(&dev->dev);
  63         return rc;
  64 }
  65
  66 /**
  67  * nfc_fw_download_done - inform that a firmware download was completed
  68  *
  69  * @dev: The nfc device to which firmware was downloaded
  70  * @firmware_name: The firmware filename
  71  * @result: The positive value of a standard errno value
  72  */
  73 int nfc_fw_download_done(struct nfc_dev *dev, const char *firmware_name,
  74                          u32 result)
  75 {
  76         dev->fw_download_in_progress = false;
  77
  78         return nfc_genl_fw_download_done(dev, firmware_name, result);
  79 }
  80 EXPORT_SYMBOL(nfc_fw_download_done);
  81
  82 /**
  83  * nfc_dev_up - turn on the NFC device
  84  *
  85  * @dev: The nfc device to be turned on
  86  *
  87  * The device remains up until the nfc_dev_down function is called.
  88  */
  89 int nfc_dev_up(struct nfc_dev *dev)
  90 {
  91         int rc = 0;
  92
  93         pr_debug("dev_name=%s\n", dev_name(&dev->dev));
  94
  95         device_lock(&dev->dev);
  96
  97         if (dev->rfkill && rfkill_blocked(dev->rfkill)) {
  98                 rc = -ERFKILL;
  99                 goto error;
 100         }
 101
 102         if (!device_is_registered(&dev->dev)) {
 103                 rc = -ENODEV;
 104                 goto error;
 105         }
 106
 107         if (dev->fw_download_in_progress) {
 108                 rc = -EBUSY;
 109                 goto error;
 110         }
 111
 112         if (dev->dev_up) {
 113                 rc = -EALREADY;
 114                 goto error;
 115         }
 116
 117         if (dev->ops->dev_up)
 118                 rc = dev->ops->dev_up(dev);
 119
 120         if (!rc)
 121                 dev->dev_up = true;
 122
 123         /* We have to enable the device before discovering SEs */
 124         if (dev->ops->discover_se && dev->ops->discover_se(dev))
 125                 pr_err("SE discovery failed\n");
 126
 127 error:
 128         device_unlock(&dev->dev);
 129         return rc;
 130 }
 131
 132 /**
 133  * nfc_dev_down - turn off the NFC device
 134  *
 135  * @dev: The nfc device to be turned off
 136  */
 137 int nfc_dev_down(struct nfc_dev *dev)
 138 {
 139         int rc = 0;
 140
 141         pr_debug("dev_name=%s\n", dev_name(&dev->dev));
 142
 143         device_lock(&dev->dev);
 144
 145         if (!device_is_registered(&dev->dev)) {
 146                 rc = -ENODEV;
 147                 goto error;
 148         }
 149
 150         if (!dev->dev_up) {
 151                 rc = -EALREADY;
 152                 goto error;
 153         }
 154
 155         if (dev->polling || dev->active_target) {
 156                 rc = -EBUSY;
 157                 goto error;
 158         }
 159
 160         if (dev->ops->dev_down)
 161                 dev->ops->dev_down(dev);
 162
 163         dev->dev_up = false;
 164
 165 error:
 166         device_unlock(&dev->dev);
 167         return rc;
 168 }
 169
 170 static int nfc_rfkill_set_block(void *data, bool blocked)
 171 {
 172         struct nfc_dev *dev = data;
 173
 174         pr_debug("%s blocked %d", dev_name(&dev->dev), blocked);
 175
 176         if (!blocked)
 177                 return 0;
 178
 179         nfc_dev_down(dev);
 180
 181         return 0;
 182 }
 183
 184 static const struct rfkill_ops nfc_rfkill_ops = {
 185         .set_block = nfc_rfkill_set_block,
 186 };
 187
 188 /**
 189  * nfc_start_poll - start polling for nfc targets
 190  *
 191  * @dev: The nfc device that must start polling
 192  * @im_protocols: bitset of nfc initiator protocols to be used for polling
 193  * @tm_protocols: bitset of nfc transport protocols to be used for polling
 194  *
 195  * The device remains polling for targets until a target is found or
 196  * the nfc_stop_poll function is called.
 197  */
 198 int nfc_start_poll(struct nfc_dev *dev, u32 im_protocols, u32 tm_protocols)
 199 {
 200         int rc;
 201
 202         pr_debug("dev_name %s initiator protocols 0x%x target protocols 0x%x\n",
 203                  dev_name(&dev->dev), im_protocols, tm_protocols);
 204
 205         if (!im_protocols && !tm_protocols)
 206                 return -EINVAL;
 207
 208         device_lock(&dev->dev);
 209
 210         if (!device_is_registered(&dev->dev)) {
 211                 rc = -ENODEV;
 212                 goto error;
 213         }
 214
 215         if (!dev->dev_up) {
 216                 rc = -ENODEV;
 217                 goto error;
 218         }
 219
 220         if (dev->polling) {
 221                 rc = -EBUSY;
 222                 goto error;
 223         }
 224
 225         rc = dev->ops->start_poll(dev, im_protocols, tm_protocols);
 226         if (!rc) {
 227                 dev->polling = true;
 228                 dev->rf_mode = NFC_RF_NONE;
 229         }
 230
 231 error:
 232         device_unlock(&dev->dev);
 233         return rc;
 234 }
 235
 236 /**
 237  * nfc_stop_poll - stop polling for nfc targets
 238  *
 239  * @dev: The nfc device that must stop polling
 240  */
 241 int nfc_stop_poll(struct nfc_dev *dev)
 242 {
 243         int rc = 0;
 244
 245         pr_debug("dev_name=%s\n", dev_name(&dev->dev));
 246
 247         device_lock(&dev->dev);
 248
 249         if (!device_is_registered(&dev->dev)) {
 250                 rc = -ENODEV;
 251                 goto error;
 252         }
 253
 254         if (!dev->polling) {
 255                 rc = -EINVAL;
 256                 goto error;
 257         }
 258
 259         dev->ops->stop_poll(dev);
 260         dev->polling = false;
 261         dev->rf_mode = NFC_RF_NONE;
 262
 263 error:
 264         device_unlock(&dev->dev);
 265         return rc;
 266 }
 267
 268 static struct nfc_target *nfc_find_target(struct nfc_dev *dev, u32 target_idx)
 269 {
 270         int i;
 271
 272         for (i = 0; i < dev->n_targets; i++) {
 273                 if (dev->targets[i].idx == target_idx)
 274                         return &dev->targets[i];
 275         }
 276
 277         return NULL;
 278 }
 279
 280 int nfc_dep_link_up(struct nfc_dev *dev, int target_index, u8 comm_mode)
 281 {
 282         int rc = 0;
 283         u8 *gb;
 284         size_t gb_len;
 285         struct nfc_target *target;
 286
 287         pr_debug("dev_name=%s comm %d\n", dev_name(&dev->dev), comm_mode);
 288
 289         if (!dev->ops->dep_link_up)
 290                 return -EOPNOTSUPP;
 291
 292         device_lock(&dev->dev);
 293
 294         if (!device_is_registered(&dev->dev)) {
 295                 rc = -ENODEV;
 296                 goto error;
 297         }
 298
 299         if (dev->dep_link_up == true) {
 300                 rc = -EALREADY;
 301                 goto error;
 302         }
 303
 304         gb = nfc_llcp_general_bytes(dev, &gb_len);
 305         if (gb_len > NFC_MAX_GT_LEN) {
 306                 rc = -EINVAL;
 307                 goto error;
 308         }
 309
 310         target = nfc_find_target(dev, target_index);
 311         if (target == NULL) {
 312                 rc = -ENOTCONN;
 313                 goto error;
 314         }
 315
 316         rc = dev->ops->dep_link_up(dev, target, comm_mode, gb, gb_len);
 317         if (!rc) {
 318                 dev->active_target = target;
 319                 dev->rf_mode = NFC_RF_INITIATOR;
 320         }
 321
 322 error:
 323         device_unlock(&dev->dev);
 324         return rc;
 325 }
 326
 327 int nfc_dep_link_down(struct nfc_dev *dev)
 328 {
 329         int rc = 0;
 330
 331         pr_debug("dev_name=%s\n", dev_name(&dev->dev));
 332
 333         if (!dev->ops->dep_link_down)
 334                 return -EOPNOTSUPP;
 335
 336         device_lock(&dev->dev);
 337
 338         if (!device_is_registered(&dev->dev)) {
 339                 rc = -ENODEV;
 340                 goto error;
 341         }
 342
 343         if (dev->dep_link_up == false) {
 344                 rc = -EALREADY;
 345                 goto error;
 346         }
 347
 348         rc = dev->ops->dep_link_down(dev);
 349         if (!rc) {
 350                 dev->dep_link_up = false;
 351                 dev->active_target = NULL;
 352                 dev->rf_mode = NFC_RF_NONE;
 353                 nfc_llcp_mac_is_down(dev);
 354                 nfc_genl_dep_link_down_event(dev);
 355         }
 356
 357 error:
 358         device_unlock(&dev->dev);
 359
 360         return rc;
 361 }
 362
 363 int nfc_dep_link_is_up(struct nfc_dev *dev, u32 target_idx,
 364                        u8 comm_mode, u8 rf_mode)
 365 {
 366         dev->dep_link_up = true;
 367
 368         if (!dev->active_target && rf_mode == NFC_RF_INITIATOR) {
 369                 struct nfc_target *target;
 370
 371                 target = nfc_find_target(dev, target_idx);
 372                 if (target == NULL)
 373                         return -ENOTCONN;
 374
 375                 dev->active_target = target;
 376         }
 377
 378         dev->polling = false;
 379         dev->rf_mode = rf_mode;
 380
 381         nfc_llcp_mac_is_up(dev, target_idx, comm_mode, rf_mode);
 382
 383         return nfc_genl_dep_link_up_event(dev, target_idx, comm_mode, rf_mode);
 384 }
 385 EXPORT_SYMBOL(nfc_dep_link_is_up);
 386
 387 /**
 388  * nfc_activate_target - prepare the target for data exchange
 389  *
 390  * @dev: The nfc device that found the target
 391  * @target_idx: index of the target that must be activated
 392  * @protocol: nfc protocol that will be used for data exchange
 393  */
 394 int nfc_activate_target(struct nfc_dev *dev, u32 target_idx, u32 protocol)
 395 {
 396         int rc;
 397         struct nfc_target *target;
 398
 399         pr_debug("dev_name=%s target_idx=%u protocol=%u\n",
 400                  dev_name(&dev->dev), target_idx, protocol);
 401
 402         device_lock(&dev->dev);
 403
 404         if (!device_is_registered(&dev->dev)) {
 405                 rc = -ENODEV;
 406                 goto error;
 407         }
 408
 409         if (dev->active_target) {
 410                 rc = -EBUSY;
 411                 goto error;
 412         }
 413
 414         target = nfc_find_target(dev, target_idx);
 415         if (target == NULL) {
 416                 rc = -ENOTCONN;
 417                 goto error;
 418         }
 419
 420         rc = dev->ops->activate_target(dev, target, protocol);
 421         if (!rc) {
 422                 dev->active_target = target;
 423                 dev->rf_mode = NFC_RF_INITIATOR;
 424
 425                 if (dev->ops->check_presence && !dev->shutting_down)
 426                         mod_timer(&dev->check_pres_timer, jiffies +
 427                                   msecs_to_jiffies(NFC_CHECK_PRES_FREQ_MS));
 428         }
 429
 430 error:
 431         device_unlock(&dev->dev);
 432         return rc;
 433 }
 434
 435 /**
 436  * nfc_deactivate_target - deactivate a nfc target
 437  *
 438  * @dev: The nfc device that found the target
 439  * @target_idx: index of the target that must be deactivated
 440  * @mode: idle or sleep?
 441  */
 442 int nfc_deactivate_target(struct nfc_dev *dev, u32 target_idx, u8 mode)
 443 {
 444         int rc = 0;
 445
 446         pr_debug("dev_name=%s target_idx=%u\n",
 447                  dev_name(&dev->dev), target_idx);
 448
 449         device_lock(&dev->dev);
 450
 451         if (!device_is_registered(&dev->dev)) {
 452                 rc = -ENODEV;
 453                 goto error;
 454         }
 455
 456         if (dev->active_target == NULL) {
 457                 rc = -ENOTCONN;
 458                 goto error;
 459         }
 460
 461         if (dev->active_target->idx != target_idx) {
 462                 rc = -ENOTCONN;
 463                 goto error;
 464         }
 465
 466         if (dev->ops->check_presence)
 467                 del_timer_sync(&dev->check_pres_timer);
 468
 469         dev->ops->deactivate_target(dev, dev->active_target, mode);
 470         dev->active_target = NULL;
 471
 472 error:
 473         device_unlock(&dev->dev);
 474         return rc;
 475 }
 476
 477 /**
 478  * nfc_data_exchange - transceive data
 479  *
 480  * @dev: The nfc device that found the target
 481  * @target_idx: index of the target
 482  * @skb: data to be sent
 483  * @cb: callback called when the response is received
 484  * @cb_context: parameter for the callback function
 485  *
 486  * The user must wait for the callback before calling this function again.
 487  */
 488 int nfc_data_exchange(struct nfc_dev *dev, u32 target_idx, struct sk_buff *skb,
 489                       data_exchange_cb_t cb, void *cb_context)
 490 {
 491         int rc;
 492
 493         pr_debug("dev_name=%s target_idx=%u skb->len=%u\n",
 494                  dev_name(&dev->dev), target_idx, skb->len);
 495
 496         device_lock(&dev->dev);
 497
 498         if (!device_is_registered(&dev->dev)) {
 499                 rc = -ENODEV;
 500                 kfree_skb(skb);
 501                 goto error;
 502         }
 503
 504         if (dev->rf_mode == NFC_RF_INITIATOR && dev->active_target != NULL) {
 505                 if (dev->active_target->idx != target_idx) {
 506                         rc = -EADDRNOTAVAIL;
 507                         kfree_skb(skb);
 508                         goto error;
 509                 }
 510
 511                 if (dev->ops->check_presence)
 512                         del_timer_sync(&dev->check_pres_timer);
 513
 514                 rc = dev->ops->im_transceive(dev, dev->active_target, skb, cb,
 515                                              cb_context);
 516
 517                 if (!rc && dev->ops->check_presence && !dev->shutting_down)
 518                         mod_timer(&dev->check_pres_timer, jiffies +
 519                                   msecs_to_jiffies(NFC_CHECK_PRES_FREQ_MS));
 520         } else if (dev->rf_mode == NFC_RF_TARGET && dev->ops->tm_send != NULL) {
 521                 rc = dev->ops->tm_send(dev, skb);
 522         } else {
 523                 rc = -ENOTCONN;
 524                 kfree_skb(skb);
 525                 goto error;
 526         }
 527
 528
 529 error:
 530         device_unlock(&dev->dev);
 531         return rc;
 532 }
 533
 534 struct nfc_se *nfc_find_se(struct nfc_dev *dev, u32 se_idx)
 535 {
 536         struct nfc_se *se;
 537
 538         list_for_each_entry(se, &dev->secure_elements, list)
 539                 if (se->idx == se_idx)
 540                         return se;
 541
 542         return NULL;
 543 }
 544 EXPORT_SYMBOL(nfc_find_se);
 545
 546 int nfc_enable_se(struct nfc_dev *dev, u32 se_idx)
 547 {
 548         struct nfc_se *se;
 549         int rc;
 550
 551         pr_debug("%s se index %d\n", dev_name(&dev->dev), se_idx);
 552
 553         device_lock(&dev->dev);
 554
 555         if (!device_is_registered(&dev->dev)) {
 556                 rc = -ENODEV;
 557                 goto error;
 558         }
 559
 560         if (!dev->dev_up) {
 561                 rc = -ENODEV;
 562                 goto error;
 563         }
 564
 565         if (dev->polling) {
 566                 rc = -EBUSY;
 567                 goto error;
 568         }
 569
 570         if (!dev->ops->enable_se || !dev->ops->disable_se) {
 571                 rc = -EOPNOTSUPP;
 572                 goto error;
 573         }
 574
 575         se = nfc_find_se(dev, se_idx);
 576         if (!se) {
 577                 rc = -EINVAL;
 578                 goto error;
 579         }
 580
 581         if (se->state == NFC_SE_ENABLED) {
 582                 rc = -EALREADY;
 583                 goto error;
 584         }
 585
 586         rc = dev->ops->enable_se(dev, se_idx);
 587         if (rc >= 0)
 588                 se->state = NFC_SE_ENABLED;
 589
 590 error:
 591         device_unlock(&dev->dev);
 592         return rc;
 593 }
 594
 595 int nfc_disable_se(struct nfc_dev *dev, u32 se_idx)
 596 {
 597         struct nfc_se *se;
 598         int rc;
 599
 600         pr_debug("%s se index %d\n", dev_name(&dev->dev), se_idx);
 601
 602         device_lock(&dev->dev);
 603
 604         if (!device_is_registered(&dev->dev)) {
 605                 rc = -ENODEV;
 606                 goto error;
 607         }
 608
 609         if (!dev->dev_up) {
 610                 rc = -ENODEV;
 611                 goto error;
 612         }
 613
 614         if (!dev->ops->enable_se || !dev->ops->disable_se) {
 615                 rc = -EOPNOTSUPP;
 616                 goto error;
 617         }
 618
 619         se = nfc_find_se(dev, se_idx);
 620         if (!se) {
 621                 rc = -EINVAL;
 622                 goto error;
 623         }
 624
 625         if (se->state == NFC_SE_DISABLED) {
 626                 rc = -EALREADY;
 627                 goto error;
 628         }
 629
 630         rc = dev->ops->disable_se(dev, se_idx);
 631         if (rc >= 0)
 632                 se->state = NFC_SE_DISABLED;
 633
 634 error:
 635         device_unlock(&dev->dev);
 636         return rc;
 637 }
 638
 639 int nfc_set_remote_general_bytes(struct nfc_dev *dev, const u8 *gb, u8 gb_len)
 640 {
 641         pr_debug("dev_name=%s gb_len=%d\n", dev_name(&dev->dev), gb_len);
 642
 643         return nfc_llcp_set_remote_gb(dev, gb, gb_len);
 644 }
 645 EXPORT_SYMBOL(nfc_set_remote_general_bytes);
 646
 647 u8 *nfc_get_local_general_bytes(struct nfc_dev *dev, size_t *gb_len)
 648 {
 649         pr_debug("dev_name=%s\n", dev_name(&dev->dev));
 650
 651         return nfc_llcp_general_bytes(dev, gb_len);
 652 }
 653 EXPORT_SYMBOL(nfc_get_local_general_bytes);
 654
 655 int nfc_tm_data_received(struct nfc_dev *dev, struct sk_buff *skb)
 656 {
 657         /* Only LLCP target mode for now */
 658         if (dev->dep_link_up == false) {
 659                 kfree_skb(skb);
 660                 return -ENOLINK;
 661         }
 662
 663         return nfc_llcp_data_received(dev, skb);
 664 }
 665 EXPORT_SYMBOL(nfc_tm_data_received);
 666
 667 int nfc_tm_activated(struct nfc_dev *dev, u32 protocol, u8 comm_mode,
 668                      const u8 *gb, size_t gb_len)
 669 {
 670         int rc;
 671
 672         device_lock(&dev->dev);
 673
 674         dev->polling = false;
 675
 676         if (gb != NULL) {
 677                 rc = nfc_set_remote_general_bytes(dev, gb, gb_len);
 678                 if (rc < 0)
 679                         goto out;
 680         }
 681
 682         dev->rf_mode = NFC_RF_TARGET;
 683
 684         if (protocol == NFC_PROTO_NFC_DEP_MASK)
 685                 nfc_dep_link_is_up(dev, 0, comm_mode, NFC_RF_TARGET);
 686
 687         rc = nfc_genl_tm_activated(dev, protocol);
 688
 689 out:
 690         device_unlock(&dev->dev);
 691
 692         return rc;
 693 }
 694 EXPORT_SYMBOL(nfc_tm_activated);
 695
 696 int nfc_tm_deactivated(struct nfc_dev *dev)
 697 {
 698         dev->dep_link_up = false;
 699         dev->rf_mode = NFC_RF_NONE;
 700
 701         return nfc_genl_tm_deactivated(dev);
 702 }
 703 EXPORT_SYMBOL(nfc_tm_deactivated);
 704
 705 /**
 706  * nfc_alloc_send_skb - allocate a skb for data exchange responses
 707  *
 708  * @dev: device sending the response
 709  * @sk: socket sending the response
 710  * @flags: MSG_DONTWAIT flag
 711  * @size: size to allocate
 712  * @err: pointer to memory to store the error code
 713  */
 714 struct sk_buff *nfc_alloc_send_skb(struct nfc_dev *dev, struct sock *sk,
 715                                    unsigned int flags, unsigned int size,
 716                                    unsigned int *err)
 717 {
 718         struct sk_buff *skb;
 719         unsigned int total_size;
 720
 721         total_size = size +
 722                 dev->tx_headroom + dev->tx_tailroom + NFC_HEADER_SIZE;
 723
 724         skb = sock_alloc_send_skb(sk, total_size, flags & MSG_DONTWAIT, err);
 725         if (skb)
 726                 skb_reserve(skb, dev->tx_headroom + NFC_HEADER_SIZE);
 727
 728         return skb;
 729 }
 730
 731 /**
 732  * nfc_alloc_recv_skb - allocate a skb for data exchange responses
 733  *
 734  * @size: size to allocate
 735  * @gfp: gfp flags
 736  */
 737 struct sk_buff *nfc_alloc_recv_skb(unsigned int size, gfp_t gfp)
 738 {
 739         struct sk_buff *skb;
 740         unsigned int total_size;
 741
 742         total_size = size + 1;
 743         skb = alloc_skb(total_size, gfp);
 744
 745         if (skb)
 746                 skb_reserve(skb, 1);
 747
 748         return skb;
 749 }
 750 EXPORT_SYMBOL(nfc_alloc_recv_skb);
 751
 752 /**
 753  * nfc_targets_found - inform that targets were found
 754  *
 755  * @dev: The nfc device that found the targets
 756  * @targets: array of nfc targets found
 757  * @n_targets: targets array size
 758  *
 759  * The device driver must call this function when one or many nfc targets
 760  * are found. After calling this function, the device driver must stop
 761  * polling for targets.
 762  * NOTE: This function can be called with targets=NULL and n_targets=0 to
 763  * notify a driver error, meaning that the polling operation cannot complete.
 764  * IMPORTANT: this function must not be called from an atomic context.
 765  * In addition, it must also not be called from a context that would prevent
 766  * the NFC Core to call other nfc ops entry point concurrently.
 767  */
 768 int nfc_targets_found(struct nfc_dev *dev,
 769                       struct nfc_target *targets, int n_targets)
 770 {
 771         int i;
 772
 773         pr_debug("dev_name=%s n_targets=%d\n", dev_name(&dev->dev), n_targets);
 774
 775         for (i = 0; i < n_targets; i++)
 776                 targets[i].idx = dev->target_next_idx++;
 777
 778         device_lock(&dev->dev);
 779
 780         if (dev->polling == false) {
 781                 device_unlock(&dev->dev);
 782                 return 0;
 783         }
 784
 785         dev->polling = false;
 786
 787         dev->targets_generation++;
 788
 789         kfree(dev->targets);
 790         dev->targets = NULL;
 791
 792         if (targets) {
 793                 dev->targets = kmemdup(targets,
 794                                        n_targets * sizeof(struct nfc_target),
 795                                        GFP_ATOMIC);
 796
 797                 if (!dev->targets) {
 798                         dev->n_targets = 0;
 799                         device_unlock(&dev->dev);
 800                         return -ENOMEM;
 801                 }
 802         }
 803
 804         dev->n_targets = n_targets;
 805         device_unlock(&dev->dev);
 806
 807         nfc_genl_targets_found(dev);
 808
 809         return 0;
 810 }
 811 EXPORT_SYMBOL(nfc_targets_found);
 812
 813 /**
 814  * nfc_target_lost - inform that an activated target went out of field
 815  *
 816  * @dev: The nfc device that had the activated target in field
 817  * @target_idx: the nfc index of the target
 818  *
 819  * The device driver must call this function when the activated target
 820  * goes out of the field.
 821  * IMPORTANT: this function must not be called from an atomic context.
 822  * In addition, it must also not be called from a context that would prevent
 823  * the NFC Core to call other nfc ops entry point concurrently.
 824  */
 825 int nfc_target_lost(struct nfc_dev *dev, u32 target_idx)
 826 {
 827         const struct nfc_target *tg;
 828         int i;
 829
 830         pr_debug("dev_name %s n_target %d\n", dev_name(&dev->dev), target_idx);
 831
 832         device_lock(&dev->dev);
 833
 834         for (i = 0; i < dev->n_targets; i++) {
 835                 tg = &dev->targets[i];
 836                 if (tg->idx == target_idx)
 837                         break;
 838         }
 839
 840         if (i == dev->n_targets) {
 841                 device_unlock(&dev->dev);
 842                 return -EINVAL;
 843         }
 844
 845         dev->targets_generation++;
 846         dev->n_targets--;
 847         dev->active_target = NULL;
 848
 849         if (dev->n_targets) {
 850                 memcpy(&dev->targets[i], &dev->targets[i + 1],
 851                        (dev->n_targets - i) * sizeof(struct nfc_target));
 852         } else {
 853                 kfree(dev->targets);
 854                 dev->targets = NULL;
 855         }
 856
 857         device_unlock(&dev->dev);
 858
 859         nfc_genl_target_lost(dev, target_idx);
 860
 861         return 0;
 862 }
 863 EXPORT_SYMBOL(nfc_target_lost);
 864
 865 inline void nfc_driver_failure(struct nfc_dev *dev, int err)
 866 {
 867         nfc_targets_found(dev, NULL, 0);
 868 }
 869 EXPORT_SYMBOL(nfc_driver_failure);
 870
 871 int nfc_add_se(struct nfc_dev *dev, u32 se_idx, u16 type)
 872 {
 873         struct nfc_se *se;
 874         int rc;
 875
 876         pr_debug("%s se index %d\n", dev_name(&dev->dev), se_idx);
 877
 878         se = nfc_find_se(dev, se_idx);
 879         if (se)
 880                 return -EALREADY;
 881
 882         se = kzalloc(sizeof(struct nfc_se), GFP_KERNEL);
 883         if (!se)
 884                 return -ENOMEM;
 885
 886         se->idx = se_idx;
 887         se->type = type;
 888         se->state = NFC_SE_DISABLED;
 889         INIT_LIST_HEAD(&se->list);
 890
 891         list_add(&se->list, &dev->secure_elements);
 892
 893         rc = nfc_genl_se_added(dev, se_idx, type);
 894         if (rc < 0) {
 895                 list_del(&se->list);
 896                 kfree(se);
 897
 898                 return rc;
 899         }
 900
 901         return 0;
 902 }
 903 EXPORT_SYMBOL(nfc_add_se);
 904
 905 int nfc_remove_se(struct nfc_dev *dev, u32 se_idx)
 906 {
 907         struct nfc_se *se, *n;
 908         int rc;
 909
 910         pr_debug("%s se index %d\n", dev_name(&dev->dev), se_idx);
 911
 912         list_for_each_entry_safe(se, n, &dev->secure_elements, list)
 913                 if (se->idx == se_idx) {
 914                         rc = nfc_genl_se_removed(dev, se_idx);
 915                         if (rc < 0)
 916                                 return rc;
 917
 918                         list_del(&se->list);
 919                         kfree(se);
 920
 921                         return 0;
 922                 }
 923
 924         return -EINVAL;
 925 }
 926 EXPORT_SYMBOL(nfc_remove_se);
 927
 928 int nfc_se_transaction(struct nfc_dev *dev, u8 se_idx,
 929                        struct nfc_evt_transaction *evt_transaction)
 930 {
 931         int rc;
 932
 933         pr_debug("transaction: %x\n", se_idx);
 934
 935         device_lock(&dev->dev);
 936
 937         if (!evt_transaction) {
 938                 rc = -EPROTO;
 939                 goto out;
 940         }
 941
 942         rc = nfc_genl_se_transaction(dev, se_idx, evt_transaction);
 943 out:
 944         device_unlock(&dev->dev);
 945         return rc;
 946 }
 947 EXPORT_SYMBOL(nfc_se_transaction);
 948
 949 int nfc_se_connectivity(struct nfc_dev *dev, u8 se_idx)
 950 {
 951         int rc;
 952
 953         pr_debug("connectivity: %x\n", se_idx);
 954
 955         device_lock(&dev->dev);
 956         rc = nfc_genl_se_connectivity(dev, se_idx);
 957         device_unlock(&dev->dev);
 958         return rc;
 959 }
 960 EXPORT_SYMBOL(nfc_se_connectivity);
 961
 962 static void nfc_release(struct device *d)
 963 {
 964         struct nfc_dev *dev = to_nfc_dev(d);
 965         struct nfc_se *se, *n;
 966
 967         pr_debug("dev_name=%s\n", dev_name(&dev->dev));
 968
 969         nfc_genl_data_exit(&dev->genl_data);
 970         kfree(dev->targets);
 971
 972         list_for_each_entry_safe(se, n, &dev->secure_elements, list) {
 973                         nfc_genl_se_removed(dev, se->idx);
 974                         list_del(&se->list);
 975                         kfree(se);
 976         }
 977
 978         ida_simple_remove(&nfc_index_ida, dev->idx);
 979
 980         kfree(dev);
 981 }
 982
 983 static void nfc_check_pres_work(struct work_struct *work)
 984 {
 985         struct nfc_dev *dev = container_of(work, struct nfc_dev,
 986                                            check_pres_work);
 987         int rc;
 988
 989         device_lock(&dev->dev);
 990
 991         if (dev->active_target && timer_pending(&dev->check_pres_timer) == 0) {
 992                 rc = dev->ops->check_presence(dev, dev->active_target);
 993                 if (rc == -EOPNOTSUPP)
 994                         goto exit;
 995                 if (rc) {
 996                         u32 active_target_idx = dev->active_target->idx;
 997                         device_unlock(&dev->dev);
 998                         nfc_target_lost(dev, active_target_idx);
 999                         return;
1000                 }
1001
1002                 if (!dev->shutting_down)
1003                         mod_timer(&dev->check_pres_timer, jiffies +
1004                                   msecs_to_jiffies(NFC_CHECK_PRES_FREQ_MS));
1005         }
1006
1007 exit:
1008         device_unlock(&dev->dev);
1009 }
1010
1011 static void nfc_check_pres_timeout(struct timer_list *t)
1012 {
1013         struct nfc_dev *dev = from_timer(dev, t, check_pres_timer);
1014
1015         schedule_work(&dev->check_pres_work);
1016 }
1017
1018 struct class nfc_class = {
1019         .name = "nfc",
1020         .dev_release = nfc_release,
1021 };
1022 EXPORT_SYMBOL(nfc_class);
1023
1024 static int match_idx(struct device *d, const void *data)
1025 {
1026         struct nfc_dev *dev = to_nfc_dev(d);
1027         const unsigned int *idx = data;
1028
1029         return dev->idx == *idx;
1030 }
1031
1032 struct nfc_dev *nfc_get_device(unsigned int idx)
1033 {
1034         struct device *d;
1035
1036         d = class_find_device(&nfc_class, NULL, &idx, match_idx);
1037         if (!d)
1038                 return NULL;
1039
1040         return to_nfc_dev(d);
1041 }
1042
1043 /**
1044  * nfc_allocate_device - allocate a new nfc device
1045  *
1046  * @ops: device operations
1047  * @supported_protocols: NFC protocols supported by the device
1048  * @tx_headroom: reserved space at beginning of skb
1049  * @tx_tailroom: reserved space at end of skb
1050  */
1051 struct nfc_dev *nfc_allocate_device(const struct nfc_ops *ops,
1052                                     u32 supported_protocols,
1053                                     int tx_headroom, int tx_tailroom)
1054 {
1055         struct nfc_dev *dev;
1056         int rc;
1057
1058         if (!ops->start_poll || !ops->stop_poll || !ops->activate_target ||
1059             !ops->deactivate_target || !ops->im_transceive)
1060                 return NULL;
1061
1062         if (!supported_protocols)
1063                 return NULL;
1064
1065         dev = kzalloc(sizeof(struct nfc_dev), GFP_KERNEL);
1066         if (!dev)
1067                 return NULL;
1068
1069         rc = ida_simple_get(&nfc_index_ida, 0, 0, GFP_KERNEL);
1070         if (rc < 0)
1071                 goto err_free_dev;
1072         dev->idx = rc;
1073
1074         dev->dev.class = &nfc_class;
1075         dev_set_name(&dev->dev, "nfc%d", dev->idx);
1076         device_initialize(&dev->dev);
1077
1078         dev->ops = ops;
1079         dev->supported_protocols = supported_protocols;
1080         dev->tx_headroom = tx_headroom;
1081         dev->tx_tailroom = tx_tailroom;
1082         INIT_LIST_HEAD(&dev->secure_elements);
1083
1084         nfc_genl_data_init(&dev->genl_data);
1085
1086         dev->rf_mode = NFC_RF_NONE;
1087
1088         /* first generation must not be 0 */
1089         dev->targets_generation = 1;
1090
1091         if (ops->check_presence) {
1092                 timer_setup(&dev->check_pres_timer, nfc_check_pres_timeout, 0);
1093                 INIT_WORK(&dev->check_pres_work, nfc_check_pres_work);
1094         }
1095
1096         return dev;
1097
1098 err_free_dev:
1099         kfree(dev);
1100
1101         return NULL;
1102 }
1103 EXPORT_SYMBOL(nfc_allocate_device);
1104
1105 /**
1106  * nfc_register_device - register a nfc device in the nfc subsystem
1107  *
1108  * @dev: The nfc device to register
1109  */
1110 int nfc_register_device(struct nfc_dev *dev)
1111 {
1112         int rc;
1113
1114         pr_debug("dev_name=%s\n", dev_name(&dev->dev));
1115
1116         mutex_lock(&nfc_devlist_mutex);
1117         nfc_devlist_generation++;
1118         rc = device_add(&dev->dev);
1119         mutex_unlock(&nfc_devlist_mutex);
1120
1121         if (rc < 0)
1122                 return rc;
1123
1124         rc = nfc_llcp_register_device(dev);
1125         if (rc)
1126                 pr_err("Could not register llcp device\n");
1127
1128         rc = nfc_genl_device_added(dev);
1129         if (rc)
1130                 pr_debug("The userspace won't be notified that the device %s was added\n",
1131                          dev_name(&dev->dev));
1132
1133         dev->rfkill = rfkill_alloc(dev_name(&dev->dev), &dev->dev,
1134                                    RFKILL_TYPE_NFC, &nfc_rfkill_ops, dev);
1135         if (dev->rfkill) {
1136                 if (rfkill_register(dev->rfkill) < 0) {
1137                         rfkill_destroy(dev->rfkill);
1138                         dev->rfkill = NULL;
1139                 }
1140         }
1141
1142         return 0;
1143 }
1144 EXPORT_SYMBOL(nfc_register_device);
1145
1146 /**
1147  * nfc_unregister_device - unregister a nfc device in the nfc subsystem
1148  *
1149  * @dev: The nfc device to unregister
1150  */
1151 void nfc_unregister_device(struct nfc_dev *dev)
1152 {
1153         int rc;
1154
1155         pr_debug("dev_name=%s\n", dev_name(&dev->dev));
1156
1157         if (dev->rfkill) {
1158                 rfkill_unregister(dev->rfkill);
1159                 rfkill_destroy(dev->rfkill);
1160         }
1161
1162         if (dev->ops->check_presence) {
1163                 device_lock(&dev->dev);
1164                 dev->shutting_down = true;
1165                 device_unlock(&dev->dev);
1166                 del_timer_sync(&dev->check_pres_timer);
1167                 cancel_work_sync(&dev->check_pres_work);
1168         }
1169
1170         rc = nfc_genl_device_removed(dev);
1171         if (rc)
1172                 pr_debug("The userspace won't be notified that the device %s "
1173                          "was removed\n", dev_name(&dev->dev));
1174
1175         nfc_llcp_unregister_device(dev);
1176
1177         mutex_lock(&nfc_devlist_mutex);
1178         nfc_devlist_generation++;
1179         device_del(&dev->dev);
1180         mutex_unlock(&nfc_devlist_mutex);
1181 }
1182 EXPORT_SYMBOL(nfc_unregister_device);
1183
1184 static int __init nfc_init(void)
1185 {
1186         int rc;
1187
1188         pr_info("NFC Core ver %s\n", VERSION);
1189
1190         rc = class_register(&nfc_class);
1191         if (rc)
1192                 return rc;
1193
1194         rc = nfc_genl_init();
1195         if (rc)
1196                 goto err_genl;
1197
1198         /* the first generation must not be 0 */
1199         nfc_devlist_generation = 1;
1200
1201         rc = rawsock_init();
1202         if (rc)
1203                 goto err_rawsock;
1204
1205         rc = nfc_llcp_init();
1206         if (rc)
1207                 goto err_llcp_sock;
1208
1209         rc = af_nfc_init();
1210         if (rc)
1211                 goto err_af_nfc;
1212
1213         return 0;
1214
1215 err_af_nfc:
1216         nfc_llcp_exit();
1217 err_llcp_sock:
1218         rawsock_exit();
1219 err_rawsock:
1220         nfc_genl_exit();
1221 err_genl:
1222         class_unregister(&nfc_class);
1223         return rc;
1224 }
1225
1226 static void __exit nfc_exit(void)
1227 {
1228         af_nfc_exit();
1229         nfc_llcp_exit();
1230         rawsock_exit();
1231         nfc_genl_exit();
1232         class_unregister(&nfc_class);
1233 }
1234
1235 subsys_initcall(nfc_init);
1236 module_exit(nfc_exit);
1237
1238 MODULE_AUTHOR("Lauro Ramos Venancio <lauro.venancio@openbossa.org>");
1239 MODULE_DESCRIPTION("NFC Core ver " VERSION);
1240 MODULE_VERSION(VERSION);
1241 MODULE_LICENSE("GPL");
1242 MODULE_ALIAS_NETPROTO(PF_NFC);
1243 MODULE_ALIAS_GENL_FAMILY(NFC_GENL_NAME);