NFC: digital: Set current target active on activate_target() call
The curr_protocol field of nfc_digital_dev structure used to determine if a target is currently active was set too soon, immediately when a target is found. This is not good since there is no other way than deactivate_target() to reset curr_protocol and if activate_target() is not called, the target remains active and it's not possible to put the device in poll mode anymore. With this patch curr_protocol is set when nfc core activates a target, puts a device up, or when an ATR_REQ is received in target mode. Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com> Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
This commit is contained in:
parent
15203b4c79
commit
48e1044515
|
@ -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;
|
||||
}
|
||||
|
||||
|
|
|
@ -681,6 +681,8 @@ void digital_tg_recv_atr_req(struct nfc_digital_dev *ddev, void *arg,
|
|||
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) {
|
||||
PROTOCOL_ERR("14.4.1.6");
|
||||
|
|
Loading…
Reference in New Issue