]> asedeno.scripts.mit.edu Git - linux.git/commitdiff
Merge tag 'nfc-next-4.13-1' of git://git.kernel.org/pub/scm/linux/kernel/git/sameo...
authorDavid S. Miller <davem@davemloft.net>
Sat, 1 Jul 2017 21:30:39 +0000 (14:30 -0700)
committerDavid S. Miller <davem@davemloft.net>
Sat, 1 Jul 2017 21:30:39 +0000 (14:30 -0700)
Samuel Ortiz says:

====================
NFC 4.13 pull request

This is the NFC pull requesy for 4.13. We have:

- A conversion to unified device and GPIO APIs for the
  fdp, pn544, and st{21,-nci} drivers.
- A fix for NFC device IDs allocation.
- A fix for the nfcmrvl driver firmware download mechanism.
- A trf7970a DT and GPIO cleanup and clock setting fix.
- A few fixes for potential overflows in the digital and LLCP code.
====================

Signed-off-by: David S. Miller <davem@davemloft.net>
24 files changed:
Documentation/devicetree/bindings/net/nfc/trf7970a.txt
MAINTAINERS
drivers/nfc/Kconfig
drivers/nfc/fdp/fdp.c
drivers/nfc/fdp/i2c.c
drivers/nfc/nfcmrvl/fw_dnld.c
drivers/nfc/nfcmrvl/main.c
drivers/nfc/nfcmrvl/uart.c
drivers/nfc/nfcmrvl/usb.c
drivers/nfc/nfcsim.c
drivers/nfc/pn544/i2c.c
drivers/nfc/st-nci/i2c.c
drivers/nfc/st-nci/spi.c
drivers/nfc/st21nfca/i2c.c
drivers/nfc/trf7970a.c
include/linux/platform_data/nfcmrvl.h
include/linux/platform_data/st-nci.h [deleted file]
net/nfc/core.c
net/nfc/digital_core.c
net/nfc/digital_dep.c
net/nfc/digital_technology.c
net/nfc/llcp_sock.c
net/nfc/nci/core.c
net/nfc/netlink.c

index c627bbb3009e5a3f54472d58c2f5ef8f37f871fa..60c833d6218184fb54c1da368400fcdc71ccd9b4 100644 (file)
@@ -13,14 +13,10 @@ Optional SoC Specific Properties:
 - pinctrl-names: Contains only one value - "default".
 - pintctrl-0: Specifies the pin control groups used for this controller.
 - autosuspend-delay: Specify autosuspend delay in milliseconds.
-- vin-voltage-override: Specify voltage of VIN pin in microvolts.
 - irq-status-read-quirk: Specify that the trf7970a being used has the
   "IRQ Status Read" erratum.
 - en2-rf-quirk: Specify that the trf7970a being used has the "EN2 RF"
   erratum.
-- t5t-rmb-extra-byte-quirk: Specify that the trf7970a has the erratum
-  where an extra byte is returned by Read Multiple Block commands issued
-  to Type 5 tags.
 - vdd-io-supply: Regulator specifying voltage for vdd-io
 - clock-frequency: Set to specify that the input frequency to the trf7970a is 13560000Hz or 27120000Hz
 
@@ -37,15 +33,13 @@ Example (for ARM-based BeagleBone with TRF7970A on SPI1):
                spi-max-frequency = <2000000>;
                interrupt-parent = <&gpio2>;
                interrupts = <14 0>;
-               ti,enable-gpios = <&gpio2 2 GPIO_ACTIVE_LOW>,
-                                 <&gpio2 5 GPIO_ACTIVE_LOW>;
+               ti,enable-gpios = <&gpio2 2 GPIO_ACTIVE_HIGH>,
+                                 <&gpio2 5 GPIO_ACTIVE_HIGH>;
                vin-supply = <&ldo3_reg>;
-               vin-voltage-override = <5000000>;
                vdd-io-supply = <&ldo2_reg>;
                autosuspend-delay = <30000>;
                irq-status-read-quirk;
                en2-rf-quirk;
-               t5t-rmb-extra-byte-quirk;
                clock-frequency = <27120000>;
                status = "okay";
        };
index 8e9495a7d74296de85cff684a322fb426c40ef25..5bebe20811c4562b655491328a515ab3b82c2f31 100644 (file)
@@ -9082,9 +9082,6 @@ F:        include/uapi/linux/nfc.h
 F:     drivers/nfc/
 F:     include/linux/platform_data/nfcmrvl.h
 F:     include/linux/platform_data/nxp-nci.h
-F:     include/linux/platform_data/pn544.h
-F:     include/linux/platform_data/st21nfca.h
-F:     include/linux/platform_data/st-nci.h
 F:     Documentation/devicetree/bindings/net/nfc/
 
 NFS, SUNRPC, AND LOCKD CLIENTS
@@ -11419,6 +11416,14 @@ F:     kernel/time/alarmtimer.c
 F:     kernel/time/ntp.c
 F:     tools/testing/selftests/timers/
 
+TI TRF7970A NFC DRIVER
+M:     Mark Greer <mgreer@animalcreek.com>
+L:     linux-wireless@vger.kernel.org
+L:     linux-nfc@lists.01.org (moderated for non-subscribers)
+S:     Supported
+F:     drivers/nfc/trf7970a.c
+F:     Documentation/devicetree/bindings/net/nfc/trf7970a.txt
+
 SC1200 WDT DRIVER
 M:     Zwane Mwaikambo <zwanem@gmail.com>
 S:     Maintained
index c4208487fadc5693d7c4d7dfda9cc3c5f614ab61..b065eb6052150e5c88a6c8ceb13bfa44c29a821e 100644 (file)
@@ -7,7 +7,7 @@ menu "Near Field Communication (NFC) devices"
 
 config NFC_TRF7970A
        tristate "Texas Instruments TRF7970a NFC driver"
-       depends on SPI && NFC_DIGITAL
+       depends on SPI && NFC_DIGITAL && GPIOLIB
        help
          This option enables the NFC driver for Texas Instruments' TRF7970a
          device. Such device supports 5 different protocols: ISO14443A,
index badd8167ac737103edb999d3eea6c334cf63846d..ec50027b0d8ba327b5b125249e1fdc142426b7e9 100644 (file)
@@ -749,11 +749,9 @@ int fdp_nci_probe(struct fdp_i2c_phy *phy, struct nfc_phy_ops *phy_ops,
        u32 protocols;
        int r;
 
-       info = kzalloc(sizeof(struct fdp_nci_info), GFP_KERNEL);
-       if (!info) {
-               r = -ENOMEM;
-               goto err_info_alloc;
-       }
+       info = devm_kzalloc(dev, sizeof(struct fdp_nci_info), GFP_KERNEL);
+       if (!info)
+               return -ENOMEM;
 
        info->phy = phy;
        info->phy_ops = phy_ops;
@@ -775,8 +773,7 @@ int fdp_nci_probe(struct fdp_i2c_phy *phy, struct nfc_phy_ops *phy_ops,
                                   tx_tailroom);
        if (!ndev) {
                nfc_err(dev, "Cannot allocate nfc ndev\n");
-               r = -ENOMEM;
-               goto err_alloc_ndev;
+               return -ENOMEM;
        }
 
        r = nci_register_device(ndev);
@@ -792,9 +789,6 @@ int fdp_nci_probe(struct fdp_i2c_phy *phy, struct nfc_phy_ops *phy_ops,
 
 err_regdev:
        nci_free_device(ndev);
-err_alloc_ndev:
-       kfree(info);
-err_info_alloc:
        return r;
 }
 EXPORT_SYMBOL(fdp_nci_probe);
@@ -808,7 +802,6 @@ void fdp_nci_remove(struct nci_dev *ndev)
 
        nci_unregister_device(ndev);
        nci_free_device(ndev);
-       kfree(info);
 }
 EXPORT_SYMBOL(fdp_nci_remove);
 
index e0baec848ff277d15da5bd35c91b06d2de38efb4..c4da50e07bbcbe2318a27f55c5e49baf5f3c077b 100644 (file)
@@ -27,7 +27,6 @@
 
 #define FDP_I2C_DRIVER_NAME    "fdp_nci_i2c"
 
-#define FDP_DP_POWER_GPIO_NAME "power"
 #define FDP_DP_CLOCK_TYPE_NAME "clock-type"
 #define FDP_DP_CLOCK_FREQ_NAME "clock-freq"
 #define FDP_DP_FW_VSC_CFG_NAME "fw-vsc-cfg"
@@ -281,8 +280,14 @@ static void fdp_nci_i2c_read_device_properties(struct device *dev,
                *clock_type, *clock_freq, *fw_vsc_cfg != NULL ? "yes" : "no");
 }
 
