iv/linux
1
0
Fork 0
Code Issues Pull Requests Actions Packages Projects Releases Wiki Activity
611905d6e3
linux/drivers/nfc/st21nfca/vendor_cmds.c

365 lines
8.0 KiB
C
Raw Normal View History

treewide: Replace GPLv2 boilerplate/reference with SPDX - rule 399 Based on 1 normalized pattern(s): 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 extracted by the scancode license scanner the SPDX license identifier GPL-2.0-only has been chosen to replace the boilerplate/reference in 33 file(s). Signed-off-by: Thomas Gleixner <tglx@linutronix.de> Reviewed-by: Allison Randal <allison@lohutok.net> Reviewed-by: Kate Stewart <kstewart@linuxfoundation.org> Cc: linux-spdx@vger.kernel.org Link: https://lkml.kernel.org/r/20190531081038.745679586@linutronix.de Signed-off-by: Greg Kroah-Hartman <gregkh@linuxfoundation.org>
2019-05-31 11:09:57 +03:00
// SPDX-License-Identifier: GPL-2.0-only
NFC: st21nfca: Add support for proprietary commands Add support for proprietary commands useful mainly for factory testings. Here is a list: - FACTORY_MODE: Allow to set the driver into a mode where no secure element are activated. It does not consider any NFC_ATTR_VENDOR_DATA. - HCI_CLEAR_ALL_PIPES: Allow to execute a HCI clear all pipes command. It does not consider any NFC_ATTR_VENDOR_DATA. - HCI_DM_PUT_DATA: Allow to configure specific CLF registry as for example RF trimmings or low level drivers configurations (I2C, SPI, SWP). - HCI_DM_UPDATE_AID: Allow to configure an AID routing into the CLF routing table following RF technology, CLF mode or protocol. - HCI_DM_GET_INFO: Allow to retrieve CLF information. - HCI_DM_GET_DATA: Allow to retrieve CLF configurable data such as low level drivers configurations or RF trimmings. - HCI_DM_LOAD: Allow to load a firmware into the CLF. A complete packet can be more than 8KB. - HCI_DM_RESET: Allow to run a CLF reset in order to "commit" CLF configuration changes without CLF power off. - HCI_GET_PARAM: Allow to retrieve an HCI CLF parameter (for example the white list). - HCI_DM_FIELD_GENERATOR: Allow to generate different kind of RF technology. When using this command to anti-collision is done. - HCI_LOOPBACK: Allow to echo a command and test the Dh to CLF connectivity. Signed-off-by: Christophe Ricard <christophe-h.ricard@st.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2015-10-26 09:50:11 +03:00
/*
* Proprietary commands extension for STMicroelectronics NFC Chip
*
* Copyright (C) 2014-2015 STMicroelectronics SAS. All rights reserved.
*/
#include <net/genetlink.h>
#include <linux/module.h>
#include <linux/nfc.h>
#include <net/nfc/hci.h>
#include <net/nfc/llc.h>
#include "st21nfca.h"
#define ST21NFCA_HCI_DM_GETDATA 0x10
#define ST21NFCA_HCI_DM_PUTDATA 0x11
#define ST21NFCA_HCI_DM_LOAD 0x12
#define ST21NFCA_HCI_DM_GETINFO 0x13
#define ST21NFCA_HCI_DM_UPDATE_AID 0x20
#define ST21NFCA_HCI_DM_RESET 0x3e
#define ST21NFCA_HCI_DM_FIELD_GENERATOR 0x32
#define ST21NFCA_FACTORY_MODE_ON 1
#define ST21NFCA_FACTORY_MODE_OFF 0
#define ST21NFCA_EVT_POST_DATA 0x02
struct get_param_data {
u8 gate;
u8 data;
} __packed;
static int st21nfca_factory_mode(struct nfc_dev *dev, void *data,
size_t data_len)
{
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
if (data_len != 1)
return -EINVAL;
pr_debug("factory mode: %x\n", ((u8 *)data)[0]);
switch (((u8 *)data)[0]) {
case ST21NFCA_FACTORY_MODE_ON:
test_and_set_bit(ST21NFCA_FACTORY_MODE, &hdev->quirks);
break;
case ST21NFCA_FACTORY_MODE_OFF:
clear_bit(ST21NFCA_FACTORY_MODE, &hdev->quirks);
break;
default:
return -EINVAL;
}
return 0;
}
static int st21nfca_hci_clear_all_pipes(struct nfc_dev *dev, void *data,
size_t data_len)
{
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
return nfc_hci_disconnect_all_gates(hdev);
}
static int st21nfca_hci_dm_put_data(struct nfc_dev *dev, void *data,
size_t data_len)
{
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
return nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE,
ST21NFCA_HCI_DM_PUTDATA, data,
data_len, NULL);
}
static int st21nfca_hci_dm_update_aid(struct nfc_dev *dev, void *data,
size_t data_len)
{
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
return nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE,
ST21NFCA_HCI_DM_UPDATE_AID, data, data_len, NULL);
}
static int st21nfca_hci_dm_get_info(struct nfc_dev *dev, void *data,
size_t data_len)
{
int r;
struct sk_buff *msg, *skb;
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
r = nfc_hci_send_cmd(hdev,
ST21NFCA_DEVICE_MGNT_GATE,
ST21NFCA_HCI_DM_GETINFO,
data, data_len, &skb);
if (r)
goto exit;
msg = nfc_vendor_cmd_alloc_reply_skb(dev, ST21NFCA_VENDOR_OUI,
HCI_DM_GET_INFO, skb->len);
if (!msg) {
r = -ENOMEM;
goto free_skb;
}
if (nla_put(msg, NFC_ATTR_VENDOR_DATA, skb->len, skb->data)) {
kfree_skb(msg);
r = -ENOBUFS;
goto free_skb;
}
r = nfc_vendor_cmd_reply(msg);
free_skb:
kfree_skb(skb);
exit:
return r;
}
static int st21nfca_hci_dm_get_data(struct nfc_dev *dev, void *data,
size_t data_len)
{
int r;
struct sk_buff *msg, *skb;
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
r = nfc_hci_send_cmd(hdev,
ST21NFCA_DEVICE_MGNT_GATE,
ST21NFCA_HCI_DM_GETDATA,
data, data_len, &skb);
if (r)
goto exit;
msg = nfc_vendor_cmd_alloc_reply_skb(dev, ST21NFCA_VENDOR_OUI,
HCI_DM_GET_DATA, skb->len);
if (!msg) {
r = -ENOMEM;
goto free_skb;
}
if (nla_put(msg, NFC_ATTR_VENDOR_DATA, skb->len, skb->data)) {
kfree_skb(msg);
r = -ENOBUFS;
goto free_skb;
}
r = nfc_vendor_cmd_reply(msg);
free_skb:
kfree_skb(skb);
exit:
return r;
}
static int st21nfca_hci_dm_load(struct nfc_dev *dev, void *data,
size_t data_len)
{
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
return nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE,
ST21NFCA_HCI_DM_LOAD, data, data_len, NULL);
}
static int st21nfca_hci_dm_reset(struct nfc_dev *dev, void *data,
size_t data_len)
{
int r;
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
r = nfc_hci_send_cmd_async(hdev, ST21NFCA_DEVICE_MGNT_GATE,
ST21NFCA_HCI_DM_RESET, data, data_len, NULL, NULL);
if (r < 0)
return r;
r = nfc_llc_stop(hdev->llc);
if (r < 0)
return r;
return nfc_llc_start(hdev->llc);
}
static int st21nfca_hci_get_param(struct nfc_dev *dev, void *data,
size_t data_len)
{
int r;
struct sk_buff *msg, *skb;
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
struct get_param_data *param = (struct get_param_data *)data;
if (data_len < sizeof(struct get_param_data))
return -EPROTO;
r = nfc_hci_get_param(hdev, param->gate, param->data, &skb);
if (r)
goto exit;
msg = nfc_vendor_cmd_alloc_reply_skb(dev, ST21NFCA_VENDOR_OUI,
HCI_GET_PARAM, skb->len);
if (!msg) {
r = -ENOMEM;
goto free_skb;
}
if (nla_put(msg, NFC_ATTR_VENDOR_DATA, skb->len, skb->data)) {
kfree_skb(msg);
r = -ENOBUFS;
goto free_skb;
}
r = nfc_vendor_cmd_reply(msg);
free_skb:
kfree_skb(skb);
exit:
return r;
}
static int st21nfca_hci_dm_field_generator(struct nfc_dev *dev, void *data,
size_t data_len)
{
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
return nfc_hci_send_cmd(hdev,
ST21NFCA_DEVICE_MGNT_GATE,
ST21NFCA_HCI_DM_FIELD_GENERATOR,
data, data_len, NULL);
}
int st21nfca_hci_loopback_event_received(struct nfc_hci_dev *hdev, u8 event,
struct sk_buff *skb)
{
struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);
switch (event) {
case ST21NFCA_EVT_POST_DATA:
info->vendor_info.rx_skb = skb;
break;
default:
nfc_err(&hdev->ndev->dev, "Unexpected event on loopback gate\n");
}
complete(&info->vendor_info.req_completion);
return 0;
}
EXPORT_SYMBOL(st21nfca_hci_loopback_event_received);
static int st21nfca_hci_loopback(struct nfc_dev *dev, void *data,
size_t data_len)
{
int r;
struct sk_buff *msg;
struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);
if (data_len <= 0)
return -EPROTO;
reinit_completion(&info->vendor_info.req_completion);
info->vendor_info.rx_skb = NULL;
r = nfc_hci_send_event(hdev, NFC_HCI_LOOPBACK_GATE,
ST21NFCA_EVT_POST_DATA, data, data_len);
if (r < 0) {
r = -EPROTO;
goto exit;
}
wait_for_completion_interruptible(&info->vendor_info.req_completion);
if (!info->vendor_info.rx_skb ||
info->vendor_info.rx_skb->len != data_len) {
r = -EPROTO;
goto exit;
}
msg = nfc_vendor_cmd_alloc_reply_skb(hdev->ndev,
ST21NFCA_VENDOR_OUI,
HCI_LOOPBACK,
info->vendor_info.rx_skb->len);
if (!msg) {
r = -ENOMEM;
goto free_skb;
}
if (nla_put(msg, NFC_ATTR_VENDOR_DATA, info->vendor_info.rx_skb->len,
info->vendor_info.rx_skb->data)) {
kfree_skb(msg);
r = -ENOBUFS;
goto free_skb;
}
r = nfc_vendor_cmd_reply(msg);
free_skb:
kfree_skb(info->vendor_info.rx_skb);
exit:
return r;
}
static struct nfc_vendor_cmd st21nfca_vendor_cmds[] = {
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = FACTORY_MODE,
.doit = st21nfca_factory_mode,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_CLEAR_ALL_PIPES,
.doit = st21nfca_hci_clear_all_pipes,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_DM_PUT_DATA,
.doit = st21nfca_hci_dm_put_data,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_DM_UPDATE_AID,
.doit = st21nfca_hci_dm_update_aid,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_DM_GET_INFO,
.doit = st21nfca_hci_dm_get_info,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_DM_GET_DATA,
.doit = st21nfca_hci_dm_get_data,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_DM_LOAD,
.doit = st21nfca_hci_dm_load,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_DM_RESET,
.doit = st21nfca_hci_dm_reset,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_GET_PARAM,
.doit = st21nfca_hci_get_param,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_DM_FIELD_GENERATOR,
.doit = st21nfca_hci_dm_field_generator,
},
{
.vendor_id = ST21NFCA_VENDOR_OUI,
.subcmd = HCI_LOOPBACK,
.doit = st21nfca_hci_loopback,
},
};
int st21nfca_vendor_cmds_init(struct nfc_hci_dev *hdev)
{
struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);
init_completion(&info->vendor_info.req_completion);
return nfc_set_vendor_cmds(hdev->ndev, st21nfca_vendor_cmds,
sizeof(st21nfca_vendor_cmds));
}
EXPORT_SYMBOL(st21nfca_vendor_cmds_init);
Reference in New Issue Copy Permalink