cregit-Linux how code gets into the kernel

Release 4.7 drivers/nfc/nxp-nci/i2c.c

/*
 * I2C link layer for the NXP NCI driver
 *
 * Copyright (C) 2014  NXP Semiconductors  All rights reserved.
 * Copyright (C) 2012-2015  Intel Corporation. All rights reserved.
 *
 * Authors: Clément Perrochaud <clement.perrochaud@nxp.com>
 * Authors: Oleg Zhurakivskyy <oleg.zhurakivskyy@intel.com>
 *
 * Derived from PN544 device driver:
 * Copyright (C) 2012  Intel Corporation. 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/>.
 */


#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt

#include <linux/acpi.h>
#include <linux/delay.h>
#include <linux/i2c.h>
#include <linux/interrupt.h>
#include <linux/miscdevice.h>
#include <linux/module.h>
#include <linux/nfc.h>
#include <linux/gpio/consumer.h>
#include <linux/of_gpio.h>
#include <linux/of_irq.h>
#include <linux/platform_data/nxp-nci.h>
#include <linux/unaligned/access_ok.h>

#include <net/nfc/nfc.h>

#include "nxp-nci.h"


#define NXP_NCI_I2C_DRIVER_NAME	"nxp-nci_i2c"


#define NXP_NCI_I2C_MAX_PAYLOAD	32


struct nxp_nci_i2c_phy {
	
struct i2c_client *i2c_dev;
	
struct nci_dev *ndev;

	
unsigned int gpio_en;
	
unsigned int gpio_fw;

	
int hard_fault; /*
                         * < 0 if hardware error occurred (e.g. i2c err)
                         * and prevents normal operation.
                         */
};