-static int fdp_nci_i2c_probe(struct i2c_client *client,
-                            const struct i2c_device_id *id)
+static const struct acpi_gpio_params power_gpios = { 0, 0, false };
+
+static const struct acpi_gpio_mapping acpi_fdp_gpios[] = {
+       { "power-gpios", &power_gpios, 1 },
+       {},
+};
+
+static int fdp_nci_i2c_probe(struct i2c_client *client)
 {
        struct fdp_i2c_phy *phy;
        struct device *dev = &client->dev;
@@ -304,8 +309,7 @@ static int fdp_nci_i2c_probe(struct i2c_client *client,
                return -ENODEV;
        }
 
-       phy = devm_kzalloc(dev, sizeof(struct fdp_i2c_phy),
-                          GFP_KERNEL);
+       phy = devm_kzalloc(dev, sizeof(struct fdp_i2c_phy), GFP_KERNEL);
        if (!phy)
                return -ENOMEM;
 
@@ -313,19 +317,22 @@ static int fdp_nci_i2c_probe(struct i2c_client *client,
        phy->next_read_size = FDP_NCI_I2C_MIN_PAYLOAD;
        i2c_set_clientdata(client, phy);
 
-       r = request_threaded_irq(client->irq, NULL, fdp_nci_i2c_irq_thread_fn,
-                                IRQF_TRIGGER_RISING | IRQF_ONESHOT,
-                                FDP_I2C_DRIVER_NAME, phy);
+       r = devm_request_threaded_irq(dev, client->irq,
+                                     NULL, fdp_nci_i2c_irq_thread_fn,
+                                     IRQF_TRIGGER_RISING | IRQF_ONESHOT,
+                                     FDP_I2C_DRIVER_NAME, phy);
 
        if (r < 0) {
                nfc_err(&client->dev, "Unable to register IRQ handler\n");
                return r;
        }
 
-       /* Requesting the power gpio */
-       phy->power_gpio = devm_gpiod_get(dev, FDP_DP_POWER_GPIO_NAME,
-                                        GPIOD_OUT_LOW);
+       r = devm_acpi_dev_add_driver_gpios(dev, acpi_fdp_gpios);
+       if (r)
+               dev_dbg(dev, "Unable to add GPIO mapping table\n");
 
+       /* Requesting the power gpio */
+       phy->power_gpio = devm_gpiod_get(dev, "power", GPIOD_OUT_LOW);
        if (IS_ERR(phy->power_gpio)) {
                nfc_err(dev, "Power GPIO request failed\n");
                return PTR_ERR(phy->power_gpio);
@@ -360,12 +367,6 @@ static int fdp_nci_i2c_remove(struct i2c_client *client)
        return 0;
 }
 
-static struct i2c_device_id fdp_nci_i2c_id_table[] = {
-       {"int339a", 0},
-       {}
-};
-MODULE_DEVICE_TABLE(i2c, fdp_nci_i2c_id_table);
-
 static const struct acpi_device_id fdp_nci_i2c_acpi_match[] = {
        {"INT339A", 0},
        {}
@@ -377,8 +378,7 @@ static struct i2c_driver fdp_nci_i2c_driver = {
                   .name = FDP_I2C_DRIVER_NAME,
                   .acpi_match_table = ACPI_PTR(fdp_nci_i2c_acpi_match),
                  },
-       .id_table = fdp_nci_i2c_id_table,
-       .probe = fdp_nci_i2c_probe,
+       .probe_new = fdp_nci_i2c_probe,
        .remove = fdp_nci_i2c_remove,
 };
 module_i2c_driver(fdp_nci_i2c_driver);
index f9f000c546d1182f768b969f5a131d90785673d7..7f8960a46aab0a6a494458f2c0a89cca1716e26d 100644 (file)
@@ -457,7 +457,7 @@ int nfcmrvl_fw_dnld_init(struct nfcmrvl_private *priv)
 
        INIT_WORK(&priv->fw_dnld.rx_work, fw_dnld_rx_work);
        snprintf(name, sizeof(name), "%s_nfcmrvl_fw_dnld_rx_wq",
-                dev_name(priv->dev));
+                dev_name(&priv->ndev->nfc_dev->dev));
        priv->fw_dnld.rx_wq = create_singlethread_workqueue(name);
        if (!priv->fw_dnld.rx_wq)
                return -ENOMEM;
@@ -494,6 +494,7 @@ int nfcmrvl_fw_dnld_start(struct nci_dev *ndev, const char *firmware_name)
 {
        struct nfcmrvl_private *priv = nci_get_drvdata(ndev);
        struct nfcmrvl_fw_dnld *fw_dnld = &priv->fw_dnld;
+       int res;
 
        if (!priv->support_fw_dnld)
                return -ENOTSUPP;
@@ -509,7 +510,9 @@ int nfcmrvl_fw_dnld_start(struct nci_dev *ndev, const char *firmware_name)
         */
 
        /* Retrieve FW binary */
-       if (request_firmware(&fw_dnld->fw, firmware_name, priv->dev) < 0) {
+       res = request_firmware(&fw_dnld->fw, firmware_name,
+                              &ndev->nfc_dev->dev);
+       if (res < 0) {
                nfc_err(priv->dev, "failed to retrieve FW %s", firmware_name);
                return -ENOENT;
        }
index c5038e6447bda4e35a6e46ed1cea43c1e6721acb..e65d027b91fafbbd752970cff0afdc9e8cfb0d7c 100644 (file)
@@ -123,13 +123,14 @@ struct nfcmrvl_private *nfcmrvl_nci_register_dev(enum nfcmrvl_phy phy,
 
        memcpy(&priv->config, pdata, sizeof(*pdata));
 
-       if (priv->config.reset_n_io) {
-               rc = devm_gpio_request_one(dev,
-                                          priv->config.reset_n_io,
-                                          GPIOF_OUT_INIT_LOW,
-                                          "nfcmrvl_reset_n");
-               if (rc < 0)
+       if (gpio_is_valid(priv->config.reset_n_io)) {
+               rc = gpio_request_one(priv->config.reset_n_io,
+                                     GPIOF_OUT_INIT_LOW,
+                                     "nfcmrvl_reset_n");
+               if (rc < 0) {
+                       priv->config.reset_n_io = -EINVAL;
                        nfc_err(dev, "failed to request reset_n io\n");
+               }
        }
 
        if (phy == NFCMRVL_PHY_SPI) {
@@ -154,7 +155,13 @@ struct nfcmrvl_private *nfcmrvl_nci_register_dev(enum nfcmrvl_phy phy,
        if (!priv->ndev) {
                nfc_err(dev, "nci_allocate_device failed\n");
                rc = -ENOMEM;
-               goto error;
+               goto error_free_gpio;
+       }
+
+       rc = nfcmrvl_fw_dnld_init(priv);
+       if (rc) {
+               nfc_err(dev, "failed to initialize FW download %d\n", rc);
+               goto error_free_dev;
        }
 
        nci_set_drvdata(priv->ndev, priv);
@@ -162,24 +169,22 @@ struct nfcmrvl_private *nfcmrvl_nci_register_dev(enum nfcmrvl_phy phy,
        rc = nci_register_device(priv->ndev);
        if (rc) {
                nfc_err(dev, "nci_register_device failed %d\n", rc);
-               goto error_free_dev;
+               goto error_fw_dnld_deinit;
        }
 
        /* Ensure that controller is powered off */
        nfcmrvl_chip_halt(priv);
 
-       rc = nfcmrvl_fw_dnld_init(priv);
-       if (rc) {
-               nfc_err(dev, "failed to initialize FW download %d\n", rc);
-               goto error_free_dev;
-       }
-
        nfc_info(dev, "registered with nci successfully\n");
        return priv;
 
+error_fw_dnld_deinit:
+       nfcmrvl_fw_dnld_deinit(priv);
 error_free_dev:
        nci_free_device(priv->ndev);
-error:
+error_free_gpio:
+       if (gpio_is_valid(priv->config.reset_n_io))
+               gpio_free(priv->config.reset_n_io);
        kfree(priv);
        return ERR_PTR(rc);
 }
@@ -194,8 +199,8 @@ void nfcmrvl_nci_unregister_dev(struct nfcmrvl_private *priv)
 
        nfcmrvl_fw_dnld_deinit(priv);
 
-       if (priv->config.reset_n_io)
-               devm_gpio_free(priv->dev, priv->config.reset_n_io);
+       if (gpio_is_valid(priv->config.reset_n_io))
+               gpio_free(priv->config.reset_n_io);
 
        nci_unregister_device(ndev);
        nci_free_device(ndev);
@@ -262,7 +267,6 @@ int nfcmrvl_parse_dt(struct device_node *node,
        reset_n_io = of_get_named_gpio(node, "reset-n-io", 0);
        if (reset_n_io < 0) {
                pr_info("no reset-n-io config\n");
-               reset_n_io = 0;
        } else if (!gpio_is_valid(reset_n_io)) {
                pr_err("invalid reset-n-io GPIO\n");
                return reset_n_io;
index 83a99e38e7bd316d949e44d1bc530865ac22befe..91162f8e0366c87ab7d3e26f2f02344599fb100b 100644 (file)
@@ -84,6 +84,7 @@ static int nfcmrvl_uart_parse_dt(struct device_node *node,
        ret = nfcmrvl_parse_dt(matched_node, pdata);
        if (ret < 0) {
                pr_err("Failed to get generic entries\n");
+               of_node_put(matched_node);
                return ret;
        }
 
@@ -97,6 +98,8 @@ static int nfcmrvl_uart_parse_dt(struct device_node *node,
        else
                pdata->break_control = 0;
 
+       of_node_put(matched_node);
+
        return 0;
 }
 
@@ -109,6 +112,7 @@ static int nfcmrvl_nci_uart_open(struct nci_uart *nu)
        struct nfcmrvl_private *priv;
        struct nfcmrvl_platform_data *pdata = NULL;
        struct nfcmrvl_platform_data config;
+       struct device *dev = nu->tty->dev;
 
        /*
         * Platform data cannot be used here since usually it is already used
@@ -116,9 +120,8 @@ static int nfcmrvl_nci_uart_open(struct nci_uart *nu)
         * and check if DT entries were added.
         */
 
-       if (nu->tty->dev->parent && nu->tty->dev->parent->of_node)
-               if (nfcmrvl_uart_parse_dt(nu->tty->dev->parent->of_node,
-                                         &config) == 0)
+       if (dev && dev->parent && dev->parent->of_node)
+               if (nfcmrvl_uart_parse_dt(dev->parent->of_node, &config) == 0)
                        pdata = &config;
 
        if (!pdata) {
@@ -131,7 +134,7 @@ static int nfcmrvl_nci_uart_open(struct nci_uart *nu)
        }
 
        priv = nfcmrvl_nci_register_dev(NFCMRVL_PHY_UART, nu, &uart_ops,
-                                       nu->tty->dev, pdata);
+                                       dev, pdata);
        if (IS_ERR(priv))
                return PTR_ERR(priv);
 
index 699aa9d1657532c7d15e46c2c2e178f02c175517..bd35eab652be7cf503adc7d253ecb5ccab7d9ad0 100644 (file)
@@ -341,15 +341,13 @@ static int nfcmrvl_probe(struct usb_interface *intf,
        init_usb_anchor(&drv_data->deferred);
 
        priv = nfcmrvl_nci_register_dev(NFCMRVL_PHY_USB, drv_data, &usb_ops,
-                                       &drv_data->udev->dev, &config);
+                                       &intf->dev, &config);
        if (IS_ERR(priv))
                return PTR_ERR(priv);
 
        drv_data->priv = priv;
        drv_data->priv->support_fw_dnld = false;
 
-       priv->dev = &drv_data->udev->dev;
-
        usb_set_intfdata(intf, drv_data);
 
        return 0;
index a466e79784668ef44955aad0d2b61cc9e1a5b3b6..33449820e75422e70753d767c5b95a061fdfe19a 100644 (file)
@@ -482,8 +482,10 @@ static int __init nfcsim_init(void)
 exit_err:
        pr_err("Failed to initialize nfcsim driver (%d)\n", rc);
 
-       nfcsim_link_free(link0);
-       nfcsim_link_free(link1);
+       if (link0)
+               nfcsim_link_free(link0);
+       if (link1)
+               nfcsim_link_free(link1);
 
        return rc;
 }
index fedde9d46ab648e87fd686e6e00d28d4bc130f2b..4b14740edb672c734239eb4c26282c036009d415 100644 (file)
@@ -904,7 +904,7 @@ static int pn544_hci_i2c_probe(struct i2c_client *client,
        phy->i2c_dev = client;
        i2c_set_clientdata(client, phy);
 
-       r = acpi_dev_add_driver_gpios(ACPI_COMPANION(dev), acpi_pn544_gpios);
+       r = devm_acpi_dev_add_driver_gpios(dev, acpi_pn544_gpios);
        if (r)
                dev_dbg(dev, "Unable to add GPIO mapping table\n");
 
@@ -958,7 +958,6 @@ static int pn544_hci_i2c_remove(struct i2c_client *client)
        if (phy->powered)
                pn544_hci_i2c_disable(phy);
 
-       acpi_dev_remove_driver_gpios(ACPI_COMPANION(&client->dev));
        return 0;
 }
 
index 9dfae0efa922b099e30b984784c82dd12c33996e..515f08d037fb40c0656dd07808c67e6ffffc1f0e 100644 (file)
 
 #include <linux/module.h>
 #include <linux/i2c.h>
-#include <linux/gpio.h>
 #include <linux/gpio/consumer.h>
-#include <linux/of_irq.h>
-#include <linux/of_gpio.h>
 #include <linux/acpi.h>
 #include <linux/interrupt.h>
 #include <linux/delay.h>
 #include <linux/nfc.h>
-#include <linux/platform_data/st-nci.h>
+#include <linux/of.h>
 
 #include "st-nci.h"
 
 #define ST_NCI_I2C_MIN_SIZE 4   /* PCB(1) + NCI Packet header(3) */
 #define ST_NCI_I2C_MAX_SIZE 250 /* req 4.2.1 */
 
+#define ST_NCI_DRIVER_NAME "st_nci"
 #define ST_NCI_I2C_DRIVER_NAME "st_nci_i2c"
 
-#define ST_NCI_GPIO_NAME_RESET "reset"
-
 struct st_nci_i2c_phy {
        struct i2c_client *i2c_dev;
        struct llt_ndlc *ndlc;
 
        bool irq_active;
 
-       unsigned int gpio_reset;
-       unsigned int irq_polarity;
+       struct gpio_desc *gpiod_reset;
 
        struct st_nci_se_status se_status;
 };
@@ -60,9 +55,9 @@ static int st_nci_i2c_enable(void *phy_id)
 {
        struct st_nci_i2c_phy *phy = phy_id;
 
-       gpio_set_value(phy->gpio_reset, 0);
+       gpiod_set_value(phy->gpiod_reset, 0);
        usleep_range(10000, 15000);
-       gpio_set_value(phy->gpio_reset, 1);
+       gpiod_set_value(phy->gpiod_reset, 1);
        usleep_range(80000, 85000);
 
        if (phy->ndlc->powered == 0 && phy->irq_active == 0) {
@@ -208,114 +203,18 @@ static struct nfc_phy_ops i2c_phy_ops = {
        .disable = st_nci_i2c_disable,
 };
 
-static int st_nci_i2c_acpi_request_resources(struct i2c_client *client)
-{
-       struct st_nci_i2c_phy *phy = i2c_get_clientdata(client);
-       struct gpio_desc *gpiod_reset;
-       struct device *dev = &client->dev;
-       u8 tmp;
-
-       /* Get RESET GPIO from ACPI */
-       gpiod_reset = devm_gpiod_get_index(dev, ST_NCI_GPIO_NAME_RESET, 1,
-                                          GPIOD_OUT_HIGH);
-       if (IS_ERR(gpiod_reset)) {
-               nfc_err(dev, "Unable to get RESET GPIO\n");
-               return -ENODEV;
-       }
-
-       phy->gpio_reset = desc_to_gpio(gpiod_reset);
-
-       phy->irq_polarity = irq_get_trigger_type(client->irq);
-
-       phy->se_status.is_ese_present = false;
-       phy->se_status.is_uicc_present = false;
-
-       if (device_property_present(dev, "ese-present")) {
-               device_property_read_u8(dev, "ese-present", &tmp);
-               phy->se_status.is_ese_present = tmp;
-       }
-
-       if (device_property_present(dev, "uicc-present")) {
-               device_property_read_u8(dev, "uicc-present", &tmp);
-               phy->se_status.is_uicc_present = tmp;
-       }
-
-       return 0;
-}
-
-static int st_nci_i2c_of_request_resources(struct i2c_client *client)
-{
-       struct st_nci_i2c_phy *phy = i2c_get_clientdata(client);
-       struct device_node *pp;
-       int gpio;
-       int r;
-
-       pp = client->dev.of_node;
-       if (!pp)
-               return -ENODEV;
-
-       /* Get GPIO from device tree */
-       gpio = of_get_named_gpio(pp, "reset-gpios", 0);
-       if (gpio < 0) {
-               nfc_err(&client->dev,
-                       "Failed to retrieve reset-gpios from device tree\n");
-               return gpio;
-       }
-
-       /* GPIO request and configuration */
-       r = devm_gpio_request_one(&client->dev, gpio,
-                               GPIOF_OUT_INIT_HIGH, ST_NCI_GPIO_NAME_RESET);
-       if (r) {
-               nfc_err(&client->dev, "Failed to request reset pin\n");
-               return r;
-       }
-       phy->gpio_reset = gpio;
-
-       phy->irq_polarity = irq_get_trigger_type(client->irq);
-
-       phy->se_status.is_ese_present =
-                               of_property_read_bool(pp, "ese-present");
-       phy->se_status.is_uicc_present =
-                               of_property_read_bool(pp, "uicc-present");
-
-       return 0;
-}
-
-static int st_nci_i2c_request_resources(struct i2c_client *client)
-{
-       struct st_nci_nfc_platform_data *pdata;
-       struct st_nci_i2c_phy *phy = i2c_get_clientdata(client);
-       int r;
-
-       pdata = client->dev.platform_data;
-       if (pdata == NULL) {
-               nfc_err(&client->dev, "No platform data\n");
-               return -EINVAL;
-       }
+static const struct acpi_gpio_params reset_gpios = { 1, 0, false };
 
-       /* store for later use */
-       phy->gpio_reset = pdata->gpio_reset;
-       phy->irq_polarity = pdata->irq_polarity;
-
-       r = devm_gpio_request_one(&client->dev,
-                       phy->gpio_reset, GPIOF_OUT_INIT_HIGH,
-                       ST_NCI_GPIO_NAME_RESET);
-       if (r) {
-               pr_err("%s : reset gpio_request failed\n", __FILE__);
-               return r;
-       }
-
-       phy->se_status.is_ese_present = pdata->is_ese_present;
-       phy->se_status.is_uicc_present = pdata->is_uicc_present;
-
-       return 0;
-}
+static const struct acpi_gpio_mapping acpi_st_nci_gpios[] = {
+       { "reset-gpios", &reset_gpios, 1 },
+       {},
+};
 
 static int st_nci_i2c_probe(struct i2c_client *client,
                                  const struct i2c_device_id *id)
 {
+       struct device *dev = &client->dev;
        struct st_nci_i2c_phy *phy;
-       struct st_nci_nfc_platform_data *pdata;
        int r;
 
        dev_dbg(&client->dev, "%s\n", __func__);
@@ -326,8 +225,7 @@ static int st_nci_i2c_probe(struct i2c_client *client,
                return -ENODEV;
        }
 
-       phy = devm_kzalloc(&client->dev, sizeof(struct st_nci_i2c_phy),
-                          GFP_KERNEL);
+       phy = devm_kzalloc(dev, sizeof(struct st_nci_i2c_phy), GFP_KERNEL);
        if (!phy)
                return -ENOMEM;
 
@@ -335,32 +233,22 @@ static int st_nci_i2c_probe(struct i2c_client *client,
 
        i2c_set_clientdata(client, phy);
 
-       pdata = client->dev.platform_data;
-       if (!pdata && client->dev.of_node) {
-               r = st_nci_i2c_of_request_resources(client);
-               if (r) {
-                       nfc_err(&client->dev, "No platform data\n");
-                       return r;
-               }
-       } else if (pdata) {
-               r = st_nci_i2c_request_resources(client);
-               if (r) {
-                       nfc_err(&client->dev,
-                               "Cannot get platform resources\n");
-                       return r;
-               }
-       } else if (ACPI_HANDLE(&client->dev)) {
-               r = st_nci_i2c_acpi_request_resources(client);
-               if (r) {
-                       nfc_err(&client->dev, "Cannot get ACPI data\n");
-                       return r;
-               }
-       } else {
-               nfc_err(&client->dev,
-                       "st_nci platform resources not available\n");
+       r = devm_acpi_dev_add_driver_gpios(dev, acpi_st_nci_gpios);
+       if (r)
+               dev_dbg(dev, "Unable to add GPIO mapping table\n");
+
+       /* Get RESET GPIO */
+       phy->gpiod_reset = devm_gpiod_get(dev, "reset", GPIOD_OUT_HIGH);
+       if (IS_ERR(phy->gpiod_reset)) {
+               nfc_err(dev, "Unable to get RESET GPIO\n");
                return -ENODEV;
        }
 
+       phy->se_status.is_ese_present =
+                               device_property_read_bool(dev, "ese-present");
+       phy->se_status.is_uicc_present =
+                               device_property_read_bool(dev, "uicc-present");
+
        r = ndlc_probe(phy, &i2c_phy_ops, &client->dev,
                        ST_NCI_FRAME_HEADROOM, ST_NCI_FRAME_TAILROOM,
                        &phy->ndlc, &phy->se_status);
@@ -372,7 +260,7 @@ static int st_nci_i2c_probe(struct i2c_client *client,
        phy->irq_active = true;
        r = devm_request_threaded_irq(&client->dev, client->irq, NULL,
                                st_nci_irq_thread_fn,
-                               phy->irq_polarity | IRQF_ONESHOT,
+                               IRQF_ONESHOT,
                                ST_NCI_DRIVER_NAME, phy);
        if (r < 0)
                nfc_err(&client->dev, "Unable to register IRQ handler\n");
index 89e341eba3ebe97407412c1cec99a3868849493a..14705591b0fb9bcf80de490d796d7d196f971961 100644 (file)
 
 #include <linux/module.h>
 #include <linux/spi/spi.h>
-#include <linux/gpio.h>
 #include <linux/gpio/consumer.h>
-#include <linux/of_irq.h>
-#include <linux/of_gpio.h>
 #include <linux/acpi.h>
 #include <linux/interrupt.h>
 #include <linux/delay.h>
 #include <linux/nfc.h>
+#include <linux/of.h>
 #include <net/nfc/nci.h>
-#include <linux/platform_data/st-nci.h>
 
 #include "st-nci.h"
 
 #define ST_NCI_SPI_MIN_SIZE 4   /* PCB(1) + NCI Packet header(3) */
 #define ST_NCI_SPI_MAX_SIZE 250 /* req 4.2.1 */
 
+#define ST_NCI_DRIVER_NAME "st_nci"
 #define ST_NCI_SPI_DRIVER_NAME "st_nci_spi"
 
-#define ST_NCI_GPIO_NAME_RESET "reset"
-
 struct st_nci_spi_phy {
        struct spi_device *spi_dev;
        struct llt_ndlc *ndlc;
 
        bool irq_active;
 
-       unsigned int gpio_reset;
-       unsigned int irq_polarity;
+       struct gpio_desc *gpiod_reset;
 
        struct st_nci_se_status se_status;
 };
@@ -61,9 +56,9 @@ static int st_nci_spi_enable(void *phy_id)
 {
        struct st_nci_spi_phy *phy = phy_id;
 
-       gpio_set_value(phy->gpio_reset, 0);
+       gpiod_set_value(phy->gpiod_reset, 0);
        usleep_range(10000, 15000);
-       gpio_set_value(phy->gpio_reset, 1);
+       gpiod_set_value(phy->gpiod_reset, 1);
        usleep_range(80000, 85000);
 
        if (phy->ndlc->powered == 0 && phy->irq_active == 0) {
@@ -223,113 +218,16 @@ static struct nfc_phy_ops spi_phy_ops = {
        .disable = st_nci_spi_disable,
 };
 
-static int st_nci_spi_acpi_request_resources(struct spi_device *spi_dev)
-{
-       struct st_nci_spi_phy *phy = spi_get_drvdata(spi_dev);
-       struct gpio_desc *gpiod_reset;
-       struct device *dev = &spi_dev->dev;
-       u8 tmp;
-
-       /* Get RESET GPIO from ACPI */
-       gpiod_reset = devm_gpiod_get_index(dev, ST_NCI_GPIO_NAME_RESET, 1,
-                                          GPIOD_OUT_HIGH);
-       if (IS_ERR(gpiod_reset)) {
-               nfc_err(dev, "Unable to get RESET GPIO\n");
-               return -ENODEV;
-       }
-
-       phy->gpio_reset = desc_to_gpio(gpiod_reset);
-
-       phy->irq_polarity = irq_get_trigger_type(spi_dev->irq);
-
-       phy->se_status.is_ese_present = false;
-       phy->se_status.is_uicc_present = false;
-
-       if (device_property_present(dev, "ese-present")) {
-               device_property_read_u8(dev, "ese-present", &tmp);
-               tmp = phy->se_status.is_ese_present;
-       }
-
-       if (device_property_present(dev, "uicc-present")) {
-               device_property_read_u8(dev, "uicc-present", &tmp);
-               tmp = phy->se_status.is_uicc_present;
-       }
-
-       return 0;
-}
-
-static int st_nci_spi_of_request_resources(struct spi_device *dev)
-{
-       struct st_nci_spi_phy *phy = spi_get_drvdata(dev);
-       struct device_node *pp;
-       int gpio;
-       int r;
-
-       pp = dev->dev.of_node;
-       if (!pp)
-               return -ENODEV;
-
-       /* Get GPIO from device tree */
-       gpio = of_get_named_gpio(pp, "reset-gpios", 0);
-       if (gpio < 0) {
-               nfc_err(&dev->dev,
-                       "Failed to retrieve reset-gpios from device tree\n");
-               return gpio;
-       }
-
-       /* GPIO request and configuration */
-       r = devm_gpio_request_one(&dev->dev, gpio,
-                               GPIOF_OUT_INIT_HIGH, ST_NCI_GPIO_NAME_RESET);
-       if (r) {
-               nfc_err(&dev->dev, "Failed to request reset pin\n");
-               return r;
-       }
-       phy->gpio_reset = gpio;
-
-       phy->irq_polarity = irq_get_trigger_type(dev->irq);
+static const struct acpi_gpio_params reset_gpios = { 1, 0, false };
 
-       phy->se_status.is_ese_present =
-                               of_property_read_bool(pp, "ese-present");
-       phy->se_status.is_uicc_present =
-                               of_property_read_bool(pp, "uicc-present");
-
-       return 0;
-}
-
-static int st_nci_spi_request_resources(struct spi_device *dev)
-{
-       struct st_nci_nfc_platform_data *pdata;
-       struct st_nci_spi_phy *phy = spi_get_drvdata(dev);
-       int r;
-
-       pdata = dev->dev.platform_data;
-       if (pdata == NULL) {
-               nfc_err(&dev->dev, "No platform data\n");
-               return -EINVAL;
-       }
-
-       /* store for later use */
-       phy->gpio_reset = pdata->gpio_reset;
-       phy->irq_polarity = pdata->irq_polarity;
-
-       r = devm_gpio_request_one(&dev->dev,
-                       phy->gpio_reset, GPIOF_OUT_INIT_HIGH,
-                       ST_NCI_GPIO_NAME_RESET);
-       if (r) {
-               pr_err("%s : reset gpio_request failed\n", __FILE__);
-               return r;
-       }
-
-       phy->se_status.is_ese_present = pdata->is_ese_present;
-       phy->se_status.is_uicc_present = pdata->is_uicc_present;
-
-       return 0;
-}
+static const struct acpi_gpio_mapping acpi_st_nci_gpios[] = {
+       { "reset-gpios", &reset_gpios, 1 },
+       {},
+};
 
 static int st_nci_spi_probe(struct spi_device *dev)
 {
        struct st_nci_spi_phy *phy;
-       struct st_nci_nfc_platform_data *pdata;
        int r;
 
        dev_dbg(&dev->dev, "%s\n", __func__);
@@ -351,32 +249,22 @@ static int st_nci_spi_probe(struct spi_device *dev)
 
        spi_set_drvdata(dev, phy);
 
-       pdata = dev->dev.platform_data;
-       if (!pdata && dev->dev.of_node) {
-               r = st_nci_spi_of_request_resources(dev);
-               if (r) {
-                       nfc_err(&dev->dev, "No platform data\n");
-                       return r;
-               }
-       } else if (pdata) {
-               r = st_nci_spi_request_resources(dev);
-               if (r) {
-                       nfc_err(&dev->dev,
-                               "Cannot get platform resources\n");
-                       return r;
-               }
-       } else if (ACPI_HANDLE(&dev->dev)) {
-               r = st_nci_spi_acpi_request_resources(dev);
-               if (r) {
-                       nfc_err(&dev->dev, "Cannot get ACPI data\n");
-                       return r;
-               }
-       } else {
-               nfc_err(&dev->dev,
-                       "st_nci platform resources not available\n");
-               return -ENODEV;
+       r = devm_acpi_dev_add_driver_gpios(&dev->dev, acpi_st_nci_gpios);
+       if (r)
+               dev_dbg(&dev->dev, "Unable to add GPIO mapping table\n");
+
+       /* Get RESET GPIO */
+       phy->gpiod_reset = devm_gpiod_get(&dev->dev, "reset", GPIOD_OUT_HIGH);
+       if (IS_ERR(phy->gpiod_reset)) {
+               nfc_err(&dev->dev, "Unable to get RESET GPIO\n");
+               return PTR_ERR(phy->gpiod_reset);
        }
 
+       phy->se_status.is_ese_present =
+                       device_property_read_bool(&dev->dev, "ese-present");
+       phy->se_status.is_uicc_present =
+                       device_property_read_bool(&dev->dev, "uicc-present");
+
        r = ndlc_probe(phy, &spi_phy_ops, &dev->dev,
                        ST_NCI_FRAME_HEADROOM, ST_NCI_FRAME_TAILROOM,
                        &phy->ndlc, &phy->se_status);
@@ -388,7 +276,7 @@ static int st_nci_spi_probe(struct spi_device *dev)
        phy->irq_active = true;
        r = devm_request_threaded_irq(&dev->dev, dev->irq, NULL,
                                st_nci_irq_thread_fn,
-                               phy->irq_polarity | IRQF_ONESHOT,
+                               IRQF_ONESHOT,
                                ST_NCI_SPI_DRIVER_NAME, phy);
        if (r < 0)
                nfc_err(&dev->dev, "Unable to register IRQ handler\n");
index 4bff76baa3417931fa0d3ec89de40dd6e4f670f4..cd1f7bfa75ebe3a75f5577d33cc162fdfacfa8c1 100644 (file)
@@ -61,8 +61,6 @@
 #define ST21NFCA_HCI_DRIVER_NAME "st21nfca_hci"
 #define ST21NFCA_HCI_I2C_DRIVER_NAME "st21nfca_hci_i2c"
 
-#define ST21NFCA_GPIO_NAME_EN "enable"
-
 struct st21nfca_i2c_phy {
        struct i2c_client *i2c_dev;
        struct nfc_hci_dev *hdev;
@@ -501,41 +499,17 @@ static struct nfc_phy_ops i2c_phy_ops = {
        .disable = st21nfca_hci_i2c_disable,
 };
 
-static int st21nfca_hci_i2c_acpi_request_resources(struct i2c_client *client)
-{
-       struct st21nfca_i2c_phy *phy = i2c_get_clientdata(client);
-       struct device *dev = &client->dev;
-
-       /* Get EN GPIO from ACPI */
-       phy->gpiod_ena = devm_gpiod_get_index(dev, ST21NFCA_GPIO_NAME_EN, 1,
-                                             GPIOD_OUT_LOW);
-       if (IS_ERR(phy->gpiod_ena)) {
-               nfc_err(dev, "Unable to get ENABLE GPIO\n");
-               return PTR_ERR(phy->gpiod_ena);
-       }
-
-       return 0;
-}
-
-static int st21nfca_hci_i2c_of_request_resources(struct i2c_client *client)
-{
-       struct st21nfca_i2c_phy *phy = i2c_get_clientdata(client);
-       struct device *dev = &client->dev;
-
-       /* Get GPIO from device tree */
-       phy->gpiod_ena = devm_gpiod_get_index(dev, ST21NFCA_GPIO_NAME_EN, 0,
-                                             GPIOD_OUT_HIGH);
-       if (IS_ERR(phy->gpiod_ena)) {
-               nfc_err(dev, "Failed to request enable pin\n");
-               return PTR_ERR(phy->gpiod_ena);
-       }
+static const struct acpi_gpio_params enable_gpios = { 1, 0, false };
 
-       return 0;
-}
+static const struct acpi_gpio_mapping acpi_st21nfca_gpios[] = {
+       { "enable-gpios", &enable_gpios, 1 },
+       {},
+};
 
 static int st21nfca_hci_i2c_probe(struct i2c_client *client,
                                  const struct i2c_device_id *id)
 {
+       struct device *dev = &client->dev;
        struct st21nfca_i2c_phy *phy;
        int r;
 
@@ -562,21 +536,15 @@ static int st21nfca_hci_i2c_probe(struct i2c_client *client,
        mutex_init(&phy->phy_lock);
        i2c_set_clientdata(client, phy);
 
-       if (client->dev.of_node) {
-               r = st21nfca_hci_i2c_of_request_resources(client);
-               if (r) {
-                       nfc_err(&client->dev, "No platform data\n");
-                       return r;
-               }
-       } else if (ACPI_HANDLE(&client->dev)) {
-               r = st21nfca_hci_i2c_acpi_request_resources(client);
-               if (r) {
-                       nfc_err(&client->dev, "Cannot get ACPI data\n");
-                       return r;
-               }
-       } else {
-               nfc_err(&client->dev, "st21nfca platform resources not available\n");
-               return -ENODEV;
+       r = devm_acpi_dev_add_driver_gpios(dev, acpi_st21nfca_gpios);
+       if (r)
+               dev_dbg(dev, "Unable to add GPIO mapping table\n");
+
+       /* Get EN GPIO from resource provider */
+       phy->gpiod_ena = devm_gpiod_get(dev, "enable", GPIOD_OUT_LOW);
+       if (IS_ERR(phy->gpiod_ena)) {
+               nfc_err(dev, "Unable to get ENABLE GPIO\n");
+               return PTR_ERR(phy->gpiod_ena);
        }
 
        phy->se_status.is_ese_present =
index 2d1c8ca6e67907002a05d284316925b951d178de..eee5cc1a9220453139eb0e16f8ff732555f64438 100644 (file)
@@ -20,9 +20,8 @@
 #include <linux/nfc.h>
 #include <linux/skbuff.h>
 #include <linux/delay.h>
-#include <linux/gpio.h>
+#include <linux/gpio/consumer.h>
 #include <linux/of.h>
-#include <linux/of_gpio.h>
 #include <linux/spi/spi.h>
 #include <linux/regulator/consumer.h>
 
                 NFC_PROTO_ISO14443_B_MASK | NFC_PROTO_FELICA_MASK | \
                 NFC_PROTO_ISO15693_MASK | NFC_PROTO_NFC_DEP_MASK)
 
-#define TRF7970A_AUTOSUSPEND_DELAY             30000 /* 30 seconds */
+#define TRF7970A_AUTOSUSPEND_DELAY             30000   /* 30 seconds */
 #define TRF7970A_13MHZ_CLOCK_FREQUENCY         13560000
 #define TRF7970A_27MHZ_CLOCK_FREQUENCY         27120000
 
-
 #define TRF7970A_RX_SKB_ALLOC_SIZE             256
 
 #define TRF7970A_FIFO_SIZE                     127
  */
 #define TRF7970A_QUIRK_IRQ_STATUS_READ         BIT(0)
 #define TRF7970A_QUIRK_EN2_MUST_STAY_LOW       BIT(1)
-#define TRF7970A_QUIRK_T5T_RMB_EXTRA_BYTE      BIT(2)
 
 /* Direct commands */
 #define TRF7970A_CMD_IDLE                      0x00
 #define TRF7970A_REG_IO_CTRL_AUTO_REG          BIT(7)
 
 /* IRQ Status Register Bits */
-#define TRF7970A_IRQ_STATUS_NORESP             BIT(0) /* ISO15693 only */
+#define TRF7970A_IRQ_STATUS_NORESP             BIT(0)  /* ISO15693 only */
 #define TRF7970A_IRQ_STATUS_NFC_COL_ERROR      BIT(0)
 #define TRF7970A_IRQ_STATUS_COL                        BIT(1)
 #define TRF7970A_IRQ_STATUS_FRAMING_EOF_ERROR  BIT(2)
@@ -451,16 +448,14 @@ struct trf7970a {
        u8                              md_rf_tech;
        u8                              tx_cmd;
        bool                            issue_eof;
-       bool                            adjust_resp_len;
-       int                             en2_gpio;
-       int                             en_gpio;
+       struct gpio_desc                *en_gpiod;
+       struct gpio_desc                *en2_gpiod;
        struct mutex                    lock;
        unsigned int                    timeout;
        bool                            ignore_timeout;
        struct delayed_work             timeout_work;
 };
 
-
 static int trf7970a_cmd(struct trf7970a *trf, u8 opcode)
 {
        u8 cmd = TRF7970A_CMD_BIT_CTRL | TRF7970A_CMD_BIT_OPCODE(opcode);
@@ -471,7 +466,7 @@ static int trf7970a_cmd(struct trf7970a *trf, u8 opcode)
        ret = spi_write(trf->spi, &cmd, 1);
        if (ret)
                dev_err(trf->dev, "%s - cmd: 0x%x, ret: %d\n", __func__, cmd,
-                               ret);
+                       ret);
        return ret;
 }
 
@@ -483,14 +478,15 @@ static int trf7970a_read(struct trf7970a *trf, u8 reg, u8 *val)
        ret = spi_write_then_read(trf->spi, &addr, 1, val, 1);
        if (ret)
                dev_err(trf->dev, "%s - addr: 0x%x, ret: %d\n", __func__, addr,
-                               ret);
+                       ret);
 
        dev_dbg(trf->dev, "read(0x%x): 0x%x\n", addr, *val);
 
        return ret;
 }
 
-static int trf7970a_read_cont(struct trf7970a *trf, u8 reg, u8 *buf, size_t len)
+static int trf7970a_read_cont(struct trf7970a *trf, u8 reg, u8 *buf,
+                             size_t len)
 {
        u8 addr = reg | TRF7970A_CMD_BIT_RW | TRF7970A_CMD_BIT_CONTINUOUS;
        struct spi_transfer t[2];
@@ -514,7 +510,7 @@ static int trf7970a_read_cont(struct trf7970a *trf, u8 reg, u8 *buf, size_t len)
        ret = spi_sync(trf->spi, &m);
        if (ret)
                dev_err(trf->dev, "%s - addr: 0x%x, ret: %d\n", __func__, addr,
-                               ret);
+                       ret);
        return ret;
 }
 
@@ -528,7 +524,7 @@ static int trf7970a_write(struct trf7970a *trf, u8 reg, u8 val)
        ret = spi_write(trf->spi, buf, 2);
        if (ret)
                dev_err(trf->dev, "%s - write: 0x%x 0x%x, ret: %d\n", __func__,
-                               buf[0], buf[1], ret);
+                       buf[0], buf[1], ret);
 
        return ret;
 }
@@ -550,7 +546,7 @@ static int trf7970a_read_irqstatus(struct trf7970a *trf, u8 *status)
 
        if (ret)
                dev_err(trf->dev, "%s - irqstatus: Status read failed: %d\n",
-                               __func__, ret);
+                       __func__, ret);
        else
                *status = buf[0];
 
@@ -564,12 +560,12 @@ static int trf7970a_read_target_proto(struct trf7970a *trf, u8 *target_proto)
        u8 addr;
 
        addr = TRF79070A_NFC_TARGET_PROTOCOL | TRF7970A_CMD_BIT_RW |
-               TRF7970A_CMD_BIT_CONTINUOUS;
+              TRF7970A_CMD_BIT_CONTINUOUS;
 
        ret = spi_write_then_read(trf->spi, &addr, 1, buf, 2);
        if (ret)
                dev_err(trf->dev, "%s - target_proto: Read failed: %d\n",
-                               __func__, ret);
+                       __func__, ret);
        else
                *target_proto = buf[0];
 
@@ -600,7 +596,7 @@ static int trf7970a_mode_detect(struct trf7970a *trf, u8 *rf_tech)
                break;
        default:
                dev_dbg(trf->dev, "%s - mode_detect: target_proto: 0x%x\n",
-                               __func__, target_proto);
+                       __func__, target_proto);
                return -EIO;
        }
 
@@ -616,8 +612,8 @@ static void trf7970a_send_upstream(struct trf7970a *trf)
 
        if (trf->rx_skb && !IS_ERR(trf->rx_skb) && !trf->aborting)
                print_hex_dump_debug("trf7970a rx data: ", DUMP_PREFIX_NONE,
-                               16, 1, trf->rx_skb->data, trf->rx_skb->len,
-                               false);
+                                    16, 1, trf->rx_skb->data, trf->rx_skb->len,
+                                    false);
 
        trf->state = TRF7970A_ST_IDLE;
 
@@ -632,13 +628,6 @@ static void trf7970a_send_upstream(struct trf7970a *trf)
                trf->aborting = false;
        }
 
-       if (trf->adjust_resp_len) {
-               if (trf->rx_skb)
-                       skb_trim(trf->rx_skb, trf->rx_skb->len - 1);
-
-               trf->adjust_resp_len = false;
-       }
-
        trf->cb(trf->ddev, trf->cb_arg, trf->rx_skb);
 
        trf->rx_skb = NULL;
@@ -657,7 +646,8 @@ static void trf7970a_send_err_upstream(struct trf7970a *trf, int errno)
 }
 
 static int trf7970a_transmit(struct trf7970a *trf, struct sk_buff *skb,
-               unsigned int len, u8 *prefix, unsigned int prefix_len)
+                            unsigned int len, u8 *prefix,
+                            unsigned int prefix_len)
 {
        struct spi_transfer t[2];
        struct spi_message m;
@@ -665,7 +655,7 @@ static int trf7970a_transmit(struct trf7970a *trf, struct sk_buff *skb,
        int ret;
 
        print_hex_dump_debug("trf7970a tx data: ", DUMP_PREFIX_NONE,
-                       16, 1, skb->data, len, false);
+                            16, 1, skb->data, len, false);
 
        spi_message_init(&m);
 
@@ -682,7 +672,7 @@ static int trf7970a_transmit(struct trf7970a *trf, struct sk_buff *skb,
        ret = spi_sync(trf->spi, &m);
        if (ret) {
                dev_err(trf->dev, "%s - Can't send tx data: %d\n", __func__,
-                               ret);
+                       ret);
                return ret;
        }
 
@@ -706,7 +696,7 @@ static int trf7970a_transmit(struct trf7970a *trf, struct sk_buff *skb,
        }
 
        dev_dbg(trf->dev, "Setting timeout for %d ms, state: %d\n", timeout,
-                       trf->state);
+               trf->state);
 
        schedule_delayed_work(&trf->timeout_work, msecs_to_jiffies(timeout));
 
@@ -774,9 +764,9 @@ static void trf7970a_drain_fifo(struct trf7970a *trf, u8 status)
 
        if (fifo_bytes > skb_tailroom(skb)) {
                skb = skb_copy_expand(skb, skb_headroom(skb),
-                               max_t(int, fifo_bytes,
-                                       TRF7970A_RX_SKB_ALLOC_SIZE),
-                               GFP_KERNEL);
+                                     max_t(int, fifo_bytes,
+                                           TRF7970A_RX_SKB_ALLOC_SIZE),
+                                     GFP_KERNEL);
                if (!skb) {
                        trf7970a_send_err_upstream(trf, -ENOMEM);
                        return;
@@ -787,7 +777,7 @@ static void trf7970a_drain_fifo(struct trf7970a *trf, u8 status)
        }
 
        ret = trf7970a_read_cont(trf, TRF7970A_FIFO_IO_REGISTER,
-                       skb_put(skb, fifo_bytes), fifo_bytes);
+                                skb_put(skb, fifo_bytes), fifo_bytes);
        if (ret) {
                trf7970a_send_err_upstream(trf, ret);
                return;
@@ -795,8 +785,7 @@ static void trf7970a_drain_fifo(struct trf7970a *trf, u8 status)
 
        /* If received Type 2 ACK/NACK, shift right 4 bits and pass up */
        if ((trf->framing == NFC_DIGITAL_FRAMING_NFCA_T2T) && (skb->len == 1) &&
-                       (trf->special_fcn_reg1 ==
-                                TRF7970A_SPECIAL_FCN_REG1_4_BIT_RX)) {
+           (trf->special_fcn_reg1 == TRF7970A_SPECIAL_FCN_REG1_4_BIT_RX)) {
                skb->data[0] >>= 4;
                status = TRF7970A_IRQ_STATUS_SRX;
        } else {
@@ -819,16 +808,16 @@ static void trf7970a_drain_fifo(struct trf7970a *trf, u8 status)
        }
 
 no_rx_data:
-       if (status == TRF7970A_IRQ_STATUS_SRX) { /* Receive complete */
+       if (status == TRF7970A_IRQ_STATUS_SRX) {        /* Receive complete */
                trf7970a_send_upstream(trf);
                return;
        }
 
        dev_dbg(trf->dev, "Setting timeout for %d ms\n",
-                       TRF7970A_WAIT_FOR_RX_DATA_TIMEOUT);
+               TRF7970A_WAIT_FOR_RX_DATA_TIMEOUT);
 
        schedule_delayed_work(&trf->timeout_work,
-                       msecs_to_jiffies(TRF7970A_WAIT_FOR_RX_DATA_TIMEOUT));
+                          msecs_to_jiffies(TRF7970A_WAIT_FOR_RX_DATA_TIMEOUT));
 }
 
 static irqreturn_t trf7970a_irq(int irq, void *dev_id)
@@ -851,7 +840,7 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
        }
 
        dev_dbg(trf->dev, "IRQ - state: %d, status: 0x%x\n", trf->state,
-                       status);
+               status);
 
        if (!status) {
                mutex_unlock(&trf->lock);
@@ -876,7 +865,7 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
        case TRF7970A_ST_WAIT_FOR_TX_FIFO:
                if (status & TRF7970A_IRQ_STATUS_TX) {
                        trf->ignore_timeout =
-                               !cancel_delayed_work(&trf->timeout_work);
+                           !cancel_delayed_work(&trf->timeout_work);
                        trf7970a_fill_fifo(trf);
                } else {
                        trf7970a_send_err_upstream(trf, -EIO);
@@ -886,11 +875,11 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
        case TRF7970A_ST_WAIT_FOR_RX_DATA_CONT:
                if (status & TRF7970A_IRQ_STATUS_SRX) {
                        trf->ignore_timeout =
-                               !cancel_delayed_work(&trf->timeout_work);
+                           !cancel_delayed_work(&trf->timeout_work);
                        trf7970a_drain_fifo(trf, status);
                } else if (status & TRF7970A_IRQ_STATUS_FIFO) {
                        ret = trf7970a_read(trf, TRF7970A_FIFO_STATUS,
-                                       &fifo_bytes);
+                                           &fifo_bytes);
 
                        fifo_bytes &= ~TRF7970A_FIFO_STATUS_OVERFLOW;
 
@@ -899,14 +888,14 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
                        else if (!fifo_bytes)
                                trf7970a_cmd(trf, TRF7970A_CMD_FIFO_RESET);
                } else if ((status == TRF7970A_IRQ_STATUS_TX) ||
-                               (!trf->is_initiator &&
-                                (status == (TRF7970A_IRQ_STATUS_TX |
-                                            TRF7970A_IRQ_STATUS_NFC_RF)))) {
+                          (!trf->is_initiator &&
+                           (status == (TRF7970A_IRQ_STATUS_TX |
+                                       TRF7970A_IRQ_STATUS_NFC_RF)))) {
                        trf7970a_cmd(trf, TRF7970A_CMD_FIFO_RESET);
 
                        if (!trf->timeout) {
-                               trf->ignore_timeout = !cancel_delayed_work(
-                                               &trf->timeout_work);
+                               trf->ignore_timeout =
+                                   !cancel_delayed_work(&trf->timeout_work);
                                trf->rx_skb = ERR_PTR(0);
                                trf7970a_send_upstream(trf);
                                break;
@@ -930,13 +919,13 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
                                break;
                        case NFC_DIGITAL_FRAMING_NFCA_ANTICOL_COMPLETE:
                                ret = trf7970a_write(trf,
-                                       TRF7970A_SPECIAL_FCN_REG1,
-                                       TRF7970A_SPECIAL_FCN_REG1_14_ANTICOLL);
+                                        TRF7970A_SPECIAL_FCN_REG1,
+                                        TRF7970A_SPECIAL_FCN_REG1_14_ANTICOLL);
                                if (ret)
                                        goto err_unlock_exit;
 
                                trf->special_fcn_reg1 =
-                                       TRF7970A_SPECIAL_FCN_REG1_14_ANTICOLL;
+                                   TRF7970A_SPECIAL_FCN_REG1_14_ANTICOLL;
                                break;
                        default:
                                break;
@@ -944,7 +933,7 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
 
                        if (iso_ctrl != trf->iso_ctrl) {
                                ret = trf7970a_write(trf, TRF7970A_ISO_CTRL,
-                                               iso_ctrl);
+                                                    iso_ctrl);
                                if (ret)
                                        goto err_unlock_exit;
 
@@ -961,7 +950,7 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
        case TRF7970A_ST_LISTENING:
                if (status & TRF7970A_IRQ_STATUS_SRX) {
                        trf->ignore_timeout =
-                               !cancel_delayed_work(&trf->timeout_work);
+                           !cancel_delayed_work(&trf->timeout_work);
                        trf7970a_drain_fifo(trf, status);
                } else if (!(status & TRF7970A_IRQ_STATUS_NFC_RF)) {
                        trf7970a_send_err_upstream(trf, -EIO);
@@ -970,7 +959,7 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
        case TRF7970A_ST_LISTENING_MD:
                if (status & TRF7970A_IRQ_STATUS_SRX) {
                        trf->ignore_timeout =
-                               !cancel_delayed_work(&trf->timeout_work);
+                           !cancel_delayed_work(&trf->timeout_work);
 
                        ret = trf7970a_mode_detect(trf, &trf->md_rf_tech);
                        if (ret) {
@@ -985,7 +974,7 @@ static irqreturn_t trf7970a_irq(int irq, void *dev_id)
                break;
        default:
                dev_err(trf->dev, "%s - Driver in invalid state: %d\n",
-                               __func__, trf->state);
+                       __func__, trf->state);
        }
 
 err_unlock_exit:
@@ -1010,19 +999,19 @@ static void trf7970a_issue_eof(struct trf7970a *trf)
        trf->state = TRF7970A_ST_WAIT_FOR_RX_DATA;
 
        dev_dbg(trf->dev, "Setting timeout for %d ms, state: %d\n",
-                       trf->timeout, trf->state);
+               trf->timeout, trf->state);
 
        schedule_delayed_work(&trf->timeout_work,
-                       msecs_to_jiffies(trf->timeout));
+                             msecs_to_jiffies(trf->timeout));
 }
 
 static void trf7970a_timeout_work_handler(struct work_struct *work)
 {
        struct trf7970a *trf = container_of(work, struct trf7970a,
-                       timeout_work.work);
+                                           timeout_work.work);
 
        dev_dbg(trf->dev, "Timeout - state: %d, ignore_timeout: %d\n",
-                       trf->state, trf->ignore_timeout);
+               trf->state, trf->ignore_timeout);
 
        mutex_lock(&trf->lock);
 
@@ -1053,7 +1042,7 @@ static int trf7970a_init(struct trf7970a *trf)
                goto err_out;
 
        ret = trf7970a_write(trf, TRF7970A_REG_IO_CTRL,
-                       trf->io_ctrl | TRF7970A_REG_IO_CTRL_VRS(0x1));
+                            trf->io_ctrl | TRF7970A_REG_IO_CTRL_VRS(0x1));
        if (ret)
                goto err_out;
 
@@ -1066,13 +1055,13 @@ static int trf7970a_init(struct trf7970a *trf)
        trf->chip_status_ctrl &= ~TRF7970A_CHIP_STATUS_RF_ON;
 
        ret = trf7970a_write(trf, TRF7970A_MODULATOR_SYS_CLK_CTRL,
-                       trf->modulator_sys_clk_ctrl);
+                            trf->modulator_sys_clk_ctrl);
        if (ret)
                goto err_out;
 
        ret = trf7970a_write(trf, TRF7970A_ADJUTABLE_FIFO_IRQ_LEVELS,
-                       TRF7970A_ADJUTABLE_FIFO_IRQ_LEVELS_WLH_96 |
-                       TRF7970A_ADJUTABLE_FIFO_IRQ_LEVELS_WLL_32);
+                            TRF7970A_ADJUTABLE_FIFO_IRQ_LEVELS_WLH_96 |
+                            TRF7970A_ADJUTABLE_FIFO_IRQ_LEVELS_WLL_32);
        if (ret)
                goto err_out;
 
