Merge branch 'add-nci-suit-and-virtual-nci-device-driver'
Bongsu Jeon says: ==================== Add nci suit and virtual nci device driver 1/2 is the Virtual NCI device driver. 2/2 is the NCI selftest suite ==================== Link: https://lore.kernel.org/r/20210127130829.4026-1-bongsu.jeon@samsung.com Signed-off-by: Jakub Kicinski <kuba@kernel.org>
This commit is contained in:
Jakub Kicinski
commit
cf3c7c7b37
@ -12540,6 +12540,14 @@ F: include/net/nfc/
|
||||
F: include/uapi/linux/nfc.h
|
||||
F: net/nfc/
|
||||
|
||||
NFC VIRTUAL NCI DEVICE DRIVER
|
||||
M: Bongsu Jeon <bongsu.jeon@samsung.com>
|
||||
L: netdev@vger.kernel.org
|
||||
L: linux-nfc@lists.01.org (moderated for non-subscribers)
|
||||
S: Supported
|
||||
F: drivers/nfc/virtual_ncidev.c
|
||||
F: tools/testing/selftests/nci/
|
||||
|
||||
NFS, SUNRPC, AND LOCKD CLIENTS
|
||||
M: Trond Myklebust <trond.myklebust@hammerspace.com>
|
||||
M: Anna Schumaker <anna.schumaker@netapp.com>
|
||||
|
||||
@ -49,6 +49,17 @@ config NFC_PORT100
|
||||
|
||||
If unsure, say N.
|
||||
|
||||
config NFC_VIRTUAL_NCI
|
||||
tristate "NCI device simulator driver"
|
||||
depends on NFC_NCI
|
||||
help
|
||||
NCI virtual device simulates a NCI device to the user.
|
||||
It can be used to validate the NCI module and applications.
|
||||
This driver supports communication between the virtual NCI device and
|
||||
module.
|
||||
|
||||
If unsure, say N.
|
||||
|
||||
source "drivers/nfc/fdp/Kconfig"
|
||||
source "drivers/nfc/pn544/Kconfig"
|
||||
source "drivers/nfc/pn533/Kconfig"
|
||||
|
||||
@ -17,3 +17,4 @@ obj-$(CONFIG_NFC_ST_NCI) += st-nci/
|
||||
obj-$(CONFIG_NFC_NXP_NCI) += nxp-nci/
|
||||
obj-$(CONFIG_NFC_S3FWRN5) += s3fwrn5/
|
||||
obj-$(CONFIG_NFC_ST95HF) += st95hf/
|
||||
obj-$(CONFIG_NFC_VIRTUAL_NCI) += virtual_ncidev.o
|
||||
|
||||
215
drivers/nfc/virtual_ncidev.c
Normal file
215
drivers/nfc/virtual_ncidev.c
Normal file
@ -0,0 +1,215 @@
|
||||
// SPDX-License-Identifier: GPL-2.0-or-later
|
||||
/*
|
||||
* Virtual NCI device simulation driver
|
||||
*
|
||||
* Copyright (C) 2020 Samsung Electrnoics
|
||||
* Bongsu Jeon <bongsu.jeon@samsung.com>
|
||||
*/
|
||||
|
||||
#include <linux/kernel.h>
|
||||
#include <linux/module.h>
|
||||
#include <linux/miscdevice.h>
|
||||
#include <linux/mutex.h>
|
||||
#include <net/nfc/nci_core.h>
|
||||
|
||||
enum virtual_ncidev_mode {
|
||||
virtual_ncidev_enabled,
|
||||
virtual_ncidev_disabled,
|
||||
virtual_ncidev_disabling,
|
||||
};
|
||||
|
||||
#define IOCTL_GET_NCIDEV_IDX 0
|
||||
#define VIRTUAL_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_ISO15693_MASK)
|
||||
|
||||
static enum virtual_ncidev_mode state;
|
||||
static struct miscdevice miscdev;
|
||||
static struct sk_buff *send_buff;
|
||||
static struct nci_dev *ndev;
|
||||
static DEFINE_MUTEX(nci_mutex);
|
||||
|
||||
static int virtual_nci_open(struct nci_dev *ndev)
|
||||
{
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int virtual_nci_close(struct nci_dev *ndev)
|
||||
{
|
||||
mutex_lock(&nci_mutex);
|
||||
kfree_skb(send_buff);
|
||||
send_buff = NULL;
|
||||
mutex_unlock(&nci_mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int virtual_nci_send(struct nci_dev *ndev, struct sk_buff *skb)
|
||||
{
|
||||
mutex_lock(&nci_mutex);
|
||||
if (state != virtual_ncidev_enabled) {
|
||||
mutex_unlock(&nci_mutex);
|
||||
return 0;
|
||||
}
|
||||
|
||||
if (send_buff) {
|
||||
mutex_unlock(&nci_mutex);
|
||||
return -1;
|
||||
}
|
||||
send_buff = skb_copy(skb, GFP_KERNEL);
|
||||
mutex_unlock(&nci_mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static struct nci_ops virtual_nci_ops = {
|
||||
.open = virtual_nci_open,
|
||||
.close = virtual_nci_close,
|
||||
.send = virtual_nci_send
|
||||
};
|
||||
|
||||
static ssize_t virtual_ncidev_read(struct file *file, char __user *buf,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
size_t actual_len;
|
||||
|
||||
mutex_lock(&nci_mutex);
|
||||
if (!send_buff) {
|
||||
mutex_unlock(&nci_mutex);
|
||||
return 0;
|
||||
}
|
||||
|
||||
actual_len = min_t(size_t, count, send_buff->len);
|
||||
|
||||
if (copy_to_user(buf, send_buff->data, actual_len)) {
|
||||
mutex_unlock(&nci_mutex);
|
||||
return -EFAULT;
|
||||
}
|
||||
|
||||
skb_pull(send_buff, actual_len);
|
||||
if (send_buff->len == 0) {
|
||||
consume_skb(send_buff);
|
||||
send_buff = NULL;
|
||||
}
|
||||
mutex_unlock(&nci_mutex);
|
||||
|
||||
return actual_len;
|
||||
}
|
||||
|
||||
static ssize_t virtual_ncidev_write(struct file *file,
|
||||
const char __user *buf,
|
||||
size_t count, loff_t *ppos)
|
||||
{
|
||||
struct sk_buff *skb;
|
||||
|
||||
skb = alloc_skb(count, GFP_KERNEL);
|
||||
if (!skb)
|
||||
return -ENOMEM;
|
||||
|
||||
if (copy_from_user(skb_put(skb, count), buf, count)) {
|
||||
kfree_skb(skb);
|
||||
return -EFAULT;
|
||||
}
|
||||
|
||||
nci_recv_frame(ndev, skb);
|
||||
return count;
|
||||
}
|
||||
|
||||
static int virtual_ncidev_open(struct inode *inode, struct file *file)
|
||||
{
|
||||
int ret = 0;
|
||||
|
||||
mutex_lock(&nci_mutex);
|
||||
if (state != virtual_ncidev_disabled) {
|
||||
mutex_unlock(&nci_mutex);
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
ndev = nci_allocate_device(&virtual_nci_ops, VIRTUAL_NFC_PROTOCOLS,
|
||||
0, 0);
|
||||
if (!ndev) {
|
||||
mutex_unlock(&nci_mutex);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
ret = nci_register_device(ndev);
|
||||
if (ret < 0) {
|
||||
nci_free_device(ndev);
|
||||
mutex_unlock(&nci_mutex);
|
||||
return ret;
|
||||
}
|
||||
state = virtual_ncidev_enabled;
|
||||
mutex_unlock(&nci_mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int virtual_ncidev_close(struct inode *inode, struct file *file)
|
||||
{
|
||||
mutex_lock(&nci_mutex);
|
||||
|
||||
if (state == virtual_ncidev_enabled) {
|
||||
state = virtual_ncidev_disabling;
|
||||
mutex_unlock(&nci_mutex);
|
||||
|
||||
nci_unregister_device(ndev);
|
||||
nci_free_device(ndev);
|
||||
|
||||
mutex_lock(&nci_mutex);
|
||||
}
|
||||
|
||||
state = virtual_ncidev_disabled;
|
||||
mutex_unlock(&nci_mutex);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static long virtual_ncidev_ioctl(struct file *flip, unsigned int cmd,
|
||||
unsigned long arg)
|
||||
{
|
||||
struct nfc_dev *nfc_dev = ndev->nfc_dev;
|
||||
void __user *p = (void __user *)arg;
|
||||
|
||||
if (cmd != IOCTL_GET_NCIDEV_IDX)
|
||||
return -ENOTTY;
|
||||
|
||||
if (copy_to_user(p, &nfc_dev->idx, sizeof(nfc_dev->idx)))
|
||||
return -EFAULT;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static const struct file_operations virtual_ncidev_fops = {
|
||||
.owner = THIS_MODULE,
|
||||
.read = virtual_ncidev_read,
|
||||
.write = virtual_ncidev_write,
|
||||
.open = virtual_ncidev_open,
|
||||
.release = virtual_ncidev_close,
|
||||
.unlocked_ioctl = virtual_ncidev_ioctl
|
||||
};
|
||||
|
||||
static int __init virtual_ncidev_init(void)
|
||||
{
|
||||
state = virtual_ncidev_disabled;
|
||||
miscdev.minor = MISC_DYNAMIC_MINOR;
|
||||
miscdev.name = "virtual_nci";
|
||||
miscdev.fops = &virtual_ncidev_fops;
|
||||
miscdev.mode = S_IALLUGO;
|
||||
|
||||
return misc_register(&miscdev);
|
||||
}
|
||||
|
||||
static void __exit virtual_ncidev_exit(void)
|
||||
{
|
||||
misc_deregister(&miscdev);
|
||||
}
|
||||
|
||||
module_init(virtual_ncidev_init);
|
||||
module_exit(virtual_ncidev_exit);
|
||||
|
||||
MODULE_LICENSE("GPL");
|
||||
MODULE_DESCRIPTION("Virtual NCI device simulation driver");
|
||||
MODULE_AUTHOR("Bongsu Jeon <bongsu.jeon@samsung.com>");
|
||||
@ -34,6 +34,7 @@ TARGETS += memory-hotplug
|
||||
TARGETS += mincore
|
||||
TARGETS += mount
|
||||
TARGETS += mqueue
|
||||
TARGETS += nci
|
||||
TARGETS += net
|
||||
TARGETS += net/forwarding
|
||||
TARGETS += net/mptcp
|
||||
|
||||
6
tools/testing/selftests/nci/Makefile
Normal file
6
tools/testing/selftests/nci/Makefile
Normal file
@ -0,0 +1,6 @@
|
||||
# SPDX-License-Identifier: GPL-2.0
|
||||
CFLAGS += -Wl,-no-as-needed -Wall
|
||||
LDFLAGS += -lpthread
|
||||
|
||||
TEST_GEN_PROGS := nci_dev
|
||||
include ../lib.mk
|
||||
3
tools/testing/selftests/nci/config
Normal file
3
tools/testing/selftests/nci/config
Normal file
@ -0,0 +1,3 @@
|
||||
CONFIG_NFC=y
|
||||
CONFIG_NFC_NCI=y
|
||||
CONFIG_NFC_VIRTUAL_NCI=y
|
||||
599
tools/testing/selftests/nci/nci_dev.c
Normal file
599
tools/testing/selftests/nci/nci_dev.c
Normal file
@ -0,0 +1,599 @@
|
||||
// SPDX-License-Identifier: GPL-2.0-only
|
||||
/*
|
||||
* Copyright (C) 2021 Samsung Electrnoics
|
||||
* Bongsu Jeon <bongsu.jeon@samsung.com>
|
||||
*
|
||||
* Test code for nci
|
||||
*/
|
||||
|
||||
#include <stdlib.h>
|
||||
#include <errno.h>
|
||||
#include <string.h>
|
||||
#include <sys/ioctl.h>
|
||||
#include <fcntl.h>
|
||||
#include <pthread.h>
|
||||
#include <linux/genetlink.h>
|
||||
#include <sys/socket.h>
|
||||
#include <linux/nfc.h>
|
||||
|
||||
#include "../kselftest_harness.h"
|
||||
|
||||
#define GENLMSG_DATA(glh) ((void *)(NLMSG_DATA(glh) + GENL_HDRLEN))
|
||||
#define GENLMSG_PAYLOAD(glh) (NLMSG_PAYLOAD(glh, 0) - GENL_HDRLEN)
|
||||
#define NLA_DATA(na) ((void *)((char *)(na) + NLA_HDRLEN))
|
||||
#define NLA_PAYLOAD(len) ((len) - NLA_HDRLEN)
|
||||
|
||||
#define MAX_MSG_SIZE 1024
|
||||
|
||||
#define IOCTL_GET_NCIDEV_IDX 0
|
||||
#define VIRTUAL_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_ISO15693_MASK)
|
||||
|
||||
const __u8 nci_reset_cmd[] = {0x20, 0x00, 0x01, 0x01};
|
||||
const __u8 nci_init_cmd[] = {0x20, 0x01, 0x00};
|
||||
const __u8 nci_rf_discovery_cmd[] = {0x21, 0x03, 0x09, 0x04, 0x00, 0x01,
|
||||
0x01, 0x01, 0x02, 0x01, 0x06, 0x01};
|
||||
const __u8 nci_init_cmd_v2[] = {0x20, 0x01, 0x02, 0x00, 0x00};
|
||||
const __u8 nci_rf_disc_map_cmd[] = {0x21, 0x00, 0x07, 0x02, 0x04, 0x03,
|
||||
0x02, 0x05, 0x03, 0x03};
|
||||
const __u8 nci_rf_deact_cmd[] = {0x21, 0x06, 0x01, 0x00};
|
||||
const __u8 nci_reset_rsp[] = {0x40, 0x00, 0x03, 0x00, 0x10, 0x01};
|
||||
const __u8 nci_reset_rsp_v2[] = {0x40, 0x00, 0x01, 0x00};
|
||||
const __u8 nci_reset_ntf[] = {0x60, 0x00, 0x09, 0x02, 0x01, 0x20, 0x0e,
|
||||
0x04, 0x61, 0x00, 0x04, 0x02};
|
||||
const __u8 nci_init_rsp[] = {0x40, 0x01, 0x14, 0x00, 0x02, 0x0e, 0x02,
|
||||
0x00, 0x03, 0x01, 0x02, 0x03, 0x02, 0xc8,
|
||||
0x00, 0xff, 0x10, 0x00, 0x0e, 0x12, 0x00,
|
||||
0x00, 0x04};
|
||||
const __u8 nci_init_rsp_v2[] = {0x40, 0x01, 0x1c, 0x00, 0x1a, 0x7e, 0x06,
|
||||
0x00, 0x02, 0x92, 0x04, 0xff, 0xff, 0x01,
|
||||
0x00, 0x40, 0x06, 0x00, 0x00, 0x01, 0x01,
|
||||
0x00, 0x02, 0x00, 0x03, 0x01, 0x01, 0x06,
|
||||
0x00, 0x80, 0x00};
|
||||
const __u8 nci_rf_disc_map_rsp[] = {0x41, 0x00, 0x01, 0x00};
|
||||
const __u8 nci_rf_disc_rsp[] = {0x41, 0x03, 0x01, 0x00};
|
||||
const __u8 nci_rf_deact_rsp[] = {0x41, 0x06, 0x01, 0x00};
|
||||
|
||||
struct msgtemplate {
|
||||
struct nlmsghdr n;
|
||||
struct genlmsghdr g;
|
||||
char buf[MAX_MSG_SIZE];
|
||||
};
|
||||
|
||||
static int create_nl_socket(void)
|
||||
{
|
||||
int fd;
|
||||
struct sockaddr_nl local;
|
||||
|
||||
fd = socket(AF_NETLINK, SOCK_RAW, NETLINK_GENERIC);
|
||||
if (fd < 0)
|
||||
return -1;
|
||||
|
||||
memset(&local, 0, sizeof(local));
|
||||
local.nl_family = AF_NETLINK;
|
||||
|
||||
if (bind(fd, (struct sockaddr *)&local, sizeof(local)) < 0)
|
||||
goto error;
|
||||
|
||||
return fd;
|
||||
error:
|
||||
close(fd);
|
||||
return -1;
|
||||
}
|
||||
|
||||
static int send_cmd_mt_nla(int sd, __u16 nlmsg_type, __u32 nlmsg_pid,
|
||||
__u8 genl_cmd, int nla_num, __u16 nla_type[],
|
||||
void *nla_data[], int nla_len[])
|
||||
{
|
||||
struct sockaddr_nl nladdr;
|
||||
struct msgtemplate msg;
|
||||
struct nlattr *na;
|
||||
int cnt, prv_len;
|
||||
int r, buflen;
|
||||
char *buf;
|
||||
|
||||
msg.n.nlmsg_len = NLMSG_LENGTH(GENL_HDRLEN);
|
||||
msg.n.nlmsg_type = nlmsg_type;
|
||||
msg.n.nlmsg_flags = NLM_F_REQUEST;
|
||||
msg.n.nlmsg_seq = 0;
|
||||
msg.n.nlmsg_pid = nlmsg_pid;
|
||||
msg.g.cmd = genl_cmd;
|
||||
msg.g.version = 0x1;
|
||||
|
||||
prv_len = 0;
|
||||
for (cnt = 0; cnt < nla_num; cnt++) {
|
||||
na = (struct nlattr *)(GENLMSG_DATA(&msg) + prv_len);
|
||||
na->nla_type = nla_type[cnt];
|
||||
na->nla_len = nla_len[cnt] + NLA_HDRLEN;
|
||||
|
||||
if (nla_len > 0)
|
||||
memcpy(NLA_DATA(na), nla_data[cnt], nla_len[cnt]);
|
||||
|
||||
msg.n.nlmsg_len += NLMSG_ALIGN(na->nla_len);
|
||||
prv_len = na->nla_len;
|
||||
}
|
||||
|
||||
buf = (char *)&msg;
|
||||
buflen = msg.n.nlmsg_len;
|
||||
memset(&nladdr, 0, sizeof(nladdr));
|
||||
nladdr.nl_family = AF_NETLINK;
|
||||
|
||||
while ((r = sendto(sd, buf, buflen, 0, (struct sockaddr *)&nladdr,
|
||||
sizeof(nladdr))) < buflen) {
|
||||
if (r > 0) {
|
||||
buf += r;
|
||||
buflen -= r;
|
||||
} else if (errno != EAGAIN) {
|
||||
return -1;
|
||||
}
|
||||
}
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int send_get_nfc_family(int sd, __u32 pid)
|
||||
{
|
||||
__u16 nla_get_family_type = CTRL_ATTR_FAMILY_NAME;
|
||||
void *nla_get_family_data;
|
||||
int nla_get_family_len;
|
||||
char family_name[100];
|
||||
|
||||
nla_get_family_len = strlen(NFC_GENL_NAME) + 1;
|
||||
strcpy(family_name, NFC_GENL_NAME);
|
||||
nla_get_family_data = family_name;
|
||||
|
||||
return send_cmd_mt_nla(sd, GENL_ID_CTRL, pid, CTRL_CMD_GETFAMILY,
|
||||
1, &nla_get_family_type,
|
||||
&nla_get_family_data, &nla_get_family_len);
|
||||
}
|
||||
|
||||
static int get_family_id(int sd, __u32 pid)
|
||||
{
|
||||
struct {
|
||||
struct nlmsghdr n;
|
||||
struct genlmsghdr g;
|
||||
char buf[512];
|
||||
} ans;
|
||||
struct nlattr *na;
|
||||
int rep_len;
|
||||
__u16 id;
|
||||
int rc;
|
||||
|
||||
rc = send_get_nfc_family(sd, pid);
|
||||
|
||||
if (rc < 0)
|
||||
return 0;
|
||||
|
||||
rep_len = recv(sd, &ans, sizeof(ans), 0);
|
||||
|
||||
if (ans.n.nlmsg_type == NLMSG_ERROR || rep_len < 0 ||
|
||||
!NLMSG_OK(&ans.n, rep_len))
|
||||
return 0;
|
||||
|
||||
na = (struct nlattr *)GENLMSG_DATA(&ans);
|
||||
na = (struct nlattr *)((char *)na + NLA_ALIGN(na->nla_len));
|
||||
if (na->nla_type == CTRL_ATTR_FAMILY_ID)
|
||||
id = *(__u16 *)NLA_DATA(na);
|
||||
|
||||
return id;
|
||||
}
|
||||
|
||||
static int send_cmd_with_idx(int sd, __u16 nlmsg_type, __u32 nlmsg_pid,
|
||||
__u8 genl_cmd, int dev_id)
|
||||
{
|
||||
__u16 nla_type = NFC_ATTR_DEVICE_INDEX;
|
||||
void *nla_data = &dev_id;
|
||||
int nla_len = 4;
|
||||
|
||||
return send_cmd_mt_nla(sd, nlmsg_type, nlmsg_pid, genl_cmd, 1,
|
||||
&nla_type, &nla_data, &nla_len);
|
||||
}
|
||||
|
||||
static int get_nci_devid(int sd, __u16 fid, __u32 pid, int dev_id, struct msgtemplate *msg)
|
||||
{
|
||||
int rc, rep_len;
|
||||
|
||||
rc = send_cmd_with_idx(sd, fid, pid, NFC_CMD_GET_DEVICE, dev_id);
|
||||
if (rc < 0) {
|
||||
rc = -1;
|
||||
goto error;
|
||||
}
|
||||
|
||||
rep_len = recv(sd, msg, sizeof(*msg), 0);
|
||||
if (rep_len < 0) {
|
||||
rc = -2;
|
||||
goto error;
|
||||
}
|
||||
|
||||
if (msg->n.nlmsg_type == NLMSG_ERROR ||
|
||||
!NLMSG_OK(&msg->n, rep_len)) {
|
||||
rc = -3;
|
||||
goto error;
|
||||
}
|
||||
|
||||
return 0;
|
||||
error:
|
||||
return rc;
|
||||
}
|
||||
|
||||
static __u8 get_dev_enable_state(struct msgtemplate *msg)
|
||||
{
|
||||
struct nlattr *na;
|
||||
int rep_len;
|
||||
int len;
|
||||
|
||||
rep_len = GENLMSG_PAYLOAD(&msg->n);
|
||||
na = (struct nlattr *)GENLMSG_DATA(msg);
|
||||
len = 0;
|
||||
|
||||
while (len < rep_len) {
|
||||
len += NLA_ALIGN(na->nla_len);
|
||||
if (na->nla_type == NFC_ATTR_DEVICE_POWERED)
|
||||
return *(char *)NLA_DATA(na);
|
||||
na = (struct nlattr *)(GENLMSG_DATA(msg) + len);
|
||||
}
|
||||
|
||||
return rep_len;
|
||||
}
|
||||
|
||||
FIXTURE(NCI) {
|
||||
int virtual_nci_fd;
|
||||
bool open_state;
|
||||
int dev_idex;
|
||||
bool isNCI2;
|
||||
int proto;
|
||||
__u32 pid;
|
||||
__u16 fid;
|
||||
int sd;
|
||||
};
|
||||
|
||||
FIXTURE_VARIANT(NCI) {
|
||||
bool isNCI2;
|
||||
};
|
||||
|
||||
FIXTURE_VARIANT_ADD(NCI, NCI1_0) {
|
||||
.isNCI2 = false,
|
||||
};
|
||||
|
||||
FIXTURE_VARIANT_ADD(NCI, NCI2_0) {
|
||||
.isNCI2 = true,
|
||||
};
|
||||
|
||||
static void *virtual_dev_open(void *data)
|
||||
{
|
||||
char buf[258];
|
||||
int dev_fd;
|
||||
int len;
|
||||
|
||||
dev_fd = *(int *)data;
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_reset_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_reset_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_reset_rsp, sizeof(nci_reset_rsp));
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_init_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_init_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_init_rsp, sizeof(nci_init_rsp));
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_rf_disc_map_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_rf_disc_map_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_rf_disc_map_rsp, sizeof(nci_rf_disc_map_rsp));
|
||||
|
||||
return (void *)0;
|
||||
error:
|
||||
return (void *)-1;
|
||||
}
|
||||
|
||||
static void *virtual_dev_open_v2(void *data)
|
||||
{
|
||||
char buf[258];
|
||||
int dev_fd;
|
||||
int len;
|
||||
|
||||
dev_fd = *(int *)data;
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_reset_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_reset_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_reset_rsp_v2, sizeof(nci_reset_rsp_v2));
|
||||
write(dev_fd, nci_reset_ntf, sizeof(nci_reset_ntf));
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_init_cmd_v2))
|
||||
goto error;
|
||||
if (memcmp(nci_init_cmd_v2, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_init_rsp_v2, sizeof(nci_init_rsp_v2));
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_rf_disc_map_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_rf_disc_map_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_rf_disc_map_rsp, sizeof(nci_rf_disc_map_rsp));
|
||||
|
||||
return (void *)0;
|
||||
error:
|
||||
return (void *)-1;
|
||||
}
|
||||
|
||||
FIXTURE_SETUP(NCI)
|
||||
{
|
||||
struct msgtemplate msg;
|
||||
pthread_t thread_t;
|
||||
int status;
|
||||
int rc;
|
||||
|
||||
self->open_state = false;
|
||||
self->proto = VIRTUAL_NFC_PROTOCOLS;
|
||||
self->isNCI2 = variant->isNCI2;
|
||||
|
||||
self->sd = create_nl_socket();
|
||||
ASSERT_NE(self->sd, -1);
|
||||
|
||||
self->pid = getpid();
|
||||
self->fid = get_family_id(self->sd, self->pid);
|
||||
ASSERT_NE(self->fid, -1);
|
||||
|
||||
self->virtual_nci_fd = open("/dev/virtual_nci", O_RDWR);
|
||||
ASSERT_GT(self->virtual_nci_fd, -1);
|
||||
|
||||
rc = ioctl(self->virtual_nci_fd, IOCTL_GET_NCIDEV_IDX, &self->dev_idex);
|
||||
ASSERT_EQ(rc, 0);
|
||||
|
||||
rc = get_nci_devid(self->sd, self->fid, self->pid, self->dev_idex, &msg);
|
||||
ASSERT_EQ(rc, 0);
|
||||
EXPECT_EQ(get_dev_enable_state(&msg), 0);
|
||||
|
||||
if (self->isNCI2)
|
||||
rc = pthread_create(&thread_t, NULL, virtual_dev_open_v2,
|
||||
(void *)&self->virtual_nci_fd);
|
||||
else
|
||||
rc = pthread_create(&thread_t, NULL, virtual_dev_open,
|
||||
(void *)&self->virtual_nci_fd);
|
||||
ASSERT_GT(rc, -1);
|
||||
|
||||
rc = send_cmd_with_idx(self->sd, self->fid, self->pid,
|
||||
NFC_CMD_DEV_UP, self->dev_idex);
|
||||
EXPECT_EQ(rc, 0);
|
||||
|
||||
pthread_join(thread_t, (void **)&status);
|
||||
ASSERT_EQ(status, 0);
|
||||
self->open_state = true;
|
||||
}
|
||||
|
||||
static void *virtual_deinit(void *data)
|
||||
{
|
||||
char buf[258];
|
||||
int dev_fd;
|
||||
int len;
|
||||
|
||||
dev_fd = *(int *)data;
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_reset_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_reset_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_reset_rsp, sizeof(nci_reset_rsp));
|
||||
|
||||
return (void *)0;
|
||||
error:
|
||||
return (void *)-1;
|
||||
}
|
||||
|
||||
static void *virtual_deinit_v2(void *data)
|
||||
{
|
||||
char buf[258];
|
||||
int dev_fd;
|
||||
int len;
|
||||
|
||||
dev_fd = *(int *)data;
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_reset_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_reset_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_reset_rsp_v2, sizeof(nci_reset_rsp_v2));
|
||||
write(dev_fd, nci_reset_ntf, sizeof(nci_reset_ntf));
|
||||
|
||||
return (void *)0;
|
||||
error:
|
||||
return (void *)-1;
|
||||
}
|
||||
|
||||
FIXTURE_TEARDOWN(NCI)
|
||||
{
|
||||
pthread_t thread_t;
|
||||
int status;
|
||||
int rc;
|
||||
|
||||
if (self->open_state) {
|
||||
if (self->isNCI2)
|
||||
rc = pthread_create(&thread_t, NULL,
|
||||
virtual_deinit_v2,
|
||||
(void *)&self->virtual_nci_fd);
|
||||
else
|
||||
rc = pthread_create(&thread_t, NULL, virtual_deinit,
|
||||
(void *)&self->virtual_nci_fd);
|
||||
|
||||
ASSERT_GT(rc, -1);
|
||||
rc = send_cmd_with_idx(self->sd, self->fid, self->pid,
|
||||
NFC_CMD_DEV_DOWN, self->dev_idex);
|
||||
EXPECT_EQ(rc, 0);
|
||||
|
||||
pthread_join(thread_t, (void **)&status);
|
||||
ASSERT_EQ(status, 0);
|
||||
}
|
||||
|
||||
close(self->sd);
|
||||
close(self->virtual_nci_fd);
|
||||
self->open_state = false;
|
||||
}
|
||||
|
||||
TEST_F(NCI, init)
|
||||
{
|
||||
struct msgtemplate msg;
|
||||
int rc;
|
||||
|
||||
rc = get_nci_devid(self->sd, self->fid, self->pid, self->dev_idex,
|
||||
&msg);
|
||||
ASSERT_EQ(rc, 0);
|
||||
EXPECT_EQ(get_dev_enable_state(&msg), 1);
|
||||
}
|
||||
|
||||
static void *virtual_poll_start(void *data)
|
||||
{
|
||||
char buf[258];
|
||||
int dev_fd;
|
||||
int len;
|
||||
|
||||
dev_fd = *(int *)data;
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_rf_discovery_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_rf_discovery_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_rf_disc_rsp, sizeof(nci_rf_disc_rsp))
|
||||
;
|
||||
|
||||
return (void *)0;
|
||||
error:
|
||||
return (void *)-1;
|
||||
}
|
||||
|
||||
static void *virtual_poll_stop(void *data)
|
||||
{
|
||||
char buf[258];
|
||||
int dev_fd;
|
||||
int len;
|
||||
|
||||
dev_fd = *(int *)data;
|
||||
|
||||
while ((len = read(dev_fd, buf, 258)) == 0)
|
||||
;
|
||||
if (len <= 0)
|
||||
goto error;
|
||||
if (len != sizeof(nci_rf_deact_cmd))
|
||||
goto error;
|
||||
if (memcmp(nci_rf_deact_cmd, buf, len))
|
||||
goto error;
|
||||
write(dev_fd, nci_rf_deact_rsp, sizeof(nci_rf_deact_rsp));
|
||||
|
||||
return (void *)0;
|
||||
error:
|
||||
return (void *)-1;
|
||||
}
|
||||
|
||||
TEST_F(NCI, start_poll)
|
||||
{
|
||||
__u16 nla_start_poll_type[2] = {NFC_ATTR_DEVICE_INDEX,
|
||||
NFC_ATTR_PROTOCOLS};
|
||||
void *nla_start_poll_data[2] = {&self->dev_idex, &self->proto};
|
||||
int nla_start_poll_len[2] = {4, 4};
|
||||
pthread_t thread_t;
|
||||
int status;
|
||||
int rc;
|
||||
|
||||
rc = pthread_create(&thread_t, NULL, virtual_poll_start,
|
||||
(void *)&self->virtual_nci_fd);
|
||||
ASSERT_GT(rc, -1);
|
||||
|
||||
rc = send_cmd_mt_nla(self->sd, self->fid, self->pid,
|
||||
NFC_CMD_START_POLL, 2, nla_start_poll_type,
|
||||
nla_start_poll_data, nla_start_poll_len);
|
||||
EXPECT_EQ(rc, 0);
|
||||
|
||||
pthread_join(thread_t, (void **)&status);
|
||||
ASSERT_EQ(status, 0);
|
||||
|
||||
rc = pthread_create(&thread_t, NULL, virtual_poll_stop,
|
||||
(void *)&self->virtual_nci_fd);
|
||||
ASSERT_GT(rc, -1);
|
||||
|
||||
rc = send_cmd_with_idx(self->sd, self->fid, self->pid,
|
||||
NFC_CMD_STOP_POLL, self->dev_idex);
|
||||
EXPECT_EQ(rc, 0);
|
||||
|
||||
pthread_join(thread_t, (void **)&status);
|
||||
ASSERT_EQ(status, 0);
|
||||
}
|
||||
|
||||
TEST_F(NCI, deinit)
|
||||
{
|
||||
struct msgtemplate msg;
|
||||
pthread_t thread_t;
|
||||
int status;
|
||||
int rc;
|
||||
|
||||
rc = get_nci_devid(self->sd, self->fid, self->pid, self->dev_idex,
|
||||
&msg);
|
||||
ASSERT_EQ(rc, 0);
|
||||
EXPECT_EQ(get_dev_enable_state(&msg), 1);
|
||||
|
||||
if (self->isNCI2)
|
||||
rc = pthread_create(&thread_t, NULL, virtual_deinit_v2,
|
||||
(void *)&self->virtual_nci_fd);
|
||||
else
|
||||
rc = pthread_create(&thread_t, NULL, virtual_deinit,
|
||||
(void *)&self->virtual_nci_fd);
|
||||
ASSERT_GT(rc, -1);
|
||||
|
||||
rc = send_cmd_with_idx(self->sd, self->fid, self->pid,
|
||||
NFC_CMD_DEV_DOWN, self->dev_idex);
|
||||
EXPECT_EQ(rc, 0);
|
||||
|
||||
pthread_join(thread_t, (void **)&status);
|
||||
self->open_state = 0;
|
||||
ASSERT_EQ(status, 0);
|
||||
|
||||
rc = get_nci_devid(self->sd, self->fid, self->pid, self->dev_idex,
|
||||
&msg);
|
||||
ASSERT_EQ(rc, 0);
|
||||
EXPECT_EQ(get_dev_enable_state(&msg), 0);
|
||||
}
|
||||
|
||||
TEST_HARNESS_MAIN
|
||||
Loading…
Reference in New Issue
Block a user