NFC: Parse NCI NFC-DEP activation params
Signed-off-by: Ilan Elias <ilane@ti.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
This commit is contained in:
parent
7e0352306f
commit
ac20683840
|
@ -351,6 +351,11 @@ struct activation_params_nfcb_poll_iso_dep {
|
||||||
__u8 attrib_res[50];
|
__u8 attrib_res[50];
|
||||||
};
|
};
|
||||||
|
|
||||||
|
struct activation_params_poll_nfc_dep {
|
||||||
|
__u8 atr_res_len;
|
||||||
|
__u8 atr_res[63];
|
||||||
|
};
|
||||||
|
|
||||||
struct nci_rf_intf_activated_ntf {
|
struct nci_rf_intf_activated_ntf {
|
||||||
__u8 rf_discovery_id;
|
__u8 rf_discovery_id;
|
||||||
__u8 rf_interface;
|
__u8 rf_interface;
|
||||||
|
@ -374,6 +379,7 @@ struct nci_rf_intf_activated_ntf {
|
||||||
union {
|
union {
|
||||||
struct activation_params_nfca_poll_iso_dep nfca_poll_iso_dep;
|
struct activation_params_nfca_poll_iso_dep nfca_poll_iso_dep;
|
||||||
struct activation_params_nfcb_poll_iso_dep nfcb_poll_iso_dep;
|
struct activation_params_nfcb_poll_iso_dep nfcb_poll_iso_dep;
|
||||||
|
struct activation_params_poll_nfc_dep poll_nfc_dep;
|
||||||
} activation_params;
|
} activation_params;
|
||||||
|
|
||||||
} __packed;
|
} __packed;
|
||||||
|
|
|
@ -361,6 +361,33 @@ static int nci_extract_activation_params_iso_dep(struct nci_dev *ndev,
|
||||||
return NCI_STATUS_OK;
|
return NCI_STATUS_OK;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
static int nci_extract_activation_params_nfc_dep(struct nci_dev *ndev,
|
||||||
|
struct nci_rf_intf_activated_ntf *ntf, __u8 *data)
|
||||||
|
{
|
||||||
|
struct activation_params_poll_nfc_dep *poll;
|
||||||
|
int i;
|
||||||
|
|
||||||
|
switch (ntf->activation_rf_tech_and_mode) {
|
||||||
|
case NCI_NFC_A_PASSIVE_POLL_MODE:
|
||||||
|
case NCI_NFC_F_PASSIVE_POLL_MODE:
|
||||||
|
poll = &ntf->activation_params.poll_nfc_dep;
|
||||||
|
poll->atr_res_len = min_t(__u8, *data++, 63);
|
||||||
|
pr_debug("atr_res_len %d\n", poll->atr_res_len);
|
||||||
|
if (poll->atr_res_len > 0) {
|
||||||
|
for (i = 0; i < poll->atr_res_len; i++)
|
||||||
|
poll->atr_res[poll->atr_res_len-1-i] = data[i];
|
||||||
|
}
|
||||||
|
break;
|
||||||
|
|
||||||
|
default:
|
||||||
|
pr_err("unsupported activation_rf_tech_and_mode 0x%x\n",
|
||||||
|
ntf->activation_rf_tech_and_mode);
|
||||||
|
return NCI_STATUS_RF_PROTOCOL_ERROR;
|
||||||
|
}
|
||||||
|
|
||||||
|
return NCI_STATUS_OK;
|
||||||
|
}
|
||||||
|
|
||||||
static void nci_target_auto_activated(struct nci_dev *ndev,
|
static void nci_target_auto_activated(struct nci_dev *ndev,
|
||||||
struct nci_rf_intf_activated_ntf *ntf)
|
struct nci_rf_intf_activated_ntf *ntf)
|
||||||
{
|
{
|
||||||
|
@ -454,6 +481,11 @@ static void nci_rf_intf_activated_ntf_packet(struct nci_dev *ndev,
|
||||||
&ntf, data);
|
&ntf, data);
|
||||||
break;
|
break;
|
||||||
|
|
||||||
|
case NCI_RF_INTERFACE_NFC_DEP:
|
||||||
|
err = nci_extract_activation_params_nfc_dep(ndev,
|
||||||
|
&ntf, data);
|
||||||
|
break;
|
||||||
|
|
||||||
case NCI_RF_INTERFACE_FRAME:
|
case NCI_RF_INTERFACE_FRAME:
|
||||||
/* no activation params */
|
/* no activation params */
|
||||||
break;
|
break;
|
||||||
|
|
Loading…
Reference in New Issue