static int nxp_nci_i2c_set_mode(void *phy_id, enum nxp_nci_mode mode) { struct nxp_nci_i2c_phy *phy = (struct nxp_nci_i2c_phy *) phy_id; gpio_set_value(phy->gpio_fw, (mode == NXP_NCI_MODE_FW) ? 1 : 0); gpio_set_value(phy->gpio_en, (mode != NXP_NCI_MODE_COLD) ? 1 : 0); usleep_range(10000, 15000); if (mode == NXP_NCI_MODE_COLD) phy->hard_fault = 0; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud82100.00%1100.00%
Total82100.00%1100.00%


static int nxp_nci_i2c_write(void *phy_id, struct sk_buff *skb) { int r; struct nxp_nci_i2c_phy *phy = phy_id; struct i2c_client *client = phy->i2c_dev; if (phy->hard_fault != 0) return phy->hard_fault; r = i2c_master_send(client, skb->data, skb->len); if (r < 0) { /* Retry, chip was in standby */ usleep_range(110000, 120000); r = i2c_master_send(client, skb->data, skb->len); } if (r < 0) { nfc_err(&client->dev, "Error %d on I2C send\n", r); } else if (r != skb->len) { nfc_err(&client->dev, "Invalid length sent: %u (expected %u)\n", r, skb->len); r = -EREMOTEIO; } else { /* Success but return 0 and not number of bytes */ r = 0; } return r; }

Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud15498.72%150.00%
fabio estevamfabio estevam21.28%150.00%
Total156100.00%2100.00%

static const struct nxp_nci_phy_ops i2c_phy_ops = { .set_mode = nxp_nci_i2c_set_mode, .write = nxp_nci_i2c_write, };
static int nxp_nci_i2c_fw_read(struct nxp_nci_i2c_phy *phy, struct sk_buff **skb) { struct i2c_client *client = phy->i2c_dev; u16 header; size_t frame_len; int r; r = i2c_master_recv(client, (u8 *) &header, NXP_NCI_FW_HDR_LEN); if (r < 0) { goto fw_read_exit; } else if (r != NXP_NCI_FW_HDR_LEN) { nfc_err(&client->dev, "Incorrect header length: %u\n", r); r = -EBADMSG; goto fw_read_exit; } frame_len = (get_unaligned_be16(&header) & NXP_NCI_FW_FRAME_LEN_MASK) + NXP_NCI_FW_CRC_LEN; *skb = alloc_skb(NXP_NCI_FW_HDR_LEN + frame_len, GFP_KERNEL); if (*skb == NULL) { r = -ENOMEM; goto fw_read_exit; } memcpy(skb_put(*skb, NXP_NCI_FW_HDR_LEN), &header, NXP_NCI_FW_HDR_LEN); r = i2c_master_recv(client, skb_put(*skb, frame_len), frame_len); if (r != frame_len) { nfc_err(&client->dev, "Invalid frame length: %u (expected %zu)\n", r, frame_len); r = -EBADMSG; goto fw_read_exit_free_skb; } return 0; fw_read_exit_free_skb: kfree_skb(*skb); fw_read_exit: return r; }

Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud213100.00%1100.00%
Total213100.00%1100.00%


static int nxp_nci_i2c_nci_read(struct nxp_nci_i2c_phy *phy, struct sk_buff **skb) { struct nci_ctrl_hdr header; /* May actually be a data header */ struct i2c_client *client = phy->i2c_dev; int r; r = i2c_master_recv(client, (u8 *) &header, NCI_CTRL_HDR_SIZE); if (r < 0) { goto nci_read_exit; } else if (r != NCI_CTRL_HDR_SIZE) { nfc_err(&client->dev, "Incorrect header length: %u\n", r); r = -EBADMSG; goto nci_read_exit; } *skb = alloc_skb(NCI_CTRL_HDR_SIZE + header.plen, GFP_KERNEL); if (*skb == NULL) { r = -ENOMEM; goto nci_read_exit; } memcpy(skb_put(*skb, NCI_CTRL_HDR_SIZE), (void *) &header, NCI_CTRL_HDR_SIZE); r = i2c_master_recv(client, skb_put(*skb, header.plen), header.plen); if (r != header.plen) { nfc_err(&client->dev, "Invalid frame payload length: %u (expected %u)\n", r, header.plen); r = -EBADMSG; goto nci_read_exit_free_skb; } return 0; nci_read_exit_free_skb: kfree_skb(*skb); nci_read_exit: return r; }

Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud212100.00%1100.00%
Total212100.00%1100.00%


static irqreturn_t nxp_nci_i2c_irq_thread_fn(int irq, void *phy_id) { struct nxp_nci_i2c_phy *phy = phy_id; struct i2c_client *client; struct nxp_nci_info *info; struct sk_buff *skb = NULL; int r = 0; if (!phy || !phy->ndev) goto exit_irq_none; client = phy->i2c_dev; if (!client || irq != client->irq) goto exit_irq_none; info = nci_get_drvdata(phy->ndev); if (!info) goto exit_irq_none; mutex_lock(&info->info_lock); if (phy->hard_fault != 0) goto exit_irq_handled; switch (info->mode) { case NXP_NCI_MODE_NCI: r = nxp_nci_i2c_nci_read(phy, &skb); break; case NXP_NCI_MODE_FW: r = nxp_nci_i2c_fw_read(phy, &skb); break; case NXP_NCI_MODE_COLD: r = -EREMOTEIO; break; } if (r == -EREMOTEIO) { phy->hard_fault = r; skb = NULL; } else if (r < 0) { nfc_err(&client->dev, "Read failed with error %d\n", r); goto exit_irq_handled; } switch (info->mode) { case NXP_NCI_MODE_NCI: nci_recv_frame(phy->ndev, skb); break; case NXP_NCI_MODE_FW: nxp_nci_fw_recv_frame(phy->ndev, skb); break; case NXP_NCI_MODE_COLD: break; } exit_irq_handled: mutex_unlock(&info->info_lock); return IRQ_HANDLED; exit_irq_none: WARN_ON_ONCE(1); return IRQ_NONE; }

Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud260100.00%1100.00%
Total260100.00%1100.00%


static int nxp_nci_i2c_parse_devtree(struct i2c_client *client) { struct nxp_nci_i2c_phy *phy = i2c_get_clientdata(client); struct device_node *pp; int r; pp = client->dev.of_node; if (!pp) return -ENODEV; r = of_get_named_gpio(pp, "enable-gpios", 0); if (r == -EPROBE_DEFER) r = of_get_named_gpio(pp, "enable-gpios", 0); if (r < 0) { nfc_err(&client->dev, "Failed to get EN gpio, error: %d\n", r); return r; } phy->gpio_en = r; r = of_get_named_gpio(pp, "firmware-gpios", 0); if (r == -EPROBE_DEFER) r = of_get_named_gpio(pp, "firmware-gpios", 0); if (r < 0) { nfc_err(&client->dev, "Failed to get FW gpio, error: %d\n", r); return r; } phy->gpio_fw = r; return 0; }

Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud165100.00%1100.00%
Total165100.00%1100.00%


static int nxp_nci_i2c_acpi_config(struct nxp_nci_i2c_phy *phy) { struct i2c_client *client = phy->i2c_dev; struct gpio_desc *gpiod_en, *gpiod_fw; gpiod_en = devm_gpiod_get_index(&client->dev, NULL, 2, GPIOD_OUT_LOW); gpiod_fw = devm_gpiod_get_index(&client->dev, NULL, 1, GPIOD_OUT_LOW); if (IS_ERR(gpiod_en) || IS_ERR(gpiod_fw)) { nfc_err(&client->dev, "No GPIOs\n"); return -EINVAL; } phy->gpio_en = desc_to_gpio(gpiod_en); phy->gpio_fw = desc_to_gpio(gpiod_fw); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
oleg zhurakivskyyoleg zhurakivskyy10596.33%150.00%
uwe kleine-koeniguwe kleine-koenig43.67%150.00%
Total109100.00%2100.00%


static int nxp_nci_i2c_probe(struct i2c_client *client, const struct i2c_device_id *id) { struct nxp_nci_i2c_phy *phy; struct nxp_nci_nfc_platform_data *pdata; int r; if (!i2c_check_functionality(client->adapter, I2C_FUNC_I2C)) { nfc_err(&client->dev, "Need I2C_FUNC_I2C\n"); r = -ENODEV; goto probe_exit; } phy = devm_kzalloc(&client->dev, sizeof(struct nxp_nci_i2c_phy), GFP_KERNEL); if (!phy) { r = -ENOMEM; goto probe_exit; } phy->i2c_dev = client; i2c_set_clientdata(client, phy); pdata = client->dev.platform_data; if (!pdata && client->dev.of_node) { r = nxp_nci_i2c_parse_devtree(client); if (r < 0) { nfc_err(&client->dev, "Failed to get DT data\n"); goto probe_exit; } } else if (pdata) { phy->gpio_en = pdata->gpio_en; phy->gpio_fw = pdata->gpio_fw; } else if (ACPI_HANDLE(&client->dev)) { r = nxp_nci_i2c_acpi_config(phy); if (r < 0) goto probe_exit; goto nci_probe; } else { nfc_err(&client->dev, "No platform data\n"); r = -EINVAL; goto probe_exit; } r = devm_gpio_request_one(&phy->i2c_dev->dev, phy->gpio_en, GPIOF_OUT_INIT_LOW, "nxp_nci_en"); if (r < 0) goto probe_exit; r = devm_gpio_request_one(&phy->i2c_dev->dev, phy->gpio_fw, GPIOF_OUT_INIT_LOW, "nxp_nci_fw"); if (r < 0) goto probe_exit; nci_probe: r = nxp_nci_probe(phy, &client->dev, &i2c_phy_ops, NXP_NCI_I2C_MAX_PAYLOAD, &phy->ndev); if (r < 0) goto probe_exit; r = request_threaded_irq(client->irq, NULL, nxp_nci_i2c_irq_thread_fn, IRQF_TRIGGER_RISING | IRQF_ONESHOT, NXP_NCI_I2C_DRIVER_NAME, phy); if (r < 0) nfc_err(&client->dev, "Unable to register IRQ handler\n"); probe_exit: return r; }

Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud33290.71%150.00%
oleg zhurakivskyyoleg zhurakivskyy349.29%150.00%
Total366100.00%2100.00%


static int nxp_nci_i2c_remove(struct i2c_client *client) { struct nxp_nci_i2c_phy *phy = i2c_get_clientdata(client); nxp_nci_remove(phy->ndev); free_irq(client->irq, phy); return 0; }

Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud40100.00%1100.00%
Total40100.00%1100.00%

static struct i2c_device_id nxp_nci_i2c_id_table[] = { {"nxp-nci_i2c", 0}, {} }; MODULE_DEVICE_TABLE(i2c, nxp_nci_i2c_id_table); static const struct of_device_id of_nxp_nci_i2c_match[] = { { .compatible = "nxp,nxp-nci-i2c", }, {}, }; MODULE_DEVICE_TABLE(of, of_nxp_nci_i2c_match); #ifdef CONFIG_ACPI static struct acpi_device_id acpi_id[] = { { "NXP7471" }, { }, }; MODULE_DEVICE_TABLE(acpi, acpi_id); #endif static struct i2c_driver nxp_nci_i2c_driver = { .driver = { .name = NXP_NCI_I2C_DRIVER_NAME, .acpi_match_table = ACPI_PTR(acpi_id), .of_match_table = of_match_ptr(of_nxp_nci_i2c_match), }, .probe = nxp_nci_i2c_probe, .id_table = nxp_nci_i2c_id_table, .remove = nxp_nci_i2c_remove, }; module_i2c_driver(nxp_nci_i2c_driver); MODULE_LICENSE("GPL"); MODULE_DESCRIPTION("I2C driver for NXP NCI NFC controllers"); MODULE_AUTHOR("Clément Perrochaud <clement.perrochaud@nxp.com>"); MODULE_AUTHOR("Oleg Zhurakivskyy <oleg.zhurakivskyy@intel.com>");

Overall Contributors

PersonTokensPropCommitsCommitProp
clement perrochaudclement perrochaud166189.64%116.67%
oleg zhurakivskyyoleg zhurakivskyy1829.82%116.67%
uwe kleine-koeniguwe kleine-koenig40.22%116.67%
samuel ortizsamuel ortiz30.16%116.67%
fabio estevamfabio estevam20.11%116.67%
julia lawalljulia lawall10.05%116.67%
Total1853100.00%6100.00%
Information contained on this website is for historical information purposes only and does not indicate or represent copyright ownership.
{% endraw %}