Merge branch 'master' of git://git.kernel.org/pub/scm/linux/kernel/git/linville/wireless-next into for-davem
This commit is contained in:
@@ -133,11 +133,8 @@ int nfc_dev_up(struct nfc_dev *dev)
|
||||
dev->dev_up = true;
|
||||
|
||||
/* We have to enable the device before discovering SEs */
|
||||
if (dev->ops->discover_se) {
|
||||
rc = dev->ops->discover_se(dev);
|
||||
if (rc)
|
||||
pr_warn("SE discovery failed\n");
|
||||
}
|
||||
if (dev->ops->discover_se && dev->ops->discover_se(dev))
|
||||
pr_err("SE discovery failed\n");
|
||||
|
||||
error:
|
||||
device_unlock(&dev->dev);
|
||||
|
||||
@@ -339,7 +339,6 @@ int digital_target_found(struct nfc_digital_dev *ddev,
|
||||
pr_debug("rf_tech=%d, protocol=%d\n", rf_tech, protocol);
|
||||
|
||||
ddev->curr_rf_tech = rf_tech;
|
||||
ddev->curr_protocol = protocol;
|
||||
|
||||
if (DIGITAL_DRV_CAPS_IN_CRC(ddev)) {
|
||||
ddev->skb_add_crc = digital_skb_add_crc_none;
|
||||
@@ -541,8 +540,14 @@ static int digital_dep_link_up(struct nfc_dev *nfc_dev,
|
||||
__u8 comm_mode, __u8 *gb, size_t gb_len)
|
||||
{
|
||||
struct nfc_digital_dev *ddev = nfc_get_drvdata(nfc_dev);
|
||||
int rc;
|
||||
|
||||
return digital_in_send_atr_req(ddev, target, comm_mode, gb, gb_len);
|
||||
rc = digital_in_send_atr_req(ddev, target, comm_mode, gb, gb_len);
|
||||
|
||||
if (!rc)
|
||||
ddev->curr_protocol = NFC_PROTO_NFC_DEP;
|
||||
|
||||
return rc;
|
||||
}
|
||||
|
||||
static int digital_dep_link_down(struct nfc_dev *nfc_dev)
|
||||
@@ -557,6 +562,20 @@ static int digital_dep_link_down(struct nfc_dev *nfc_dev)
|
||||
static int digital_activate_target(struct nfc_dev *nfc_dev,
|
||||
struct nfc_target *target, __u32 protocol)
|
||||
{
|
||||
struct nfc_digital_dev *ddev = nfc_get_drvdata(nfc_dev);
|
||||
|
||||
if (ddev->poll_tech_count) {
|
||||
pr_err("Can't activate a target while polling\n");
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
if (ddev->curr_protocol) {
|
||||
pr_err("A target is already active\n");
|
||||
return -EBUSY;
|
||||
}
|
||||
|
||||
ddev->curr_protocol = protocol;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
@@ -565,6 +584,11 @@ static void digital_deactivate_target(struct nfc_dev *nfc_dev,
|
||||
{
|
||||
struct nfc_digital_dev *ddev = nfc_get_drvdata(nfc_dev);
|
||||
|
||||
if (!ddev->curr_protocol) {
|
||||
pr_err("No active target\n");
|
||||
return;
|
||||
}
|
||||
|
||||
ddev->curr_protocol = 0;
|
||||
}
|
||||
|
||||
|
||||
@@ -32,7 +32,6 @@
|
||||
#define DIGITAL_ATR_REQ_MIN_SIZE 16
|
||||
#define DIGITAL_ATR_REQ_MAX_SIZE 64
|
||||
|
||||
#define DIGITAL_NFCID3_LEN ((u8)8)
|
||||
#define DIGITAL_LR_BITS_PAYLOAD_SIZE_254B 0x30
|
||||
#define DIGITAL_GB_BIT 0x02
|
||||
|
||||
@@ -206,10 +205,9 @@ int digital_in_send_atr_req(struct nfc_digital_dev *ddev,
|
||||
atr_req->dir = DIGITAL_NFC_DEP_FRAME_DIR_OUT;
|
||||
atr_req->cmd = DIGITAL_CMD_ATR_REQ;
|
||||
if (target->nfcid2_len)
|
||||
memcpy(atr_req->nfcid3, target->nfcid2,
|
||||
max(target->nfcid2_len, DIGITAL_NFCID3_LEN));
|
||||
memcpy(atr_req->nfcid3, target->nfcid2, NFC_NFCID2_MAXSIZE);
|
||||
else
|
||||
get_random_bytes(atr_req->nfcid3, DIGITAL_NFCID3_LEN);
|
||||
get_random_bytes(atr_req->nfcid3, NFC_NFCID3_MAXSIZE);
|
||||
|
||||
atr_req->did = 0;
|
||||
atr_req->bs = 0;
|
||||
@@ -382,6 +380,33 @@ int digital_in_send_dep_req(struct nfc_digital_dev *ddev,
|
||||
data_exch);
|
||||
}
|
||||
|
||||
static void digital_tg_set_rf_tech(struct nfc_digital_dev *ddev, u8 rf_tech)
|
||||
{
|
||||
ddev->curr_rf_tech = rf_tech;
|
||||
|
||||
ddev->skb_add_crc = digital_skb_add_crc_none;
|
||||
ddev->skb_check_crc = digital_skb_check_crc_none;
|
||||
|
||||
if (DIGITAL_DRV_CAPS_TG_CRC(ddev))
|
||||
return;
|
||||
|
||||
switch (ddev->curr_rf_tech) {
|
||||
case NFC_DIGITAL_RF_TECH_106A:
|
||||
ddev->skb_add_crc = digital_skb_add_crc_a;
|
||||
ddev->skb_check_crc = digital_skb_check_crc_a;
|
||||
break;
|
||||
|
||||
case NFC_DIGITAL_RF_TECH_212F:
|
||||
case NFC_DIGITAL_RF_TECH_424F:
|
||||
ddev->skb_add_crc = digital_skb_add_crc_f;
|
||||
ddev->skb_check_crc = digital_skb_check_crc_f;
|
||||
break;
|
||||
|
||||
default:
|
||||
break;
|
||||
}
|
||||
}
|
||||
|
||||
static void digital_tg_recv_dep_req(struct nfc_digital_dev *ddev, void *arg,
|
||||
struct sk_buff *resp)
|
||||
{
|
||||
@@ -472,11 +497,13 @@ int digital_tg_send_dep_res(struct nfc_digital_dev *ddev, struct sk_buff *skb)
|
||||
static void digital_tg_send_psl_res_complete(struct nfc_digital_dev *ddev,
|
||||
void *arg, struct sk_buff *resp)
|
||||
{
|
||||
u8 rf_tech = PTR_ERR(arg);
|
||||
u8 rf_tech = (unsigned long)arg;
|
||||
|
||||
if (IS_ERR(resp))
|
||||
return;
|
||||
|
||||
digital_tg_set_rf_tech(ddev, rf_tech);
|
||||
|
||||
digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech);
|
||||
|
||||
digital_tg_listen(ddev, 1500, digital_tg_recv_dep_req, NULL);
|
||||
@@ -508,7 +535,7 @@ static int digital_tg_send_psl_res(struct nfc_digital_dev *ddev, u8 did,
|
||||
ddev->skb_add_crc(skb);
|
||||
|
||||
rc = digital_tg_send_cmd(ddev, skb, 0, digital_tg_send_psl_res_complete,
|
||||
ERR_PTR(rf_tech));
|
||||
(void *)(unsigned long)rf_tech);
|
||||
|
||||
if (rc)
|
||||
kfree_skb(skb);
|
||||
@@ -661,16 +688,10 @@ void digital_tg_recv_atr_req(struct nfc_digital_dev *ddev, void *arg,
|
||||
|
||||
if (resp->data[0] == DIGITAL_NFC_DEP_NFCA_SOD_SB) {
|
||||
min_size = DIGITAL_ATR_REQ_MIN_SIZE + 2;
|
||||
|
||||
ddev->curr_rf_tech = NFC_DIGITAL_RF_TECH_106A;
|
||||
ddev->skb_add_crc = digital_skb_add_crc_a;
|
||||
ddev->skb_check_crc = digital_skb_check_crc_a;
|
||||
digital_tg_set_rf_tech(ddev, NFC_DIGITAL_RF_TECH_106A);
|
||||
} else {
|
||||
min_size = DIGITAL_ATR_REQ_MIN_SIZE + 1;
|
||||
|
||||
ddev->curr_rf_tech = NFC_DIGITAL_RF_TECH_212F;
|
||||
ddev->skb_add_crc = digital_skb_add_crc_f;
|
||||
ddev->skb_check_crc = digital_skb_check_crc_f;
|
||||
digital_tg_set_rf_tech(ddev, NFC_DIGITAL_RF_TECH_212F);
|
||||
}
|
||||
|
||||
if (resp->len < min_size) {
|
||||
@@ -678,10 +699,7 @@ void digital_tg_recv_atr_req(struct nfc_digital_dev *ddev, void *arg,
|
||||
goto exit;
|
||||
}
|
||||
|
||||
if (DIGITAL_DRV_CAPS_TG_CRC(ddev)) {
|
||||
ddev->skb_add_crc = digital_skb_add_crc_none;
|
||||
ddev->skb_check_crc = digital_skb_check_crc_none;
|
||||
}
|
||||
ddev->curr_protocol = NFC_PROTO_NFC_DEP_MASK;
|
||||
|
||||
rc = ddev->skb_check_crc(resp);
|
||||
if (rc) {
|
||||
|
||||
@@ -335,11 +335,8 @@ exit:
|
||||
kfree_skb(skb);
|
||||
|
||||
exit_noskb:
|
||||
if (r) {
|
||||
/* TODO: There was an error dispatching the event,
|
||||
* how to propagate up to nfc core?
|
||||
*/
|
||||
}
|
||||
if (r)
|
||||
nfc_hci_driver_failure(hdev, r);
|
||||
}
|
||||
|
||||
static void nfc_hci_cmd_timeout(unsigned long data)
|
||||
|
||||
@@ -675,7 +675,7 @@ int nfc_llcp_send_i_frame(struct nfc_llcp_sock *sock,
|
||||
|
||||
do {
|
||||
remote_miu = sock->remote_miu > LLCP_MAX_MIU ?
|
||||
local->remote_miu : sock->remote_miu;
|
||||
LLCP_DEFAULT_MIU : sock->remote_miu;
|
||||
|
||||
frag_len = min_t(size_t, remote_miu, remaining_len);
|
||||
|
||||
@@ -684,8 +684,10 @@ int nfc_llcp_send_i_frame(struct nfc_llcp_sock *sock,
|
||||
|
||||
pdu = llcp_allocate_pdu(sock, LLCP_PDU_I,
|
||||
frag_len + LLCP_SEQUENCE_SIZE);
|
||||
if (pdu == NULL)
|
||||
if (pdu == NULL) {
|
||||
kfree(msg_data);
|
||||
return -ENOMEM;
|
||||
}
|
||||
|
||||
skb_put(pdu, LLCP_SEQUENCE_SIZE);
|
||||
|
||||
|
||||
@@ -943,7 +943,6 @@ static void nfc_llcp_recv_connect(struct nfc_llcp_local *local,
|
||||
new_sock->local = nfc_llcp_local_get(local);
|
||||
new_sock->rw = sock->rw;
|
||||
new_sock->miux = sock->miux;
|
||||
new_sock->remote_miu = local->remote_miu;
|
||||
new_sock->nfc_protocol = sock->nfc_protocol;
|
||||
new_sock->dsap = ssap;
|
||||
new_sock->target_idx = local->target_idx;
|
||||
|
||||
@@ -700,7 +700,6 @@ static int llcp_sock_connect(struct socket *sock, struct sockaddr *_addr,
|
||||
|
||||
llcp_sock->dev = dev;
|
||||
llcp_sock->local = nfc_llcp_local_get(local);
|
||||
llcp_sock->remote_miu = llcp_sock->local->remote_miu;
|
||||
llcp_sock->ssap = nfc_llcp_get_local_ssap(local);
|
||||
if (llcp_sock->ssap == LLCP_SAP_MAX) {
|
||||
ret = -ENOMEM;
|
||||
|
||||
@@ -301,6 +301,9 @@ static int nci_open_device(struct nci_dev *ndev)
|
||||
rc = __nci_request(ndev, nci_reset_req, 0,
|
||||
msecs_to_jiffies(NCI_RESET_TIMEOUT));
|
||||
|
||||
if (ndev->ops->setup(ndev))
|
||||
ndev->ops->setup(ndev);
|
||||
|
||||
if (!rc) {
|
||||
rc = __nci_request(ndev, nci_init_req, 0,
|
||||
msecs_to_jiffies(NCI_INIT_TIMEOUT));
|
||||
@@ -361,6 +364,8 @@ static int nci_close_device(struct nci_dev *ndev)
|
||||
msecs_to_jiffies(NCI_RESET_TIMEOUT));
|
||||
clear_bit(NCI_INIT, &ndev->flags);
|
||||
|
||||
del_timer_sync(&ndev->cmd_timer);
|
||||
|
||||
/* Flush cmd wq */
|
||||
flush_workqueue(ndev->cmd_wq);
|
||||
|
||||
@@ -408,12 +413,26 @@ static int nci_dev_down(struct nfc_dev *nfc_dev)
|
||||
return nci_close_device(ndev);
|
||||
}
|
||||
|
||||
int nci_set_config(struct nci_dev *ndev, __u8 id, size_t len, __u8 *val)
|
||||
{
|
||||
struct nci_set_config_param param;
|
||||
|
||||
if (!val || !len)
|
||||
return 0;
|
||||
|
||||
param.id = id;
|
||||
param.len = len;
|
||||
param.val = val;
|
||||
|
||||
return __nci_request(ndev, nci_set_config_req, (unsigned long)¶m,
|
||||
msecs_to_jiffies(NCI_SET_CONFIG_TIMEOUT));
|
||||
}
|
||||
EXPORT_SYMBOL(nci_set_config);
|
||||
|
||||
static int nci_set_local_general_bytes(struct nfc_dev *nfc_dev)
|
||||
{
|
||||
struct nci_dev *ndev = nfc_get_drvdata(nfc_dev);
|
||||
struct nci_set_config_param param;
|
||||
__u8 local_gb[NFC_MAX_GT_LEN];
|
||||
int i;
|
||||
|
||||
param.val = nfc_get_local_general_bytes(nfc_dev, ¶m.len);
|
||||
if ((param.val == NULL) || (param.len == 0))
|
||||
@@ -422,11 +441,7 @@ static int nci_set_local_general_bytes(struct nfc_dev *nfc_dev)
|
||||
if (param.len > NFC_MAX_GT_LEN)
|
||||
return -EINVAL;
|
||||
|
||||
for (i = 0; i < param.len; i++)
|
||||
local_gb[param.len-1-i] = param.val[i];
|
||||
|
||||
param.id = NCI_PN_ATR_REQ_GEN_BYTES;
|
||||
param.val = local_gb;
|
||||
|
||||
return nci_request(ndev, nci_set_config_req, (unsigned long)¶m,
|
||||
msecs_to_jiffies(NCI_SET_CONFIG_TIMEOUT));
|
||||
|
||||
Reference in New Issue
Block a user