@@ -1093,7 +1082,7 @@ static int trf7970a_init(struct trf7970a *trf)
 static void trf7970a_switch_rf_off(struct trf7970a *trf)
 {
        if ((trf->state == TRF7970A_ST_PWR_OFF) ||
-                       (trf->state == TRF7970A_ST_RF_OFF))
+           (trf->state == TRF7970A_ST_RF_OFF))
                return;
 
        dev_dbg(trf->dev, "Switching rf off\n");
@@ -1117,9 +1106,9 @@ static int trf7970a_switch_rf_on(struct trf7970a *trf)
 
        pm_runtime_get_sync(trf->dev);
 
-       if (trf->state != TRF7970A_ST_RF_OFF) { /* Power on, RF off */
+       if (trf->state != TRF7970A_ST_RF_OFF) { /* Power on, RF off */
                dev_err(trf->dev, "%s - Incorrect state: %d\n", __func__,
-                               trf->state);
+                       trf->state);
                return -EINVAL;
        }
 
@@ -1154,7 +1143,7 @@ static int trf7970a_switch_rf(struct nfc_digital_dev *ddev, bool on)
                        break;
                default:
                        dev_err(trf->dev, "%s - Invalid request: %d %d\n",
-                                       __func__, trf->state, on);
+                               __func__, trf->state, on);
                        trf7970a_switch_rf_off(trf);
                        ret = -EINVAL;
                }
