123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206120712081209121012111212121312141215121612171218121912201221122212231224122512261227122812291230123112321233123412351236123712381239 |
- // SPDX-License-Identifier: GPL-2.0-or-later
- /*
- * Copyright (C) 2011 Instituto Nokia de Tecnologia
- *
- * Authors:
- * Lauro Ramos Venancio <lauro.venancio@openbossa.org>
- * Aloisio Almeida Jr <aloisio.almeida@openbossa.org>
- */
- #define pr_fmt(fmt) KBUILD_MODNAME ": %s: " fmt, __func__
- #include <linux/init.h>
- #include <linux/kernel.h>
- #include <linux/module.h>
- #include <linux/slab.h>
- #include <linux/rfkill.h>
- #include <linux/nfc.h>
- #include <net/genetlink.h>
- #include "nfc.h"
- #define VERSION "0.1"
- #define NFC_CHECK_PRES_FREQ_MS 2000
- int nfc_devlist_generation;
- DEFINE_MUTEX(nfc_devlist_mutex);
- /* NFC device ID bitmap */
- static DEFINE_IDA(nfc_index_ida);
- int nfc_fw_download(struct nfc_dev *dev, const char *firmware_name)
- {
- int rc = 0;
- pr_debug("%s do firmware %s\n", dev_name(&dev->dev), firmware_name);
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (dev->dev_up) {
- rc = -EBUSY;
- goto error;
- }
- if (!dev->ops->fw_download) {
- rc = -EOPNOTSUPP;
- goto error;
- }
- dev->fw_download_in_progress = true;
- rc = dev->ops->fw_download(dev, firmware_name);
- if (rc)
- dev->fw_download_in_progress = false;
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- /**
- * nfc_fw_download_done - inform that a firmware download was completed
- *
- * @dev: The nfc device to which firmware was downloaded
- * @firmware_name: The firmware filename
- * @result: The positive value of a standard errno value
- */
- int nfc_fw_download_done(struct nfc_dev *dev, const char *firmware_name,
- u32 result)
- {
- dev->fw_download_in_progress = false;
- return nfc_genl_fw_download_done(dev, firmware_name, result);
- }
- EXPORT_SYMBOL(nfc_fw_download_done);
- /**
- * nfc_dev_up - turn on the NFC device
- *
- * @dev: The nfc device to be turned on
- *
- * The device remains up until the nfc_dev_down function is called.
- */
- int nfc_dev_up(struct nfc_dev *dev)
- {
- int rc = 0;
- pr_debug("dev_name=%s\n", dev_name(&dev->dev));
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (dev->rfkill && rfkill_blocked(dev->rfkill)) {
- rc = -ERFKILL;
- goto error;
- }
- if (dev->fw_download_in_progress) {
- rc = -EBUSY;
- goto error;
- }
- if (dev->dev_up) {
- rc = -EALREADY;
- goto error;
- }
- if (dev->ops->dev_up)
- rc = dev->ops->dev_up(dev);
- if (!rc)
- dev->dev_up = true;
- /* We have to enable the device before discovering SEs */
- if (dev->ops->discover_se && dev->ops->discover_se(dev))
- pr_err("SE discovery failed\n");
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- /**
- * nfc_dev_down - turn off the NFC device
- *
- * @dev: The nfc device to be turned off
- */
- int nfc_dev_down(struct nfc_dev *dev)
- {
- int rc = 0;
- pr_debug("dev_name=%s\n", dev_name(&dev->dev));
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (!dev->dev_up) {
- rc = -EALREADY;
- goto error;
- }
- if (dev->polling || dev->active_target) {
- rc = -EBUSY;
- goto error;
- }
- if (dev->ops->dev_down)
- dev->ops->dev_down(dev);
- dev->dev_up = false;
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- static int nfc_rfkill_set_block(void *data, bool blocked)
- {
- struct nfc_dev *dev = data;
- pr_debug("%s blocked %d", dev_name(&dev->dev), blocked);
- if (!blocked)
- return 0;
- nfc_dev_down(dev);
- return 0;
- }
- static const struct rfkill_ops nfc_rfkill_ops = {
- .set_block = nfc_rfkill_set_block,
- };
- /**
- * nfc_start_poll - start polling for nfc targets
- *
- * @dev: The nfc device that must start polling
- * @protocols: bitset of nfc protocols that must be used for polling
- *
- * The device remains polling for targets until a target is found or
- * the nfc_stop_poll function is called.
- */
- int nfc_start_poll(struct nfc_dev *dev, u32 im_protocols, u32 tm_protocols)
- {
- int rc;
- pr_debug("dev_name %s initiator protocols 0x%x target protocols 0x%x\n",
- dev_name(&dev->dev), im_protocols, tm_protocols);
- if (!im_protocols && !tm_protocols)
- return -EINVAL;
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (!dev->dev_up) {
- rc = -ENODEV;
- goto error;
- }
- if (dev->polling) {
- rc = -EBUSY;
- goto error;
- }
- rc = dev->ops->start_poll(dev, im_protocols, tm_protocols);
- if (!rc) {
- dev->polling = true;
- dev->rf_mode = NFC_RF_NONE;
- }
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- /**
- * nfc_stop_poll - stop polling for nfc targets
- *
- * @dev: The nfc device that must stop polling
- */
- int nfc_stop_poll(struct nfc_dev *dev)
- {
- int rc = 0;
- pr_debug("dev_name=%s\n", dev_name(&dev->dev));
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (!dev->polling) {
- rc = -EINVAL;
- goto error;
- }
- dev->ops->stop_poll(dev);
- dev->polling = false;
- dev->rf_mode = NFC_RF_NONE;
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- static struct nfc_target *nfc_find_target(struct nfc_dev *dev, u32 target_idx)
- {
- int i;
- for (i = 0; i < dev->n_targets; i++) {
- if (dev->targets[i].idx == target_idx)
- return &dev->targets[i];
- }
- return NULL;
- }
- int nfc_dep_link_up(struct nfc_dev *dev, int target_index, u8 comm_mode)
- {
- int rc = 0;
- u8 *gb;
- size_t gb_len;
- struct nfc_target *target;
- pr_debug("dev_name=%s comm %d\n", dev_name(&dev->dev), comm_mode);
- if (!dev->ops->dep_link_up)
- return -EOPNOTSUPP;
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (dev->dep_link_up == true) {
- rc = -EALREADY;
- goto error;
- }
- gb = nfc_llcp_general_bytes(dev, &gb_len);
- if (gb_len > NFC_MAX_GT_LEN) {
- rc = -EINVAL;
- goto error;
- }
- target = nfc_find_target(dev, target_index);
- if (target == NULL) {
- rc = -ENOTCONN;
- goto error;
- }
- rc = dev->ops->dep_link_up(dev, target, comm_mode, gb, gb_len);
- if (!rc) {
- dev->active_target = target;
- dev->rf_mode = NFC_RF_INITIATOR;
- }
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- int nfc_dep_link_down(struct nfc_dev *dev)
- {
- int rc = 0;
- pr_debug("dev_name=%s\n", dev_name(&dev->dev));
- if (!dev->ops->dep_link_down)
- return -EOPNOTSUPP;
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (dev->dep_link_up == false) {
- rc = -EALREADY;
- goto error;
- }
- rc = dev->ops->dep_link_down(dev);
- if (!rc) {
- dev->dep_link_up = false;
- dev->active_target = NULL;
- dev->rf_mode = NFC_RF_NONE;
- nfc_llcp_mac_is_down(dev);
- nfc_genl_dep_link_down_event(dev);
- }
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- int nfc_dep_link_is_up(struct nfc_dev *dev, u32 target_idx,
- u8 comm_mode, u8 rf_mode)
- {
- dev->dep_link_up = true;
- if (!dev->active_target && rf_mode == NFC_RF_INITIATOR) {
- struct nfc_target *target;
- target = nfc_find_target(dev, target_idx);
- if (target == NULL)
- return -ENOTCONN;
- dev->active_target = target;
- }
- dev->polling = false;
- dev->rf_mode = rf_mode;
- nfc_llcp_mac_is_up(dev, target_idx, comm_mode, rf_mode);
- return nfc_genl_dep_link_up_event(dev, target_idx, comm_mode, rf_mode);
- }
- EXPORT_SYMBOL(nfc_dep_link_is_up);
- /**
- * nfc_activate_target - prepare the target for data exchange
- *
- * @dev: The nfc device that found the target
- * @target_idx: index of the target that must be activated
- * @protocol: nfc protocol that will be used for data exchange
- */
- int nfc_activate_target(struct nfc_dev *dev, u32 target_idx, u32 protocol)
- {
- int rc;
- struct nfc_target *target;
- pr_debug("dev_name=%s target_idx=%u protocol=%u\n",
- dev_name(&dev->dev), target_idx, protocol);
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (dev->active_target) {
- rc = -EBUSY;
- goto error;
- }
- target = nfc_find_target(dev, target_idx);
- if (target == NULL) {
- rc = -ENOTCONN;
- goto error;
- }
- rc = dev->ops->activate_target(dev, target, protocol);
- if (!rc) {
- dev->active_target = target;
- dev->rf_mode = NFC_RF_INITIATOR;
- if (dev->ops->check_presence && !dev->shutting_down)
- mod_timer(&dev->check_pres_timer, jiffies +
- msecs_to_jiffies(NFC_CHECK_PRES_FREQ_MS));
- }
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- /**
- * nfc_deactivate_target - deactivate a nfc target
- *
- * @dev: The nfc device that found the target
- * @target_idx: index of the target that must be deactivated
- */
- int nfc_deactivate_target(struct nfc_dev *dev, u32 target_idx, u8 mode)
- {
- int rc = 0;
- pr_debug("dev_name=%s target_idx=%u\n",
- dev_name(&dev->dev), target_idx);
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (dev->active_target == NULL) {
- rc = -ENOTCONN;
- goto error;
- }
- if (dev->active_target->idx != target_idx) {
- rc = -ENOTCONN;
- goto error;
- }
- if (dev->ops->check_presence)
- del_timer_sync(&dev->check_pres_timer);
- dev->ops->deactivate_target(dev, dev->active_target, mode);
- dev->active_target = NULL;
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- /**
- * nfc_data_exchange - transceive data
- *
- * @dev: The nfc device that found the target
- * @target_idx: index of the target
- * @skb: data to be sent
- * @cb: callback called when the response is received
- * @cb_context: parameter for the callback function
- *
- * The user must wait for the callback before calling this function again.
- */
- int nfc_data_exchange(struct nfc_dev *dev, u32 target_idx, struct sk_buff *skb,
- data_exchange_cb_t cb, void *cb_context)
- {
- int rc;
- pr_debug("dev_name=%s target_idx=%u skb->len=%u\n",
- dev_name(&dev->dev), target_idx, skb->len);
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- kfree_skb(skb);
- goto error;
- }
- if (dev->rf_mode == NFC_RF_INITIATOR && dev->active_target != NULL) {
- if (dev->active_target->idx != target_idx) {
- rc = -EADDRNOTAVAIL;
- kfree_skb(skb);
- goto error;
- }
- if (dev->ops->check_presence)
- del_timer_sync(&dev->check_pres_timer);
- rc = dev->ops->im_transceive(dev, dev->active_target, skb, cb,
- cb_context);
- if (!rc && dev->ops->check_presence && !dev->shutting_down)
- mod_timer(&dev->check_pres_timer, jiffies +
- msecs_to_jiffies(NFC_CHECK_PRES_FREQ_MS));
- } else if (dev->rf_mode == NFC_RF_TARGET && dev->ops->tm_send != NULL) {
- rc = dev->ops->tm_send(dev, skb);
- } else {
- rc = -ENOTCONN;
- kfree_skb(skb);
- goto error;
- }
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- struct nfc_se *nfc_find_se(struct nfc_dev *dev, u32 se_idx)
- {
- struct nfc_se *se;
- list_for_each_entry(se, &dev->secure_elements, list)
- if (se->idx == se_idx)
- return se;
- return NULL;
- }
- EXPORT_SYMBOL(nfc_find_se);
- int nfc_enable_se(struct nfc_dev *dev, u32 se_idx)
- {
- struct nfc_se *se;
- int rc;
- pr_debug("%s se index %d\n", dev_name(&dev->dev), se_idx);
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (!dev->dev_up) {
- rc = -ENODEV;
- goto error;
- }
- if (dev->polling) {
- rc = -EBUSY;
- goto error;
- }
- if (!dev->ops->enable_se || !dev->ops->disable_se) {
- rc = -EOPNOTSUPP;
- goto error;
- }
- se = nfc_find_se(dev, se_idx);
- if (!se) {
- rc = -EINVAL;
- goto error;
- }
- if (se->state == NFC_SE_ENABLED) {
- rc = -EALREADY;
- goto error;
- }
- rc = dev->ops->enable_se(dev, se_idx);
- if (rc >= 0)
- se->state = NFC_SE_ENABLED;
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- int nfc_disable_se(struct nfc_dev *dev, u32 se_idx)
- {
- struct nfc_se *se;
- int rc;
- pr_debug("%s se index %d\n", dev_name(&dev->dev), se_idx);
- device_lock(&dev->dev);
- if (!device_is_registered(&dev->dev)) {
- rc = -ENODEV;
- goto error;
- }
- if (!dev->dev_up) {
- rc = -ENODEV;
- goto error;
- }
- if (!dev->ops->enable_se || !dev->ops->disable_se) {
- rc = -EOPNOTSUPP;
- goto error;
- }
- se = nfc_find_se(dev, se_idx);
- if (!se) {
- rc = -EINVAL;
- goto error;
- }
- if (se->state == NFC_SE_DISABLED) {
- rc = -EALREADY;
- goto error;
- }
- rc = dev->ops->disable_se(dev, se_idx);
- if (rc >= 0)
- se->state = NFC_SE_DISABLED;
- error:
- device_unlock(&dev->dev);
- return rc;
- }
- int nfc_set_remote_general_bytes(struct nfc_dev *dev, u8 *gb, u8 gb_len)
- {
- pr_debug("dev_name=%s gb_len=%d\n", dev_name(&dev->dev), gb_len);
- return nfc_llcp_set_remote_gb(dev, gb, gb_len);
- }
- EXPORT_SYMBOL(nfc_set_remote_general_bytes);
- u8 *nfc_get_local_general_bytes(struct nfc_dev *dev, size_t *gb_len)
- {
- pr_debug("dev_name=%s\n", dev_name(&dev->dev));
- return nfc_llcp_general_bytes(dev, gb_len);
- }
- EXPORT_SYMBOL(nfc_get_local_general_bytes);
- int nfc_tm_data_received(struct nfc_dev *dev, struct sk_buff *skb)
- {
- /* Only LLCP target mode for now */
- if (dev->dep_link_up == false) {
- kfree_skb(skb);
- return -ENOLINK;
- }
- return nfc_llcp_data_received(dev, skb);
- }
- EXPORT_SYMBOL(nfc_tm_data_received);
- int nfc_tm_activated(struct nfc_dev *dev, u32 protocol, u8 comm_mode,
- u8 *gb, size_t gb_len)
- {
- int rc;
- device_lock(&dev->dev);
- dev->polling = false;
- if (gb != NULL) {
- rc = nfc_set_remote_general_bytes(dev, gb, gb_len);
- if (rc < 0)
- goto out;
- }
- dev->rf_mode = NFC_RF_TARGET;
- if (protocol == NFC_PROTO_NFC_DEP_MASK)
- nfc_dep_link_is_up(dev, 0, comm_mode, NFC_RF_TARGET);
- rc = nfc_genl_tm_activated(dev, protocol);
- out:
- device_unlock(&dev->dev);
- return rc;
- }
- EXPORT_SYMBOL(nfc_tm_activated);
- int nfc_tm_deactivated(struct nfc_dev *dev)
- {
- dev->dep_link_up = false;
- dev->rf_mode = NFC_RF_NONE;
- return nfc_genl_tm_deactivated(dev);
- }
- EXPORT_SYMBOL(nfc_tm_deactivated);
- /**
- * nfc_alloc_send_skb - allocate a skb for data exchange responses
- *
- * @size: size to allocate
- */
- struct sk_buff *nfc_alloc_send_skb(struct nfc_dev *dev, struct sock *sk,
- unsigned int flags, unsigned int size,
- unsigned int *err)
- {
- struct sk_buff *skb;
- unsigned int total_size;
- total_size = size +
- dev->tx_headroom + dev->tx_tailroom + NFC_HEADER_SIZE;
- skb = sock_alloc_send_skb(sk, total_size, flags & MSG_DONTWAIT, err);
- if (skb)
- skb_reserve(skb, dev->tx_headroom + NFC_HEADER_SIZE);
- return skb;
- }
- /**
- * nfc_alloc_recv_skb - allocate a skb for data exchange responses
- *
- * @size: size to allocate
- * @gfp: gfp flags
- */
- struct sk_buff *nfc_alloc_recv_skb(unsigned int size, gfp_t gfp)
- {
- struct sk_buff *skb;
- unsigned int total_size;
- total_size = size + 1;
- skb = alloc_skb(total_size, gfp);
- if (skb)
- skb_reserve(skb, 1);
- return skb;
- }
- EXPORT_SYMBOL(nfc_alloc_recv_skb);
- /**
- * nfc_targets_found - inform that targets were found
- *
- * @dev: The nfc device that found the targets
- * @targets: array of nfc targets found
- * @n_targets: targets array size
- *
- * The device driver must call this function when one or many nfc targets
- * are found. After calling this function, the device driver must stop
- * polling for targets.
- * NOTE: This function can be called with targets=NULL and n_targets=0 to
- * notify a driver error, meaning that the polling operation cannot complete.
- * IMPORTANT: this function must not be called from an atomic context.
- * In addition, it must also not be called from a context that would prevent
- * the NFC Core to call other nfc ops entry point concurrently.
- */
- int nfc_targets_found(struct nfc_dev *dev,
- struct nfc_target *targets, int n_targets)
- {
- int i;
- pr_debug("dev_name=%s n_targets=%d\n", dev_name(&dev->dev), n_targets);
- for (i = 0; i < n_targets; i++)
- targets[i].idx = dev->target_next_idx++;
- device_lock(&dev->dev);
- if (dev->polling == false) {
- device_unlock(&dev->dev);
- return 0;
- }
- dev->polling = false;
- dev->targets_generation++;
- kfree(dev->targets);
- dev->targets = NULL;
- if (targets) {
- dev->targets = kmemdup(targets,
- n_targets * sizeof(struct nfc_target),
- GFP_ATOMIC);
- if (!dev->targets) {
- dev->n_targets = 0;
- device_unlock(&dev->dev);
- return -ENOMEM;
- }
- }
- dev->n_targets = n_targets;
- device_unlock(&dev->dev);
- nfc_genl_targets_found(dev);
- return 0;
- }
- EXPORT_SYMBOL(nfc_targets_found);
- /**
- * nfc_target_lost - inform that an activated target went out of field
- *
- * @dev: The nfc device that had the activated target in field
- * @target_idx: the nfc index of the target
- *
- * The device driver must call this function when the activated target
- * goes out of the field.
- * IMPORTANT: this function must not be called from an atomic context.
- * In addition, it must also not be called from a context that would prevent
- * the NFC Core to call other nfc ops entry point concurrently.
- */
- int nfc_target_lost(struct nfc_dev *dev, u32 target_idx)
- {
- struct nfc_target *tg;
- int i;
- pr_debug("dev_name %s n_target %d\n", dev_name(&dev->dev), target_idx);
- device_lock(&dev->dev);
- for (i = 0; i < dev->n_targets; i++) {
- tg = &dev->targets[i];
- if (tg->idx == target_idx)
- break;
- }
- if (i == dev->n_targets) {
- device_unlock(&dev->dev);
- return -EINVAL;
- }
- dev->targets_generation++;
- dev->n_targets--;
- dev->active_target = NULL;
- if (dev->n_targets) {
- memcpy(&dev->targets[i], &dev->targets[i + 1],
- (dev->n_targets - i) * sizeof(struct nfc_target));
- } else {
- kfree(dev->targets);
- dev->targets = NULL;
- }
- device_unlock(&dev->dev);
- nfc_genl_target_lost(dev, target_idx);
- return 0;
- }
- EXPORT_SYMBOL(nfc_target_lost);
- inline void nfc_driver_failure(struct nfc_dev *dev, int err)
- {
- nfc_targets_found(dev, NULL, 0);
- }
- EXPORT_SYMBOL(nfc_driver_failure);
- int nfc_add_se(struct nfc_dev *dev, u32 se_idx, u16 type)
- {
- struct nfc_se *se;
- int rc;
- pr_debug("%s se index %d\n", dev_name(&dev->dev), se_idx);
- se = nfc_find_se(dev, se_idx);
- if (se)
- return -EALREADY;
- se = kzalloc(sizeof(struct nfc_se), GFP_KERNEL);
- if (!se)
- return -ENOMEM;
- se->idx = se_idx;
- se->type = type;
- se->state = NFC_SE_DISABLED;
- INIT_LIST_HEAD(&se->list);
- list_add(&se->list, &dev->secure_elements);
- rc = nfc_genl_se_added(dev, se_idx, type);
- if (rc < 0) {
- list_del(&se->list);
- kfree(se);
- return rc;
- }
- return 0;
- }
- EXPORT_SYMBOL(nfc_add_se);
- int nfc_remove_se(struct nfc_dev *dev, u32 se_idx)
- {
- struct nfc_se *se, *n;
- int rc;
- pr_debug("%s se index %d\n", dev_name(&dev->dev), se_idx);
- list_for_each_entry_safe(se, n, &dev->secure_elements, list)
- if (se->idx == se_idx) {
- rc = nfc_genl_se_removed(dev, se_idx);
- if (rc < 0)
- return rc;
- list_del(&se->list);
- kfree(se);
- return 0;
- }
- return -EINVAL;
- }
- EXPORT_SYMBOL(nfc_remove_se);
- int nfc_se_transaction(struct nfc_dev *dev, u8 se_idx,
- struct nfc_evt_transaction *evt_transaction)
- {
- int rc;
- pr_debug("transaction: %x\n", se_idx);
- device_lock(&dev->dev);
- if (!evt_transaction) {
- rc = -EPROTO;
- goto out;
- }
- rc = nfc_genl_se_transaction(dev, se_idx, evt_transaction);
- out:
- device_unlock(&dev->dev);
- return rc;
- }
- EXPORT_SYMBOL(nfc_se_transaction);
- int nfc_se_connectivity(struct nfc_dev *dev, u8 se_idx)
- {
- int rc;
- pr_debug("connectivity: %x\n", se_idx);
- device_lock(&dev->dev);
- rc = nfc_genl_se_connectivity(dev, se_idx);
- device_unlock(&dev->dev);
- return rc;
- }
- EXPORT_SYMBOL(nfc_se_connectivity);
- static void nfc_release(struct device *d)
- {
- struct nfc_dev *dev = to_nfc_dev(d);
- struct nfc_se *se, *n;
- pr_debug("dev_name=%s\n", dev_name(&dev->dev));
- nfc_genl_data_exit(&dev->genl_data);
- kfree(dev->targets);
- list_for_each_entry_safe(se, n, &dev->secure_elements, list) {
- nfc_genl_se_removed(dev, se->idx);
- list_del(&se->list);
- kfree(se);
- }
- ida_simple_remove(&nfc_index_ida, dev->idx);
- kfree(dev);
- }
- static void nfc_check_pres_work(struct work_struct *work)
- {
- struct nfc_dev *dev = container_of(work, struct nfc_dev,
- check_pres_work);
- int rc;
- device_lock(&dev->dev);
- if (dev->active_target && timer_pending(&dev->check_pres_timer) == 0) {
- rc = dev->ops->check_presence(dev, dev->active_target);
- if (rc == -EOPNOTSUPP)
- goto exit;
- if (rc) {
- u32 active_target_idx = dev->active_target->idx;
- device_unlock(&dev->dev);
- nfc_target_lost(dev, active_target_idx);
- return;
- }
- if (!dev->shutting_down)
- mod_timer(&dev->check_pres_timer, jiffies +
- msecs_to_jiffies(NFC_CHECK_PRES_FREQ_MS));
- }
- exit:
- device_unlock(&dev->dev);
- }
- static void nfc_check_pres_timeout(struct timer_list *t)
- {
- struct nfc_dev *dev = from_timer(dev, t, check_pres_timer);
- schedule_work(&dev->check_pres_work);
- }
- struct class nfc_class = {
- .name = "nfc",
- .dev_release = nfc_release,
- };
- EXPORT_SYMBOL(nfc_class);
- static int match_idx(struct device *d, const void *data)
- {
- struct nfc_dev *dev = to_nfc_dev(d);
- const unsigned int *idx = data;
- return dev->idx == *idx;
- }
- struct nfc_dev *nfc_get_device(unsigned int idx)
- {
- struct device *d;
- d = class_find_device(&nfc_class, NULL, &idx, match_idx);
- if (!d)
- return NULL;
- return to_nfc_dev(d);
- }
- /**
- * nfc_allocate_device - allocate a new nfc device
- *
- * @ops: device operations
- * @supported_protocols: NFC protocols supported by the device
- */
- struct nfc_dev *nfc_allocate_device(struct nfc_ops *ops,
- u32 supported_protocols,
- int tx_headroom, int tx_tailroom)
- {
- struct nfc_dev *dev;
- int rc;
- if (!ops->start_poll || !ops->stop_poll || !ops->activate_target ||
- !ops->deactivate_target || !ops->im_transceive)
- return NULL;
- if (!supported_protocols)
- return NULL;
- dev = kzalloc(sizeof(struct nfc_dev), GFP_KERNEL);
- if (!dev)
- return NULL;
- rc = ida_simple_get(&nfc_index_ida, 0, 0, GFP_KERNEL);
- if (rc < 0)
- goto err_free_dev;
- dev->idx = rc;
- dev->dev.class = &nfc_class;
- dev_set_name(&dev->dev, "nfc%d", dev->idx);
- device_initialize(&dev->dev);
- dev->ops = ops;
- dev->supported_protocols = supported_protocols;
- dev->tx_headroom = tx_headroom;
- dev->tx_tailroom = tx_tailroom;
- INIT_LIST_HEAD(&dev->secure_elements);
- nfc_genl_data_init(&dev->genl_data);
- dev->rf_mode = NFC_RF_NONE;
- /* first generation must not be 0 */
- dev->targets_generation = 1;
- if (ops->check_presence) {
- timer_setup(&dev->check_pres_timer, nfc_check_pres_timeout, 0);
- INIT_WORK(&dev->check_pres_work, nfc_check_pres_work);
- }
- return dev;
- err_free_dev:
- kfree(dev);
- return NULL;
- }
- EXPORT_SYMBOL(nfc_allocate_device);
- /**
- * nfc_register_device - register a nfc device in the nfc subsystem
- *
- * @dev: The nfc device to register
- */
- int nfc_register_device(struct nfc_dev *dev)
- {
- int rc;
- pr_debug("dev_name=%s\n", dev_name(&dev->dev));
- mutex_lock(&nfc_devlist_mutex);
- nfc_devlist_generation++;
- rc = device_add(&dev->dev);
- mutex_unlock(&nfc_devlist_mutex);
- if (rc < 0)
- return rc;
- rc = nfc_llcp_register_device(dev);
- if (rc)
- pr_err("Could not register llcp device\n");
- device_lock(&dev->dev);
- dev->rfkill = rfkill_alloc(dev_name(&dev->dev), &dev->dev,
- RFKILL_TYPE_NFC, &nfc_rfkill_ops, dev);
- if (dev->rfkill) {
- if (rfkill_register(dev->rfkill) < 0) {
- rfkill_destroy(dev->rfkill);
- dev->rfkill = NULL;
- }
- }
- device_unlock(&dev->dev);
- rc = nfc_genl_device_added(dev);
- if (rc)
- pr_debug("The userspace won't be notified that the device %s was added\n",
- dev_name(&dev->dev));
- return 0;
- }
- EXPORT_SYMBOL(nfc_register_device);
- /**
- * nfc_unregister_device - unregister a nfc device in the nfc subsystem
- *
- * @dev: The nfc device to unregister
- */
- void nfc_unregister_device(struct nfc_dev *dev)
- {
- int rc;
- pr_debug("dev_name=%s\n", dev_name(&dev->dev));
- rc = nfc_genl_device_removed(dev);
- if (rc)
- pr_debug("The userspace won't be notified that the device %s "
- "was removed\n", dev_name(&dev->dev));
- device_lock(&dev->dev);
- if (dev->rfkill) {
- rfkill_unregister(dev->rfkill);
- rfkill_destroy(dev->rfkill);
- }
- device_unlock(&dev->dev);
- if (dev->ops->check_presence) {
- device_lock(&dev->dev);
- dev->shutting_down = true;
- device_unlock(&dev->dev);
- del_timer_sync(&dev->check_pres_timer);
- cancel_work_sync(&dev->check_pres_work);
- }
- nfc_llcp_unregister_device(dev);
- mutex_lock(&nfc_devlist_mutex);
- nfc_devlist_generation++;
- device_del(&dev->dev);
- mutex_unlock(&nfc_devlist_mutex);
- }
- EXPORT_SYMBOL(nfc_unregister_device);
- static int __init nfc_init(void)
- {
- int rc;
- pr_info("NFC Core ver %s\n", VERSION);
- rc = class_register(&nfc_class);
- if (rc)
- return rc;
- rc = nfc_genl_init();
- if (rc)
- goto err_genl;
- /* the first generation must not be 0 */
- nfc_devlist_generation = 1;
- rc = rawsock_init();
- if (rc)
- goto err_rawsock;
- rc = nfc_llcp_init();
- if (rc)
- goto err_llcp_sock;
- rc = af_nfc_init();
- if (rc)
- goto err_af_nfc;
- return 0;
- err_af_nfc:
- nfc_llcp_exit();
- err_llcp_sock:
- rawsock_exit();
- err_rawsock:
- nfc_genl_exit();
- err_genl:
- class_unregister(&nfc_class);
- return rc;
- }
- static void __exit nfc_exit(void)
- {
- af_nfc_exit();
- nfc_llcp_exit();
- rawsock_exit();
- nfc_genl_exit();
- class_unregister(&nfc_class);
- }
- subsys_initcall(nfc_init);
- module_exit(nfc_exit);
- MODULE_AUTHOR("Lauro Ramos Venancio <lauro.venancio@openbossa.org>");
- MODULE_DESCRIPTION("NFC Core ver " VERSION);
- MODULE_VERSION(VERSION);
- MODULE_LICENSE("GPL");
- MODULE_ALIAS_NETPROTO(PF_NFC);
- MODULE_ALIAS_GENL_FAMILY(NFC_GENL_NAME);
|