NFC: nci: Support logical connections management
In order to communicate with an NFCEE, we need to open a logical connection to it, by sending the NCI_OP_CORE_CONN_CREATE_CMD command to the NFCC. It's left up to the drivers to decide when to close an already opened logical connection. Signed-off-by: Christophe Ricard <christophe-h.ricard@st.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
This commit is contained in:
parent
f7f793f313
commit
736bb95774
|
@ -243,6 +243,26 @@ struct nci_core_set_config_cmd {
|
||||||
struct set_config_param param; /* support 1 param per cmd is enough */
|
struct set_config_param param; /* support 1 param per cmd is enough */
|
||||||
} __packed;
|
} __packed;
|
||||||
|
|
||||||
|
#define NCI_OP_CORE_CONN_CREATE_CMD nci_opcode_pack(NCI_GID_CORE, 0x04)
|
||||||
|
struct dest_spec_params {
|
||||||
|
__u8 id;
|
||||||
|
__u8 protocol;
|
||||||
|
} __packed;
|
||||||
|
|
||||||
|
struct core_conn_create_dest_spec_params {
|
||||||
|
__u8 type;
|
||||||
|
__u8 length;
|
||||||
|
struct dest_spec_params value;
|
||||||
|
} __packed;
|
||||||
|
|
||||||
|
struct nci_core_conn_create_cmd {
|
||||||
|
__u8 destination_type;
|
||||||
|
__u8 number_destination_params;
|
||||||
|
struct core_conn_create_dest_spec_params params;
|
||||||
|
} __packed;
|
||||||
|
|
||||||
|
#define NCI_OP_CORE_CONN_CLOSE_CMD nci_opcode_pack(NCI_GID_CORE, 0x05)
|
||||||
|
|
||||||
#define NCI_OP_RF_DISCOVER_MAP_CMD nci_opcode_pack(NCI_GID_RF_MGMT, 0x00)
|
#define NCI_OP_RF_DISCOVER_MAP_CMD nci_opcode_pack(NCI_GID_RF_MGMT, 0x00)
|
||||||
struct disc_map_config {
|
struct disc_map_config {
|
||||||
__u8 rf_protocol;
|
__u8 rf_protocol;
|
||||||
|
@ -327,6 +347,16 @@ struct nci_core_set_config_rsp {
|
||||||
__u8 params_id[0]; /* variable size array */
|
__u8 params_id[0]; /* variable size array */
|
||||||
} __packed;
|
} __packed;
|
||||||
|
|
||||||
|
#define NCI_OP_CORE_CONN_CREATE_RSP nci_opcode_pack(NCI_GID_CORE, 0x04)
|
||||||
|
struct nci_core_conn_create_rsp {
|
||||||
|
__u8 status;
|
||||||
|
__u8 max_ctrl_pkt_payload_len;
|
||||||
|
__u8 credits;
|
||||||
|
__u8 conn_id;
|
||||||
|
} __packed;
|
||||||
|
|
||||||
|
#define NCI_OP_CORE_CONN_CLOSE_RSP nci_opcode_pack(NCI_GID_CORE, 0x05)
|
||||||
|
|
||||||
#define NCI_OP_RF_DISCOVER_MAP_RSP nci_opcode_pack(NCI_GID_RF_MGMT, 0x00)
|
#define NCI_OP_RF_DISCOVER_MAP_RSP nci_opcode_pack(NCI_GID_RF_MGMT, 0x00)
|
||||||
|
|
||||||
#define NCI_OP_RF_DISCOVER_RSP nci_opcode_pack(NCI_GID_RF_MGMT, 0x03)
|
#define NCI_OP_RF_DISCOVER_RSP nci_opcode_pack(NCI_GID_RF_MGMT, 0x03)
|
||||||
|
|
|
@ -186,6 +186,9 @@ int nci_set_config(struct nci_dev *ndev, __u8 id, size_t len, __u8 *val);
|
||||||
|
|
||||||
int nci_nfcee_discover(struct nci_dev *ndev, u8 action);
|
int nci_nfcee_discover(struct nci_dev *ndev, u8 action);
|
||||||
int nci_nfcee_mode_set(struct nci_dev *ndev, u8 nfcee_id, u8 nfcee_mode);
|
int nci_nfcee_mode_set(struct nci_dev *ndev, u8 nfcee_id, u8 nfcee_mode);
|
||||||
|
int nci_core_conn_create(struct nci_dev *ndev,
|
||||||
|
struct core_conn_create_dest_spec_params *params);
|
||||||
|
int nci_core_conn_close(struct nci_dev *ndev, u8 conn_id);
|
||||||
|
|
||||||
static inline struct sk_buff *nci_skb_alloc(struct nci_dev *ndev,
|
static inline struct sk_buff *nci_skb_alloc(struct nci_dev *ndev,
|
||||||
unsigned int len,
|
unsigned int len,
|
||||||
|
|
|
@ -507,6 +507,44 @@ int nci_nfcee_mode_set(struct nci_dev *ndev, u8 nfcee_id, u8 nfcee_mode)
|
||||||
}
|
}
|
||||||
EXPORT_SYMBOL(nci_nfcee_mode_set);
|
EXPORT_SYMBOL(nci_nfcee_mode_set);
|
||||||
|
|
||||||
|
static void nci_core_conn_create_req(struct nci_dev *ndev, unsigned long opt)
|
||||||
|
{
|
||||||
|
struct nci_core_conn_create_cmd cmd;
|
||||||
|
struct core_conn_create_dest_spec_params *params =
|
||||||
|
(struct core_conn_create_dest_spec_params *)opt;
|
||||||
|
|
||||||
|
cmd.destination_type = NCI_DESTINATION_NFCEE;
|
||||||
|
cmd.number_destination_params = 1;
|
||||||
|
memcpy(&cmd.params.type, params,
|
||||||
|
sizeof(struct core_conn_create_dest_spec_params));
|
||||||
|
nci_send_cmd(ndev, NCI_OP_CORE_CONN_CREATE_CMD,
|
||||||
|
sizeof(struct nci_core_conn_create_cmd), &cmd);
|
||||||
|
}
|
||||||
|
|
||||||
|
int nci_core_conn_create(struct nci_dev *ndev,
|
||||||
|
struct core_conn_create_dest_spec_params *params)
|
||||||
|
{
|
||||||
|
ndev->cur_id = params->value.id;
|
||||||
|
return nci_request(ndev, nci_core_conn_create_req,
|
||||||
|
(unsigned long)params,
|
||||||
|
msecs_to_jiffies(NCI_CMD_TIMEOUT));
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(nci_core_conn_create);
|
||||||
|
|
||||||
|
static void nci_core_conn_close_req(struct nci_dev *ndev, unsigned long opt)
|
||||||
|
{
|
||||||
|
__u8 conn_id = opt;
|
||||||
|
|
||||||
|
nci_send_cmd(ndev, NCI_OP_CORE_CONN_CLOSE_CMD, 1, &conn_id);
|
||||||
|
}
|
||||||
|
|
||||||
|
int nci_core_conn_close(struct nci_dev *ndev, u8 conn_id)
|
||||||
|
{
|
||||||
|
return nci_request(ndev, nci_core_conn_close_req, conn_id,
|
||||||
|
msecs_to_jiffies(NCI_CMD_TIMEOUT));
|
||||||
|
}
|
||||||
|
EXPORT_SYMBOL(nci_core_conn_close);
|
||||||
|
|
||||||
static int nci_set_local_general_bytes(struct nfc_dev *nfc_dev)
|
static int nci_set_local_general_bytes(struct nfc_dev *nfc_dev)
|
||||||
{
|
{
|
||||||
struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
|
struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
|
||||||
|
|
|
@ -222,6 +222,45 @@ static void nci_nfcee_mode_set_rsp_packet(struct nci_dev *ndev,
|
||||||
nci_req_complete(ndev, status);
|
nci_req_complete(ndev, status);
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static void nci_core_conn_create_rsp_packet(struct nci_dev *ndev,
|
||||||
|
struct sk_buff *skb)
|
||||||
|
{
|
||||||
|
__u8 status = skb->data[0];
|
||||||
|
struct nci_conn_info *conn_info;
|
||||||
|
struct nci_core_conn_create_rsp *rsp;
|
||||||
|
|
||||||
|
pr_debug("status 0x%x\n", status);
|
||||||
|
|
||||||
|
if (status == NCI_STATUS_OK) {
|
||||||
|
rsp = (struct nci_core_conn_create_rsp *)skb->data;
|
||||||
|
list_for_each_entry(conn_info, &ndev->conn_info_list, list) {
|
||||||
|
if (conn_info->id == ndev->cur_id)
|
||||||
|
break;
|
||||||
|
}
|
||||||
|
|
||||||
|
if (!conn_info || conn_info->id != ndev->cur_id) {
|
||||||
|
status = NCI_STATUS_REJECTED;
|
||||||
|
goto exit;
|
||||||
|
}
|
||||||
|
|
||||||
|
conn_info->conn_id = rsp->conn_id;
|
||||||
|
conn_info->max_pkt_payload_len = rsp->max_ctrl_pkt_payload_len;
|
||||||
|
atomic_set(&conn_info->credits_cnt, rsp->credits);
|
||||||
|
}
|
||||||
|
|
||||||
|
exit:
|
||||||
|
nci_req_complete(ndev, status);
|
||||||
|
}
|
||||||
|
|
||||||
|
static void nci_core_conn_close_rsp_packet(struct nci_dev *ndev,
|
||||||
|
struct sk_buff *skb)
|
||||||
|
{
|
||||||
|
__u8 status = skb->data[0];
|
||||||
|
|
||||||
|
pr_debug("status 0x%x\n", status);
|
||||||
|
nci_req_complete(ndev, status);
|
||||||
|
}
|
||||||
|
|
||||||
void nci_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
|
void nci_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
|
||||||
{
|
{
|
||||||
__u16 rsp_opcode = nci_opcode(skb->data);
|
__u16 rsp_opcode = nci_opcode(skb->data);
|
||||||
|
@ -251,6 +290,14 @@ void nci_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
|
||||||
nci_core_set_config_rsp_packet(ndev, skb);
|
nci_core_set_config_rsp_packet(ndev, skb);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case NCI_OP_CORE_CONN_CREATE_RSP:
|
||||||
|
nci_core_conn_create_rsp_packet(ndev, skb);
|
||||||
|
break;
|
||||||
|
|
||||||
|
case NCI_OP_CORE_CONN_CLOSE_RSP:
|
||||||
|
nci_core_conn_close_rsp_packet(ndev, skb);
|
||||||
|
break;
|
||||||
|
|
||||||
case NCI_OP_RF_DISCOVER_MAP_RSP:
|
case NCI_OP_RF_DISCOVER_MAP_RSP:
|
||||||
nci_rf_disc_map_rsp_packet(ndev, skb);
|
nci_rf_disc_map_rsp_packet(ndev, skb);
|
||||||
break;
|
break;
|
||||||
|
|
Loading…
Reference in a new issue