@@ -1165,7 +1154,7 @@ static int trf7970a_switch_rf(struct nfc_digital_dev *ddev, bool on)
                        break;
                default:
                        dev_err(trf->dev, "%s - Invalid request: %d %d\n",
-                                       __func__, trf->state, on);
+                               __func__, trf->state, on);
                        ret = -EINVAL;
                        /* FALLTHROUGH */
                case TRF7970A_ST_IDLE:
@@ -1190,36 +1179,36 @@ static int trf7970a_in_config_rf_tech(struct trf7970a *trf, int tech)
        case NFC_DIGITAL_RF_TECH_106A:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_14443A_106;
                trf->modulator_sys_clk_ctrl =
-                       (trf->modulator_sys_clk_ctrl & 0xf8) |
-                       TRF7970A_MODULATOR_DEPTH_OOK;
+                   (trf->modulator_sys_clk_ctrl & 0xf8) |
+                   TRF7970A_MODULATOR_DEPTH_OOK;
                trf->guard_time = TRF7970A_GUARD_TIME_NFCA;
                break;
        case NFC_DIGITAL_RF_TECH_106B:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_14443B_106;
                trf->modulator_sys_clk_ctrl =
-                       (trf->modulator_sys_clk_ctrl & 0xf8) |
-                       TRF7970A_MODULATOR_DEPTH_ASK10;
+                   (trf->modulator_sys_clk_ctrl & 0xf8) |
+                   TRF7970A_MODULATOR_DEPTH_ASK10;
                trf->guard_time = TRF7970A_GUARD_TIME_NFCB;
                break;
        case NFC_DIGITAL_RF_TECH_212F:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_FELICA_212;
                trf->modulator_sys_clk_ctrl =
