Commit cf3c7c7b authored by Jakub Kicinski's avatar Jakub Kicinski

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.comSigned-off-by: default avatarJakub Kicinski <kuba@kernel.org>
parents 8c224751 f595cf12
...@@ -12540,6 +12540,14 @@ F: include/net/nfc/ ...@@ -12540,6 +12540,14 @@ F: include/net/nfc/
F: include/uapi/linux/nfc.h F: include/uapi/linux/nfc.h
F: net/nfc/ 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 NFS, SUNRPC, AND LOCKD CLIENTS
M: Trond Myklebust <trond.myklebust@hammerspace.com> M: Trond Myklebust <trond.myklebust@hammerspace.com>
M: Anna Schumaker <anna.schumaker@netapp.com> M: Anna Schumaker <anna.schumaker@netapp.com>
......
...@@ -49,6 +49,17 @@ config NFC_PORT100 ...@@ -49,6 +49,17 @@ config NFC_PORT100
If unsure, say N. 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/fdp/Kconfig"
source "drivers/nfc/pn544/Kconfig" source "drivers/nfc/pn544/Kconfig"
source "drivers/nfc/pn533/Kconfig" source "drivers/nfc/pn533/Kconfig"
......
...@@ -17,3 +17,4 @@ obj-$(CONFIG_NFC_ST_NCI) += st-nci/ ...@@ -17,3 +17,4 @@ obj-$(CONFIG_NFC_ST_NCI) += st-nci/
obj-$(CONFIG_NFC_NXP_NCI) += nxp-nci/ obj-$(CONFIG_NFC_NXP_NCI) += nxp-nci/
obj-$(CONFIG_NFC_S3FWRN5) += s3fwrn5/ obj-$(CONFIG_NFC_S3FWRN5) += s3fwrn5/
obj-$(CONFIG_NFC_ST95HF) += st95hf/ obj-$(CONFIG_NFC_ST95HF) += st95hf/
obj-$(CONFIG_NFC_VIRTUAL_NCI) += virtual_ncidev.o
// 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 ...@@ -34,6 +34,7 @@ TARGETS += memory-hotplug
TARGETS += mincore TARGETS += mincore
TARGETS += mount TARGETS += mount
TARGETS += mqueue TARGETS += mqueue
TARGETS += nci
TARGETS += net TARGETS += net
TARGETS += net/forwarding TARGETS += net/forwarding
TARGETS += net/mptcp TARGETS += net/mptcp
......
# SPDX-License-Identifier: GPL-2.0
CFLAGS += -Wl,-no-as-needed -Wall
LDFLAGS += -lpthread
TEST_GEN_PROGS := nci_dev
include ../lib.mk
CONFIG_NFC=y
CONFIG_NFC_NCI=y
CONFIG_NFC_VIRTUAL_NCI=y
// 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
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment