![Julia Lawall](/assets/img/avatar_default.png)
The only instance of a nxp_nci_phy_ops structure is never modified. Thus the declaration of the structure and all references to the structure type can be made const. Done with the help of Coccinelle. Signed-off-by: Julia Lawall <Julia.Lawall@lip6.fr> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
188 lines
4.3 KiB
C
188 lines
4.3 KiB
C
/*
|
|
* Generic driver for NXP NCI NFC chips
|
|
*
|
|
* Copyright (C) 2014 NXP Semiconductors All rights reserved.
|
|
*
|
|
* Authors: Clément Perrochaud <clement.perrochaud@nxp.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/>.
|
|
*/
|
|
|
|
#include <linux/delay.h>
|
|
#include <linux/gpio.h>
|
|
#include <linux/module.h>
|
|
#include <linux/nfc.h>
|
|
#include <linux/platform_data/nxp-nci.h>
|
|
|
|
#include <net/nfc/nci_core.h>
|
|
|
|
#include "nxp-nci.h"
|
|
|
|
#define NXP_NCI_HDR_LEN 4
|
|
|
|
#define NXP_NCI_NFC_PROTOCOLS (NFC_PROTO_JEWEL_MASK | \
|
|
NFC_PROTO_MIFARE_MASK | \
|
|
NFC_PROTO_FELICA_MASK | \
|
|
NFC_PROTO_ISO14443_MASK | \
|
|
NFC_PROTO_ISO14443_B_MASK | \
|
|
NFC_PROTO_NFC_DEP_MASK)
|
|
|
|
static int nxp_nci_open(struct nci_dev *ndev)
|
|
{
|
|
struct nxp_nci_info *info = nci_get_drvdata(ndev);
|
|
int r = 0;
|
|
|
|
mutex_lock(&info->info_lock);
|
|
|
|
if (info->mode != NXP_NCI_MODE_COLD) {
|
|
r = -EBUSY;
|
|
goto open_exit;
|
|
}
|
|
|
|
if (info->phy_ops->set_mode)
|
|
r = info->phy_ops->set_mode(info->phy_id, NXP_NCI_MODE_NCI);
|
|
|
|
info->mode = NXP_NCI_MODE_NCI;
|
|
|
|
open_exit:
|
|
mutex_unlock(&info->info_lock);
|
|
return r;
|
|
}
|
|
|
|
static int nxp_nci_close(struct nci_dev *ndev)
|
|
{
|
|
struct nxp_nci_info *info = nci_get_drvdata(ndev);
|
|
int r = 0;
|
|
|
|
mutex_lock(&info->info_lock);
|
|
|
|
if (info->phy_ops->set_mode)
|
|
r = info->phy_ops->set_mode(info->phy_id, NXP_NCI_MODE_COLD);
|
|
|
|
info->mode = NXP_NCI_MODE_COLD;
|
|
|
|
mutex_unlock(&info->info_lock);
|
|
return r;
|
|
}
|
|
|
|
static int nxp_nci_send(struct nci_dev *ndev, struct sk_buff *skb)
|
|
{
|
|
struct nxp_nci_info *info = nci_get_drvdata(ndev);
|
|
int r;
|
|
|
|
if (!info->phy_ops->write) {
|
|
r = -ENOTSUPP;
|
|
goto send_exit;
|
|
}
|
|
|
|
if (info->mode != NXP_NCI_MODE_NCI) {
|
|
r = -EINVAL;
|
|
goto send_exit;
|
|
}
|
|
|
|
r = info->phy_ops->write(info->phy_id, skb);
|
|
if (r < 0)
|
|
kfree_skb(skb);
|
|
|
|
send_exit:
|
|
return r;
|
|
}
|
|
|
|
static struct nci_ops nxp_nci_ops = {
|
|
.open = nxp_nci_open,
|
|
.close = nxp_nci_close,
|
|
.send = nxp_nci_send,
|
|
.fw_download = nxp_nci_fw_download,
|
|
};
|
|
|
|
int nxp_nci_probe(void *phy_id, struct device *pdev,
|
|
const struct nxp_nci_phy_ops *phy_ops,
|
|
unsigned int max_payload,
|
|
struct nci_dev **ndev)
|
|
{
|
|
struct nxp_nci_info *info;
|
|
int r;
|
|
|
|
info = devm_kzalloc(pdev, sizeof(struct nxp_nci_info), GFP_KERNEL);
|
|
if (!info) {
|
|
r = -ENOMEM;
|
|
goto probe_exit;
|
|
}
|
|
|
|
info->phy_id = phy_id;
|
|
info->pdev = pdev;
|
|
info->phy_ops = phy_ops;
|
|
info->max_payload = max_payload;
|
|
INIT_WORK(&info->fw_info.work, nxp_nci_fw_work);
|
|
init_completion(&info->fw_info.cmd_completion);
|
|
mutex_init(&info->info_lock);
|
|
|
|
if (info->phy_ops->set_mode) {
|
|
r = info->phy_ops->set_mode(info->phy_id, NXP_NCI_MODE_COLD);
|
|
if (r < 0)
|
|
goto probe_exit;
|
|
}
|
|
|
|
info->mode = NXP_NCI_MODE_COLD;
|
|
|
|
info->ndev = nci_allocate_device(&nxp_nci_ops, NXP_NCI_NFC_PROTOCOLS,
|
|
NXP_NCI_HDR_LEN, 0);
|
|
if (!info->ndev) {
|
|
r = -ENOMEM;
|
|
goto probe_exit;
|
|
}
|
|
|
|
nci_set_parent_dev(info->ndev, pdev);
|
|
nci_set_drvdata(info->ndev, info);
|
|
r = nci_register_device(info->ndev);
|
|
if (r < 0)
|
|
goto probe_exit_free_nci;
|
|
|
|
*ndev = info->ndev;
|
|
|
|
goto probe_exit;
|
|
|
|
probe_exit_free_nci:
|
|
nci_free_device(info->ndev);
|
|
probe_exit:
|
|
return r;
|
|
}
|
|
EXPORT_SYMBOL(nxp_nci_probe);
|
|
|
|
void nxp_nci_remove(struct nci_dev *ndev)
|
|
{
|
|
struct nxp_nci_info *info = nci_get_drvdata(ndev);
|
|
|
|
if (info->mode == NXP_NCI_MODE_FW)
|
|
nxp_nci_fw_work_complete(info, -ESHUTDOWN);
|
|
cancel_work_sync(&info->fw_info.work);
|
|
|
|
mutex_lock(&info->info_lock);
|
|
|
|
if (info->phy_ops->set_mode)
|
|
info->phy_ops->set_mode(info->phy_id, NXP_NCI_MODE_COLD);
|
|
|
|
nci_unregister_device(ndev);
|
|
nci_free_device(ndev);
|
|
|
|
mutex_unlock(&info->info_lock);
|
|
}
|
|
EXPORT_SYMBOL(nxp_nci_remove);
|
|
|
|
MODULE_LICENSE("GPL");
|
|
MODULE_DESCRIPTION("NXP NCI NFC driver");
|
|
MODULE_AUTHOR("Clément Perrochaud <clement.perrochaud@nxp.com>");
|