-                       (trf->modulator_sys_clk_ctrl & 0xf8) |
-                       TRF7970A_MODULATOR_DEPTH_ASK10;
+                   (trf->modulator_sys_clk_ctrl & 0xf8) |
+                   TRF7970A_MODULATOR_DEPTH_ASK10;
                trf->guard_time = TRF7970A_GUARD_TIME_NFCF;
                break;
        case NFC_DIGITAL_RF_TECH_424F:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_FELICA_424;
                trf->modulator_sys_clk_ctrl =
-                       (trf->modulator_sys_clk_ctrl & 0xf8) |
-                       TRF7970A_MODULATOR_DEPTH_ASK10;
+                   (trf->modulator_sys_clk_ctrl & 0xf8) |
+                   TRF7970A_MODULATOR_DEPTH_ASK10;
                trf->guard_time = TRF7970A_GUARD_TIME_NFCF;
                break;
        case NFC_DIGITAL_RF_TECH_ISO15693:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_15693_SGL_1OF4_2648;
                trf->modulator_sys_clk_ctrl =
-                       (trf->modulator_sys_clk_ctrl & 0xf8) |
-                       TRF7970A_MODULATOR_DEPTH_OOK;
+                   (trf->modulator_sys_clk_ctrl & 0xf8) |
+                   TRF7970A_MODULATOR_DEPTH_OOK;
                trf->guard_time = TRF7970A_GUARD_TIME_15693;
                break;
        default:
@@ -1246,7 +1235,8 @@ static int trf7970a_is_rf_field(struct trf7970a *trf, bool *is_rf_field)
        u8 rssi;
 
        ret = trf7970a_write(trf, TRF7970A_CHIP_STATUS_CTRL,
-                       trf->chip_status_ctrl | TRF7970A_CHIP_STATUS_REC_ON);
+                            trf->chip_status_ctrl |
+                            TRF7970A_CHIP_STATUS_REC_ON);
        if (ret)
                return ret;
 
@@ -1261,7 +1251,7 @@ static int trf7970a_is_rf_field(struct trf7970a *trf, bool *is_rf_field)
                return ret;
 
        ret = trf7970a_write(trf, TRF7970A_CHIP_STATUS_CTRL,
-                       trf->chip_status_ctrl);
+                            trf->chip_status_ctrl);
        if (ret)
                return ret;
 
@@ -1328,15 +1318,15 @@ static int trf7970a_in_config_framing(struct trf7970a *trf, int framing)
                trf->iso_ctrl = iso_ctrl;
 
                ret = trf7970a_write(trf, TRF7970A_MODULATOR_SYS_CLK_CTRL,
-                               trf->modulator_sys_clk_ctrl);
+                                    trf->modulator_sys_clk_ctrl);
                if (ret)
                        return ret;
        }
 
        if (!(trf->chip_status_ctrl & TRF7970A_CHIP_STATUS_RF_ON)) {
                ret = trf7970a_write(trf, TRF7970A_CHIP_STATUS_CTRL,
-                               trf->chip_status_ctrl |
-                                       TRF7970A_CHIP_STATUS_RF_ON);
+                                    trf->chip_status_ctrl |
+                                    TRF7970A_CHIP_STATUS_RF_ON);
                if (ret)
                        return ret;
 
@@ -1349,7 +1339,7 @@ static int trf7970a_in_config_framing(struct trf7970a *trf, int framing)
 }
 
 static int trf7970a_in_configure_hw(struct nfc_digital_dev *ddev, int type,
-               int param)
+                                   int param)
 {
        struct trf7970a *trf = nfc_digital_get_drvdata(ddev);
        int ret;
@@ -1361,7 +1351,7 @@ static int trf7970a_in_configure_hw(struct nfc_digital_dev *ddev, int type,
        trf->is_initiator = true;
 
        if ((trf->state == TRF7970A_ST_PWR_OFF) ||
-                       (trf->state == TRF7970A_ST_RF_OFF)) {
+           (trf->state == TRF7970A_ST_RF_OFF)) {
                ret = trf7970a_switch_rf_on(trf);
                if (ret)
                        goto err_unlock;
@@ -1419,7 +1409,7 @@ static int trf7970a_per_cmd_config(struct trf7970a *trf, struct sk_buff *skb)
         * has to send an EOF in order to get a response.
         */
        if ((trf->technology == NFC_DIGITAL_RF_TECH_106A) &&
-                       (trf->framing == NFC_DIGITAL_FRAMING_NFCA_T2T)) {
+           (trf->framing == NFC_DIGITAL_FRAMING_NFCA_T2T)) {
                if (req[0] == NFC_T2T_CMD_READ)
                        special_fcn_reg1 = 0;
                else
@@ -1427,7 +1417,7 @@ static int trf7970a_per_cmd_config(struct trf7970a *trf, struct sk_buff *skb)
 
                if (special_fcn_reg1 != trf->special_fcn_reg1) {
                        ret = trf7970a_write(trf, TRF7970A_SPECIAL_FCN_REG1,
-                                       special_fcn_reg1);
+                                            special_fcn_reg1);
                        if (ret)
                                return ret;
 
@@ -1447,7 +1437,7 @@ static int trf7970a_per_cmd_config(struct trf7970a *trf, struct sk_buff *skb)
                        iso_ctrl |= TRF7970A_ISO_CTRL_15693_SGL_1OF4_2648;
                        break;
                case (ISO15693_REQ_FLAG_SUB_CARRIER |
-                               ISO15693_REQ_FLAG_DATA_RATE):
+                     ISO15693_REQ_FLAG_DATA_RATE):
                        iso_ctrl |= TRF7970A_ISO_CTRL_15693_DBL_1OF4_2669;
                        break;
                }
@@ -1460,23 +1450,18 @@ static int trf7970a_per_cmd_config(struct trf7970a *trf, struct sk_buff *skb)
                        trf->iso_ctrl = iso_ctrl;
                }
 
-               if (trf->framing == NFC_DIGITAL_FRAMING_ISO15693_T5T) {
-                       if (trf7970a_is_iso15693_write_or_lock(req[1]) &&
-                                       (req[0] & ISO15693_REQ_FLAG_OPTION))
-                               trf->issue_eof = true;
-                       else if ((trf->quirks &
-                                       TRF7970A_QUIRK_T5T_RMB_EXTRA_BYTE) &&
-                                (req[1] == ISO15693_CMD_READ_MULTIPLE_BLOCK))
-                               trf->adjust_resp_len = true;
-               }
+               if ((trf->framing == NFC_DIGITAL_FRAMING_ISO15693_T5T) &&
+                   trf7970a_is_iso15693_write_or_lock(req[1]) &&
+                   (req[0] & ISO15693_REQ_FLAG_OPTION))
+                       trf->issue_eof = true;
        }
 
        return 0;
 }
 
 static int trf7970a_send_cmd(struct nfc_digital_dev *ddev,
-               struct sk_buff *skb, u16 timeout,
-               nfc_digital_cmd_complete_t cb, void *arg)
+                            struct sk_buff *skb, u16 timeout,
+                            nfc_digital_cmd_complete_t cb, void *arg)
 {
        struct trf7970a *trf = nfc_digital_get_drvdata(ddev);
        u8 prefix[5];
@@ -1485,7 +1470,7 @@ static int trf7970a_send_cmd(struct nfc_digital_dev *ddev,
        u8 status;
 
        dev_dbg(trf->dev, "New request - state: %d, timeout: %d ms, len: %d\n",
-                       trf->state, timeout, skb->len);
+               trf->state, timeout, skb->len);
 
        if (skb->len > TRF7970A_TX_MAX)
                return -EINVAL;
@@ -1493,9 +1478,9 @@ static int trf7970a_send_cmd(struct nfc_digital_dev *ddev,
        mutex_lock(&trf->lock);
 
        if ((trf->state != TRF7970A_ST_IDLE) &&
-                       (trf->state != TRF7970A_ST_IDLE_RX_BLOCKED)) {
+           (trf->state != TRF7970A_ST_IDLE_RX_BLOCKED)) {
                dev_err(trf->dev, "%s - Bogus state: %d\n", __func__,
-                               trf->state);
+                       trf->state);
                ret = -EIO;
                goto out_err;
        }
@@ -1509,7 +1494,7 @@ static int trf7970a_send_cmd(struct nfc_digital_dev *ddev,
 
        if (timeout) {
                trf->rx_skb = nfc_alloc_recv_skb(TRF7970A_RX_SKB_ALLOC_SIZE,
-                               GFP_KERNEL);
+                                                GFP_KERNEL);
                if (!trf->rx_skb) {
                        dev_dbg(trf->dev, "Can't alloc rx_skb\n");
                        ret = -ENOMEM;
@@ -1546,14 +1531,14 @@ static int trf7970a_send_cmd(struct nfc_digital_dev *ddev,
         * That totals 5 bytes.
         */
        prefix[0] = TRF7970A_CMD_BIT_CTRL |
-                       TRF7970A_CMD_BIT_OPCODE(TRF7970A_CMD_FIFO_RESET);
+           TRF7970A_CMD_BIT_OPCODE(TRF7970A_CMD_FIFO_RESET);
        prefix[1] = TRF7970A_CMD_BIT_CTRL |
-                       TRF7970A_CMD_BIT_OPCODE(trf->tx_cmd);
+           TRF7970A_CMD_BIT_OPCODE(trf->tx_cmd);
        prefix[2] = TRF7970A_CMD_BIT_CONTINUOUS | TRF7970A_TX_LENGTH_BYTE1;
 
        if (trf->framing == NFC_DIGITAL_FRAMING_NFCA_SHORT) {
                prefix[3] = 0x00;
-               prefix[4] = 0x0f; /* 7 bits */
+               prefix[4] = 0x0f;       /* 7 bits */
        } else {
                prefix[3] = (len & 0xf00) >> 4;
                prefix[3] |= ((len & 0xf0) >> 4);
@@ -1587,25 +1572,24 @@ static int trf7970a_tg_config_rf_tech(struct trf7970a *trf, int tech)
        switch (tech) {
        case NFC_DIGITAL_RF_TECH_106A:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_NFC_NFC_CE_MODE |
-                       TRF7970A_ISO_CTRL_NFC_CE |
-                       TRF7970A_ISO_CTRL_NFC_CE_14443A;
+                   TRF7970A_ISO_CTRL_NFC_CE | TRF7970A_ISO_CTRL_NFC_CE_14443A;
                trf->modulator_sys_clk_ctrl =
-                       (trf->modulator_sys_clk_ctrl & 0xf8) |
-                       TRF7970A_MODULATOR_DEPTH_OOK;
+                   (trf->modulator_sys_clk_ctrl & 0xf8) |
+                   TRF7970A_MODULATOR_DEPTH_OOK;
                break;
        case NFC_DIGITAL_RF_TECH_212F:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_NFC_NFC_CE_MODE |
-                       TRF7970A_ISO_CTRL_NFC_NFCF_212;
+                   TRF7970A_ISO_CTRL_NFC_NFCF_212;
                trf->modulator_sys_clk_ctrl =
-                       (trf->modulator_sys_clk_ctrl & 0xf8) |
-                       TRF7970A_MODULATOR_DEPTH_ASK10;
+                   (trf->modulator_sys_clk_ctrl & 0xf8) |
+                   TRF7970A_MODULATOR_DEPTH_ASK10;
                break;
        case NFC_DIGITAL_RF_TECH_424F:
                trf->iso_ctrl_tech = TRF7970A_ISO_CTRL_NFC_NFC_CE_MODE |
-                       TRF7970A_ISO_CTRL_NFC_NFCF_424;
+                   TRF7970A_ISO_CTRL_NFC_NFCF_424;
                trf->modulator_sys_clk_ctrl =
-                       (trf->modulator_sys_clk_ctrl & 0xf8) |
-                       TRF7970A_MODULATOR_DEPTH_ASK10;
+                   (trf->modulator_sys_clk_ctrl & 0xf8) |
+                   TRF7970A_MODULATOR_DEPTH_ASK10;
                break;
        default:
                dev_dbg(trf->dev, "Unsupported rf technology: %d\n", tech);
@@ -1622,9 +1606,9 @@ static int trf7970a_tg_config_rf_tech(struct trf7970a *trf, int tech)
         * here.
         */
        if ((trf->framing == NFC_DIGITAL_FRAMING_NFC_DEP_ACTIVATED) &&
-                       (trf->iso_ctrl_tech != trf->iso_ctrl)) {
+           (trf->iso_ctrl_tech != trf->iso_ctrl)) {
                ret = trf7970a_write(trf, TRF7970A_ISO_CTRL,
-                               trf->iso_ctrl_tech);
+                                    trf->iso_ctrl_tech);
 
                trf->iso_ctrl = trf->iso_ctrl_tech;
        }
@@ -1679,15 +1663,15 @@ static int trf7970a_tg_config_framing(struct trf7970a *trf, int framing)
                trf->iso_ctrl = iso_ctrl;
 
                ret = trf7970a_write(trf, TRF7970A_MODULATOR_SYS_CLK_CTRL,
-                               trf->modulator_sys_clk_ctrl);
+                                    trf->modulator_sys_clk_ctrl);
                if (ret)
                        return ret;
        }
 
        if (!(trf->chip_status_ctrl & TRF7970A_CHIP_STATUS_RF_ON)) {
                ret = trf7970a_write(trf, TRF7970A_CHIP_STATUS_CTRL,
-                               trf->chip_status_ctrl |
-                                       TRF7970A_CHIP_STATUS_RF_ON);
+                                    trf->chip_status_ctrl |
+                                    TRF7970A_CHIP_STATUS_RF_ON);
                if (ret)
                        return ret;
 
@@ -1698,7 +1682,7 @@ static int trf7970a_tg_config_framing(struct trf7970a *trf, int framing)
 }
 
 static int trf7970a_tg_configure_hw(struct nfc_digital_dev *ddev, int type,
-               int param)
+                                   int param)
 {
        struct trf7970a *trf = nfc_digital_get_drvdata(ddev);
        int ret;
@@ -1710,7 +1694,7 @@ static int trf7970a_tg_configure_hw(struct nfc_digital_dev *ddev, int type,
        trf->is_initiator = false;
 
        if ((trf->state == TRF7970A_ST_PWR_OFF) ||
-                       (trf->state == TRF7970A_ST_RF_OFF)) {
+           (trf->state == TRF7970A_ST_RF_OFF)) {
                ret = trf7970a_switch_rf_on(trf);
                if (ret)
                        goto err_unlock;
@@ -1734,7 +1718,8 @@ static int trf7970a_tg_configure_hw(struct nfc_digital_dev *ddev, int type,
 }
 
 static int _trf7970a_tg_listen(struct nfc_digital_dev *ddev, u16 timeout,
-               nfc_digital_cmd_complete_t cb, void *arg, bool mode_detect)
+                              nfc_digital_cmd_complete_t cb, void *arg,
+                              bool mode_detect)
 {
        struct trf7970a *trf = nfc_digital_get_drvdata(ddev);
        int ret;
@@ -1742,9 +1727,9 @@ static int _trf7970a_tg_listen(struct nfc_digital_dev *ddev, u16 timeout,
        mutex_lock(&trf->lock);
 
        if ((trf->state != TRF7970A_ST_IDLE) &&
-                       (trf->state != TRF7970A_ST_IDLE_RX_BLOCKED)) {
+           (trf->state != TRF7970A_ST_IDLE_RX_BLOCKED)) {
                dev_err(trf->dev, "%s - Bogus state: %d\n", __func__,
-                               trf->state);
+                       trf->state);
                ret = -EIO;
                goto out_err;
        }
@@ -1757,7 +1742,7 @@ static int _trf7970a_tg_listen(struct nfc_digital_dev *ddev, u16 timeout,
        }
 
        trf->rx_skb = nfc_alloc_recv_skb(TRF7970A_RX_SKB_ALLOC_SIZE,
-                       GFP_KERNEL);
+                                        GFP_KERNEL);
        if (!trf->rx_skb) {
                dev_dbg(trf->dev, "Can't alloc rx_skb\n");
                ret = -ENOMEM;
@@ -1765,25 +1750,25 @@ static int _trf7970a_tg_listen(struct nfc_digital_dev *ddev, u16 timeout,
        }
 
        ret = trf7970a_write(trf, TRF7970A_RX_SPECIAL_SETTINGS,
-                       TRF7970A_RX_SPECIAL_SETTINGS_HBT |
-                       TRF7970A_RX_SPECIAL_SETTINGS_M848 |
-                       TRF7970A_RX_SPECIAL_SETTINGS_C424 |
-                       TRF7970A_RX_SPECIAL_SETTINGS_C212);
+                            TRF7970A_RX_SPECIAL_SETTINGS_HBT |
+                            TRF7970A_RX_SPECIAL_SETTINGS_M848 |
+                            TRF7970A_RX_SPECIAL_SETTINGS_C424 |
+                            TRF7970A_RX_SPECIAL_SETTINGS_C212);
        if (ret)
                goto out_err;
 
        ret = trf7970a_write(trf, TRF7970A_REG_IO_CTRL,
-                       trf->io_ctrl | TRF7970A_REG_IO_CTRL_VRS(0x1));
+                            trf->io_ctrl | TRF7970A_REG_IO_CTRL_VRS(0x1));
        if (ret)
                goto out_err;
 
        ret = trf7970a_write(trf, TRF7970A_NFC_LOW_FIELD_LEVEL,
-                       TRF7970A_NFC_LOW_FIELD_LEVEL_RFDET(0x3));
+                            TRF7970A_NFC_LOW_FIELD_LEVEL_RFDET(0x3));
        if (ret)
                goto out_err;
 
        ret = trf7970a_write(trf, TRF7970A_NFC_TARGET_LEVEL,
-                       TRF7970A_NFC_TARGET_LEVEL_RFDET(0x7));
+                            TRF7970A_NFC_TARGET_LEVEL_RFDET(0x7));
        if (ret)
                goto out_err;
 
@@ -1808,32 +1793,33 @@ static int _trf7970a_tg_listen(struct nfc_digital_dev *ddev, u16 timeout,
 }
 
 static int trf7970a_tg_listen(struct nfc_digital_dev *ddev, u16 timeout,
-               nfc_digital_cmd_complete_t cb, void *arg)
+                             nfc_digital_cmd_complete_t cb, void *arg)
 {
        struct trf7970a *trf = nfc_digital_get_drvdata(ddev);
 
        dev_dbg(trf->dev, "Listen - state: %d, timeout: %d ms\n",
-                       trf->state, timeout);
+               trf->state, timeout);
 
        return _trf7970a_tg_listen(ddev, timeout, cb, arg, false);
 }
 
 static int trf7970a_tg_listen_md(struct nfc_digital_dev *ddev,
-               u16 timeout, nfc_digital_cmd_complete_t cb, void *arg)
+                                u16 timeout, nfc_digital_cmd_complete_t cb,
+                                void *arg)
 {
        struct trf7970a *trf = nfc_digital_get_drvdata(ddev);
        int ret;
 
        dev_dbg(trf->dev, "Listen MD - state: %d, timeout: %d ms\n",
-                       trf->state, timeout);
+               trf->state, timeout);
 
        ret = trf7970a_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
-                       NFC_DIGITAL_RF_TECH_106A);
+                                      NFC_DIGITAL_RF_TECH_106A);
        if (ret)
                return ret;
 
        ret = trf7970a_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
-                       NFC_DIGITAL_FRAMING_NFCA_NFC_DEP);
+                                      NFC_DIGITAL_FRAMING_NFCA_NFC_DEP);
        if (ret)
                return ret;
 
@@ -1845,7 +1831,7 @@ static int trf7970a_tg_get_rf_tech(struct nfc_digital_dev *ddev, u8 *rf_tech)
        struct trf7970a *trf = nfc_digital_get_drvdata(ddev);
 
        dev_dbg(trf->dev, "Get RF Tech - state: %d, rf_tech: %d\n",
-                       trf->state, trf->md_rf_tech);
+               trf->state, trf->md_rf_tech);
 
        *rf_tech = trf->md_rf_tech;
 
@@ -1908,14 +1894,13 @@ static int trf7970a_power_up(struct trf7970a *trf)
 
        usleep_range(5000, 6000);
 
-       if (!(trf->quirks & TRF7970A_QUIRK_EN2_MUST_STAY_LOW)) {
-               if (gpio_is_valid(trf->en2_gpio)) {
-                       gpio_set_value(trf->en2_gpio, 1);
-                       usleep_range(1000, 2000);
-               }
+       if (trf->en2_gpiod &&
+           !(trf->quirks & TRF7970A_QUIRK_EN2_MUST_STAY_LOW)) {
+               gpiod_set_value_cansleep(trf->en2_gpiod, 1);
+               usleep_range(1000, 2000);
        }
 
-       gpio_set_value(trf->en_gpio, 1);
+       gpiod_set_value_cansleep(trf->en_gpiod, 1);
 
        usleep_range(20000, 21000);
 
@@ -1935,18 +1920,19 @@ static int trf7970a_power_down(struct trf7970a *trf)
 
        if (trf->state != TRF7970A_ST_RF_OFF) {
                dev_dbg(trf->dev, "Can't power down - not RF_OFF state (%d)\n",
-                               trf->state);
+                       trf->state);
                return -EBUSY;
        }
 
-       gpio_set_value(trf->en_gpio, 0);
-       if (gpio_is_valid(trf->en2_gpio))
-               gpio_set_value(trf->en2_gpio, 0);
+       gpiod_set_value_cansleep(trf->en_gpiod, 0);
+
+       if (trf->en2_gpiod && !(trf->quirks & TRF7970A_QUIRK_EN2_MUST_STAY_LOW))
+               gpiod_set_value_cansleep(trf->en2_gpiod, 0);
 
        ret = regulator_disable(trf->regulator);
        if (ret)
                dev_err(trf->dev, "%s - Can't disable VIN: %d\n", __func__,
-                               ret);
+                       ret);
 
        trf->state = TRF7970A_ST_PWR_OFF;
 
@@ -2003,12 +1989,6 @@ static int trf7970a_get_autosuspend_delay(struct device_node *np)
        return autosuspend_delay;
 }
 
-static int trf7970a_get_vin_voltage_override(struct device_node *np,
-               u32 *vin_uvolts)
-{
-       return of_property_read_u32(np, "vin-voltage-override", vin_uvolts);
-}
-
 static int trf7970a_probe(struct spi_device *spi)
 {
        struct device_node *np = spi->dev.of_node;
@@ -2038,53 +2018,48 @@ static int trf7970a_probe(struct spi_device *spi)
                return ret;
        }
 
-       if (of_property_read_bool(np, "t5t-rmb-extra-byte-quirk"))
-               trf->quirks |= TRF7970A_QUIRK_T5T_RMB_EXTRA_BYTE;
-
        if (of_property_read_bool(np, "irq-status-read-quirk"))
                trf->quirks |= TRF7970A_QUIRK_IRQ_STATUS_READ;
 
-       /* There are two enable pins - both must be present */
-       trf->en_gpio = of_get_named_gpio(np, "ti,enable-gpios", 0);
-       if (!gpio_is_valid(trf->en_gpio)) {
+       /* There are two enable pins - only EN must be present in the DT */
+       trf->en_gpiod = devm_gpiod_get_index(trf->dev, "ti,enable", 0,
+                                            GPIOD_OUT_LOW);
+       if (IS_ERR(trf->en_gpiod)) {
                dev_err(trf->dev, "No EN GPIO property\n");
-               return trf->en_gpio;
+               return PTR_ERR(trf->en_gpiod);
        }
 
-       ret = devm_gpio_request_one(trf->dev, trf->en_gpio,
-                       GPIOF_DIR_OUT | GPIOF_INIT_LOW, "trf7970a EN");
-       if (ret) {
-               dev_err(trf->dev, "Can't request EN GPIO: %d\n", ret);
-               return ret;
-       }
-
-       trf->en2_gpio = of_get_named_gpio(np, "ti,enable-gpios", 1);
-       if (!gpio_is_valid(trf->en2_gpio)) {
+       trf->en2_gpiod = devm_gpiod_get_index_optional(trf->dev, "ti,enable", 1,
+                                                      GPIOD_OUT_LOW);
+       if (!trf->en2_gpiod) {
                dev_info(trf->dev, "No EN2 GPIO property\n");
-       } else {
-               ret = devm_gpio_request_one(trf->dev, trf->en2_gpio,
-                               GPIOF_DIR_OUT | GPIOF_INIT_LOW, "trf7970a EN2");
-               if (ret) {
-                       dev_err(trf->dev, "Can't request EN2 GPIO: %d\n", ret);
-                       return ret;
-               }
+       } else if (IS_ERR(trf->en2_gpiod)) {
+               dev_err(trf->dev, "Error getting EN2 GPIO property: %ld\n",
+                       PTR_ERR(trf->en2_gpiod));
+               return PTR_ERR(trf->en2_gpiod);
+       } else if (of_property_read_bool(np, "en2-rf-quirk")) {
+               trf->quirks |= TRF7970A_QUIRK_EN2_MUST_STAY_LOW;
        }
 
        of_property_read_u32(np, "clock-frequency", &clk_freq);
-       if ((clk_freq != TRF7970A_27MHZ_CLOCK_FREQUENCY) ||
-               (clk_freq != TRF7970A_13MHZ_CLOCK_FREQUENCY)) {
+       if ((clk_freq != TRF7970A_27MHZ_CLOCK_FREQUENCY) &&
+           (clk_freq != TRF7970A_13MHZ_CLOCK_FREQUENCY)) {
                dev_err(trf->dev,
-                       "clock-frequency (%u Hz) unsupported\n",
-                       clk_freq);
+                       "clock-frequency (%u Hz) unsupported\n", clk_freq);
                return -EINVAL;
        }
 
-       if (of_property_read_bool(np, "en2-rf-quirk"))
-               trf->quirks |= TRF7970A_QUIRK_EN2_MUST_STAY_LOW;
+       if (clk_freq == TRF7970A_27MHZ_CLOCK_FREQUENCY) {
+               trf->modulator_sys_clk_ctrl = TRF7970A_MODULATOR_27MHZ;
+               dev_dbg(trf->dev, "trf7970a configured for 27MHz crystal\n");
+       } else {
+               trf->modulator_sys_clk_ctrl = 0;
+       }
 
        ret = devm_request_threaded_irq(trf->dev, spi->irq, NULL,
-                       trf7970a_irq, IRQF_TRIGGER_RISING | IRQF_ONESHOT,
-                       "trf7970a", trf);
+                                       trf7970a_irq,
+                                       IRQF_TRIGGER_RISING | IRQF_ONESHOT,
+                                       "trf7970a", trf);
        if (ret) {
                dev_err(trf->dev, "Can't request IRQ#%d: %d\n", spi->irq, ret);
                return ret;
@@ -2106,10 +2081,7 @@ static int trf7970a_probe(struct spi_device *spi)
                goto err_destroy_lock;
        }
 
-       ret = trf7970a_get_vin_voltage_override(np, &uvolts);
-       if (ret)
-               uvolts = regulator_get_voltage(trf->regulator);
-
+       uvolts = regulator_get_voltage(trf->regulator);
        if (uvolts > 4000000)
                trf->chip_status_ctrl = TRF7970A_CHIP_STATUS_VRS5_3;
 
@@ -2132,9 +2104,10 @@ static int trf7970a_probe(struct spi_device *spi)
        }
 
        trf->ddev = nfc_digital_allocate_device(&trf7970a_nfc_ops,
-                       TRF7970A_SUPPORTED_PROTOCOLS,
-                       NFC_DIGITAL_DRV_CAPS_IN_CRC |
-                               NFC_DIGITAL_DRV_CAPS_TG_CRC, 0, 0);
+                                               TRF7970A_SUPPORTED_PROTOCOLS,
+                                               NFC_DIGITAL_DRV_CAPS_IN_CRC |
+                                               NFC_DIGITAL_DRV_CAPS_TG_CRC, 0,
+                                               0);
        if (!trf->ddev) {
                dev_err(trf->dev, "Can't allocate NFC digital device\n");
                ret = -ENOMEM;
@@ -2157,7 +2130,7 @@ static int trf7970a_probe(struct spi_device *spi)
        ret = nfc_digital_register_device(trf->ddev);
        if (ret) {
                dev_err(trf->dev, "Can't register NFC digital device: %d\n",
-                               ret);
+                       ret);
                goto err_shutdown;
        }
 
@@ -2266,29 +2239,31 @@ static int trf7970a_pm_runtime_resume(struct device *dev)
 static const struct dev_pm_ops trf7970a_pm_ops = {
        SET_SYSTEM_SLEEP_PM_OPS(trf7970a_suspend, trf7970a_resume)
        SET_RUNTIME_PM_OPS(trf7970a_pm_runtime_suspend,
-                       trf7970a_pm_runtime_resume, NULL)
+                          trf7970a_pm_runtime_resume, NULL)
 };
 
 static const struct of_device_id trf7970a_of_match[] = {
-       { .compatible = "ti,trf7970a", },
-       { /* sentinel */ },
+       {.compatible = "ti,trf7970a",},
+       {},
 };
+
 MODULE_DEVICE_TABLE(of, trf7970a_of_match);
 
 static const struct spi_device_id trf7970a_id_table[] = {
-       { "trf7970a", 0 },
-       { }
+       {"trf7970a", 0},
+       {}
 };
+
 MODULE_DEVICE_TABLE(spi, trf7970a_id_table);
 
 static struct spi_driver trf7970a_spi_driver = {
        .probe          = trf7970a_probe,
        .remove         = trf7970a_remove,
        .id_table       = trf7970a_id_table,
-       .driver         = {
-               .name   = "trf7970a",
-               .of_match_table = of_match_ptr(trf7970a_of_match),
-               .pm     = &trf7970a_pm_ops,
+       .driver = {
+               .name           = "trf7970a",
+               .of_match_table = of_match_ptr(trf7970a_of_match),
+               .pm             = &trf7970a_pm_ops,
        },
 };
 
index a6f9d633f5bedf8ca1c3ca302de283edb18bfaf2..9e75ac8d19be3ee1fa619af941a418a23261e902 100644 (file)
@@ -23,7 +23,7 @@ struct nfcmrvl_platform_data {
         */
 
        /* GPIO that is wired to RESET_N signal */
-       unsigned int reset_n_io;
+       int reset_n_io;
        /* Tell if transport is muxed in HCI one */
        unsigned int hci_muxed;
 
diff --git a/include/linux/platform_data/st-nci.h b/include/linux/platform_data/st-nci.h
deleted file mode 100644 (file)
index f6494b3..0000000
+++ /dev/null
@@ -1,31 +0,0 @@
-/*
- * Driver include for ST NCI NFC chip family.
- *
- * Copyright (C) 2014-2015  STMicroelectronics SAS. All rights reserved.
- *
- * This program is free software; you can redistribute it and/or modify it
- * under the terms and conditions of the GNU General Public License,
- * version 2, as published by the Free Software Foundation.
- *
- * This program is distributed in the hope that it will be useful,
- * but WITHOUT ANY WARRANTY; without even the implied warranty of
- * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
- * GNU General Public License for more details.
- *
- * You should have received a copy of the GNU General Public License
- * along with this program; if not, see <http://www.gnu.org/licenses/>.
- */
-
-#ifndef _ST_NCI_H_
-#define _ST_NCI_H_
-
-#define ST_NCI_DRIVER_NAME "st_nci"
-
-struct st_nci_nfc_platform_data {
-       unsigned int gpio_reset;
-       unsigned int irq_polarity;
-       bool is_ese_present;
-       bool is_uicc_present;
-};
-
-#endif /* _ST_NCI_H_ */
index 122bb81da9181ff92a964f381ea44113c5bd5025..5cf33df888c3d181d07753570746a566011a22d8 100644 (file)
@@ -982,6 +982,8 @@ static void nfc_release(struct device *d)
                        kfree(se);
        }
 
+       ida_simple_remove(&nfc_index_ida, dev->idx);
+
        kfree(dev);
 }
 
@@ -1056,6 +1058,7 @@ struct nfc_dev *nfc_allocate_device(struct nfc_ops *ops,
                                    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)
@@ -1068,6 +1071,15 @@ struct nfc_dev *nfc_allocate_device(struct nfc_ops *ops,
        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;
@@ -1090,6 +1102,11 @@ struct nfc_dev *nfc_allocate_device(struct nfc_ops *ops,
        }
 
        return dev;
+
+err_free_dev:
+       kfree(dev);
+
+       return ERR_PTR(rc);
 }
 EXPORT_SYMBOL(nfc_allocate_device);
 
@@ -1104,14 +1121,6 @@ int nfc_register_device(struct nfc_dev *dev)
 
        pr_debug("dev_name=%s\n", dev_name(&dev->dev));
 
-       dev->idx = ida_simple_get(&nfc_index_ida, 0, 0, GFP_KERNEL);
-       if (dev->idx < 0)
-               return dev->idx;
-
-       dev->dev.class = &nfc_class;
-       dev_set_name(&dev->dev, "nfc%d", dev->idx);
-       device_initialize(&dev->dev);
-
        mutex_lock(&nfc_devlist_mutex);
        nfc_devlist_generation++;
        rc = device_add(&dev->dev);
@@ -1149,12 +1158,10 @@ EXPORT_SYMBOL(nfc_register_device);
  */
 void nfc_unregister_device(struct nfc_dev *dev)
 {
-       int rc, id;
+       int rc;
 
        pr_debug("dev_name=%s\n", dev_name(&dev->dev));
 
-       id = dev->idx;
-
        if (dev->rfkill) {
                rfkill_unregister(dev->rfkill);
                rfkill_destroy(dev->rfkill);
@@ -1179,8 +1186,6 @@ void nfc_unregister_device(struct nfc_dev *dev)
        nfc_devlist_generation++;
        device_del(&dev->dev);
        mutex_unlock(&nfc_devlist_mutex);
-
-       ida_simple_remove(&nfc_index_ida, id);
 }
 EXPORT_SYMBOL(nfc_unregister_device);
 
index ebeace7a8278861939be6eacee410e76b3339430..de6dd37d04c7065b9eb9f5186f735136048be335 100644 (file)
@@ -240,7 +240,7 @@ int digital_send_cmd(struct nfc_digital_dev *ddev, u8 cmd_type,
 {
        struct digital_cmd *cmd;
 
-       cmd = kzalloc(sizeof(struct digital_cmd), GFP_KERNEL);
+       cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
        if (!cmd)
                return -ENOMEM;
 
@@ -287,7 +287,7 @@ static int digital_tg_listen_mdaa(struct nfc_digital_dev *ddev, u8 rf_tech)
 {
        struct digital_tg_mdaa_params *params;
 
-       params = kzalloc(sizeof(struct digital_tg_mdaa_params), GFP_KERNEL);
+       params = kzalloc(sizeof(*params), GFP_KERNEL);
        if (!params)
                return -ENOMEM;
 
@@ -706,11 +706,9 @@ static int digital_in_send(struct nfc_dev *nfc_dev, struct nfc_target *target,
        struct digital_data_exch *data_exch;
        int rc;
 
-       data_exch = kzalloc(sizeof(struct digital_data_exch), GFP_KERNEL);
-       if (!data_exch) {
-               pr_err("Failed to allocate data_exch struct\n");
+       data_exch = kzalloc(sizeof(*data_exch), GFP_KERNEL);
+       if (!data_exch)
                return -ENOMEM;
-       }
 
        data_exch->cb = cb;
        data_exch->cb_context = cb_context;
@@ -764,7 +762,7 @@ struct nfc_digital_dev *nfc_digital_allocate_device(struct nfc_digital_ops *ops,
            !ops->switch_rf || (ops->tg_listen_md && !ops->tg_get_rf_tech))
                return NULL;
 
-       ddev = kzalloc(sizeof(struct nfc_digital_dev), GFP_KERNEL);
+       ddev = kzalloc(sizeof(*ddev), GFP_KERNEL);
        if (!ddev)
                return NULL;
 
index 74ccc2dd79d0943f2f5a24e2adb171908bfac7c8..4f9a973988b2b13fc5426525b487a23cbabb84f3 100644 (file)
@@ -151,7 +151,7 @@ static const u8 digital_payload_bits_map[4] = {
  *  0 <= wt <= 14 (given by the target by the TO field of ATR_RES response)
  */
 #define DIGITAL_NFC_DEP_IN_MAX_WT 14
-#define DIGITAL_NFC_DEP_TG_MAX_WT 8
+#define DIGITAL_NFC_DEP_TG_MAX_WT 14
 static const u16 digital_rwt_map[DIGITAL_NFC_DEP_IN_MAX_WT + 1] = {
        100,  101,  101,  102,  105,
        110,  119,  139,  177,  255,
index 3cc3448da524c4b99bb8e6068bc077c56bac6e6b..2021d1d58a75e8bca71625c3d34e1a05a9cce89d 100644 (file)
@@ -27,6 +27,7 @@
 
 #define DIGITAL_SDD_RES_CT  0x88
 #define DIGITAL_SDD_RES_LEN 5
+#define DIGITAL_SEL_RES_LEN 1
 
 #define DIGITAL_SEL_RES_NFCID1_COMPLETE(sel_res) (!((sel_res) & 0x04))
 #define DIGITAL_SEL_RES_IS_T2T(sel_res) (!((sel_res) & 0x60))
@@ -299,7 +300,7 @@ static void digital_in_recv_sel_res(struct nfc_digital_dev *ddev, void *arg,
                }
        }
 
-       if (!resp->len) {
+       if (resp->len != DIGITAL_SEL_RES_LEN) {
                rc = -EIO;
                goto exit;
        }
index 2ffb18e73df6c03072fffeb68b660fb2f884eb45..fb7afcaa30047dbb3c1dd6287317c4ad7d3b186e 100644 (file)
@@ -77,7 +77,8 @@ static int llcp_sock_bind(struct socket *sock, struct sockaddr *addr, int alen)
        struct sockaddr_nfc_llcp llcp_addr;
        int len, ret = 0;
 
-       if (!addr || addr->sa_family != AF_NFC)
+       if (!addr || alen < offsetofend(struct sockaddr, sa_family) ||
+           addr->sa_family != AF_NFC)
                return -EINVAL;
 
        pr_debug("sk %p addr %p family %d\n", sk, addr, addr->sa_family);
@@ -151,7 +152,8 @@ static int llcp_raw_sock_bind(struct socket *sock, struct sockaddr *addr,
        struct sockaddr_nfc_llcp llcp_addr;
        int len, ret = 0;
 
-       if (!addr || addr->sa_family != AF_NFC)
+       if (!addr || alen < offsetofend(struct sockaddr, sa_family) ||
+           addr->sa_family != AF_NFC)
                return -EINVAL;
 
        pr_debug("sk %p addr %p family %d\n", sk, addr, addr->sa_family);
@@ -662,8 +664,7 @@ static int llcp_sock_connect(struct socket *sock, struct sockaddr *_addr,
 
        pr_debug("sock %p sk %p flags 0x%x\n", sock, sk, flags);
 
-       if (!addr || len < sizeof(struct sockaddr_nfc) ||
-           addr->sa_family != AF_NFC)
+       if (!addr || len < sizeof(*addr) || addr->sa_family != AF_NFC)
                return -EINVAL;
 
        if (addr->service_name_len == 0 && addr->dsap == 0)
index a3dac34cf790b423001549c89091c87739547083..c25e9b4179c34b571c6adbb65f3cff9f60dad06d 100644 (file)
@@ -73,11 +73,10 @@ int nci_get_conn_info_by_dest_type_params(struct nci_dev *ndev, u8 dest_type,
                if (conn_info->dest_type == dest_type) {
                        if (!params)
                                return conn_info->conn_id;
-                       if (conn_info) {
-                               if (params->id == conn_info->dest_params->id &&
-                                   params->protocol == conn_info->dest_params->protocol)
-                                       return conn_info->conn_id;
-                       }
+
+                       if (params->id == conn_info->dest_params->id &&
+                           params->protocol == conn_info->dest_params->protocol)
+                               return conn_info->conn_id;
                }
        }
 
@@ -1173,8 +1172,7 @@ struct nci_dev *nci_allocate_device(struct nci_ops *ops,
        return ndev;
 
 free_nfc:
-       kfree(ndev->nfc_dev);
-
+       nfc_free_device(ndev->nfc_dev);
 free_nci:
        kfree(ndev);
        return NULL;
index 6b0850e63e09cf747a498f913f7eabe11e59c380..b251fb936a27a9632c55d5aa91c1dbd2fa543ffa 100644 (file)
@@ -907,7 +907,9 @@ static int nfc_genl_activate_target(struct sk_buff *skb, struct genl_info *info)
        u32 device_idx, target_idx, protocol;
        int rc;
 
-       if (!info->attrs[NFC_ATTR_DEVICE_INDEX])
+       if (!info->attrs[NFC_ATTR_DEVICE_INDEX] ||
+           !info->attrs[NFC_ATTR_TARGET_INDEX] ||
+           !info->attrs[NFC_ATTR_PROTOCOLS])
                return -EINVAL;
 
        device_idx = nla_get_u32(info->attrs[NFC_ATTR_DEVICE_INDEX]);