2019-05-29 22:18:02 +08:00
|
|
|
// SPDX-License-Identifier: GPL-2.0-only
|
2013-09-19 23:55:26 +08:00
|
|
|
/*
|
|
|
|
|
* NFC Digital Protocol stack
|
|
|
|
|
* Copyright (c) 2013, Intel Corporation.
|
|
|
|
|
*/
|
|
|
|
|
|
2013-09-20 15:05:48 +08:00
|
|
|
#define pr_fmt(fmt) "digital: %s: " fmt, __func__
|
|
|
|
|
|
2013-09-19 23:55:26 +08:00
|
|
|
#include "digital.h"
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_CMD_SENS_REQ 0x26
|
|
|
|
|
#define DIGITAL_CMD_ALL_REQ 0x52
|
|
|
|
|
#define DIGITAL_CMD_SEL_REQ_CL1 0x93
|
|
|
|
|
#define DIGITAL_CMD_SEL_REQ_CL2 0x95
|
|
|
|
|
#define DIGITAL_CMD_SEL_REQ_CL3 0x97
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_SDD_REQ_SEL_PAR 0x20
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_SDD_RES_CT 0x88
|
|
|
|
|
#define DIGITAL_SDD_RES_LEN 5
|
2017-06-16 01:46:15 +08:00
|
|
|
#define DIGITAL_SEL_RES_LEN 1
|
2013-09-19 23:55:26 +08:00
|
|
|
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
#define DIGITAL_SEL_RES_NFCID1_COMPLETE(sel_res) (!((sel_res) & 0x04))
|
|
|
|
|
#define DIGITAL_SEL_RES_IS_T2T(sel_res) (!((sel_res) & 0x60))
|
2014-01-27 07:31:31 +08:00
|
|
|
#define DIGITAL_SEL_RES_IS_T4T(sel_res) ((sel_res) & 0x20)
|
2013-09-19 23:55:29 +08:00
|
|
|
#define DIGITAL_SEL_RES_IS_NFC_DEP(sel_res) ((sel_res) & 0x40)
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
|
2013-09-24 17:47:34 +08:00
|
|
|
#define DIGITAL_SENS_RES_IS_T1T(sens_res) (((sens_res) & 0x0C00) == 0x0C00)
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
#define DIGITAL_SENS_RES_IS_VALID(sens_res) \
|
2013-09-24 17:47:34 +08:00
|
|
|
((!((sens_res) & 0x001F) && (((sens_res) & 0x0C00) == 0x0C00)) || \
|
|
|
|
|
(((sens_res) & 0x001F) && ((sens_res) & 0x0C00) != 0x0C00))
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
|
|
|
|
|
#define DIGITAL_MIFARE_READ_RES_LEN 16
|
|
|
|
|
#define DIGITAL_MIFARE_ACK_RES 0x0A
|
|
|
|
|
|
2014-04-01 08:36:38 +08:00
|
|
|
#define DIGITAL_CMD_SENSB_REQ 0x05
|
|
|
|
|
#define DIGITAL_SENSB_ADVANCED BIT(5)
|
|
|
|
|
#define DIGITAL_SENSB_EXTENDED BIT(4)
|
|
|
|
|
#define DIGITAL_SENSB_ALLB_REQ BIT(3)
|
|
|
|
|
#define DIGITAL_SENSB_N(n) ((n) & 0x7)
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_CMD_SENSB_RES 0x50
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_CMD_ATTRIB_REQ 0x1D
|
|
|
|
|
#define DIGITAL_ATTRIB_P1_TR0_DEFAULT (0x0 << 6)
|
|
|
|
|
#define DIGITAL_ATTRIB_P1_TR1_DEFAULT (0x0 << 4)
|
|
|
|
|
#define DIGITAL_ATTRIB_P1_SUPRESS_EOS BIT(3)
|
|
|
|
|
#define DIGITAL_ATTRIB_P1_SUPRESS_SOS BIT(2)
|
|
|
|
|
#define DIGITAL_ATTRIB_P2_LISTEN_POLL_1 (0x0 << 6)
|
|
|
|
|
#define DIGITAL_ATTRIB_P2_POLL_LISTEN_1 (0x0 << 4)
|
|
|
|
|
#define DIGITAL_ATTRIB_P2_MAX_FRAME_256 0x8
|
|
|
|
|
#define DIGITAL_ATTRIB_P4_DID(n) ((n) & 0xf)
|
|
|
|
|
|
2013-09-19 23:55:28 +08:00
|
|
|
#define DIGITAL_CMD_SENSF_REQ 0x00
|
|
|
|
|
#define DIGITAL_CMD_SENSF_RES 0x01
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_SENSF_RES_MIN_LENGTH 17
|
|
|
|
|
#define DIGITAL_SENSF_RES_RD_AP_B1 0x00
|
|
|
|
|
#define DIGITAL_SENSF_RES_RD_AP_B2 0x8F
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_SENSF_REQ_RC_NONE 0
|
|
|
|
|
#define DIGITAL_SENSF_REQ_RC_SC 1
|
|
|
|
|
#define DIGITAL_SENSF_REQ_RC_AP 2
|
|
|
|
|
|
2014-01-22 07:23:59 +08:00
|
|
|
#define DIGITAL_CMD_ISO15693_INVENTORY_REQ 0x01
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_ISO15693_REQ_FLAG_DATA_RATE BIT(1)
|
|
|
|
|
#define DIGITAL_ISO15693_REQ_FLAG_INVENTORY BIT(2)
|
|
|
|
|
#define DIGITAL_ISO15693_REQ_FLAG_NB_SLOTS BIT(5)
|
|
|
|
|
#define DIGITAL_ISO15693_RES_FLAG_ERROR BIT(0)
|
|
|
|
|
#define DIGITAL_ISO15693_RES_IS_VALID(flags) \
|
|
|
|
|
(!((flags) & DIGITAL_ISO15693_RES_FLAG_ERROR))
|
|
|
|
|
|
2014-01-27 07:31:32 +08:00
|
|
|
#define DIGITAL_ISO_DEP_I_PCB 0x02
|
|
|
|
|
#define DIGITAL_ISO_DEP_PNI(pni) ((pni) & 0x01)
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_ISO_DEP_PCB_TYPE(pcb) ((pcb) & 0xC0)
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_ISO_DEP_I_BLOCK 0x00
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_ISO_DEP_BLOCK_HAS_DID(pcb) ((pcb) & 0x08)
|
|
|
|
|
|
2014-01-27 07:31:31 +08:00
|
|
|
static const u8 digital_ats_fsc[] = {
|
|
|
|
|
16, 24, 32, 40, 48, 64, 96, 128,
|
|
|
|
|
};
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_ATS_FSCI(t0) ((t0) & 0x0F)
|
2014-04-01 08:36:38 +08:00
|
|
|
#define DIGITAL_SENSB_FSCI(pi2) (((pi2) & 0xF0) >> 4)
|
2014-01-27 07:31:31 +08:00
|
|
|
#define DIGITAL_ATS_MAX_FSC 256
|
|
|
|
|
|
|
|
|
|
#define DIGITAL_RATS_BYTE1 0xE0
|
|
|
|
|
#define DIGITAL_RATS_PARAM 0x80
|
|
|
|
|
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
struct digital_sdd_res {
|
|
|
|
|
u8 nfcid1[4];
|
|
|
|
|
u8 bcc;
|
|
|
|
|
} __packed;
|
|
|
|
|
|
|
|
|
|
struct digital_sel_req {
|
|
|
|
|
u8 sel_cmd;
|
|
|
|
|
u8 b2;
|
|
|
|
|
u8 nfcid1[4];
|
|
|
|
|
u8 bcc;
|
|
|
|
|
} __packed;
|
|
|
|
|
|
2014-04-01 08:36:38 +08:00
|
|
|
struct digital_sensb_req {
|
|
|
|
|
u8 cmd;
|
|
|
|
|
u8 afi;
|
|
|
|
|
u8 param;
|
|
|
|
|
} __packed;
|
|
|
|
|
|
|
|
|
|
struct digital_sensb_res {
|
|
|
|
|
u8 cmd;
|
|
|
|
|
u8 nfcid0[4];
|
|
|
|
|
u8 app_data[4];
|
|
|
|
|
u8 proto_info[3];
|
|
|
|
|
} __packed;
|
|
|
|
|
|
|
|
|
|
struct digital_attrib_req {
|
|
|
|
|
u8 cmd;
|
|
|
|
|
u8 nfcid0[4];
|
|
|
|
|
u8 param1;
|
|
|
|
|
u8 param2;
|
|
|
|
|
u8 param3;
|
|
|
|
|
u8 param4;
|
|
|
|
|
} __packed;
|
|
|
|
|
|
|
|
|
|
struct digital_attrib_res {
|
|
|
|
|
u8 mbli_did;
|
|
|
|
|
} __packed;
|
|
|
|
|
|
2013-09-19 23:55:28 +08:00
|
|
|
struct digital_sensf_req {
|
|
|
|
|
u8 cmd;
|
|
|
|
|
u8 sc1;
|
|
|
|
|
u8 sc2;
|
|
|
|
|
u8 rc;
|
|
|
|
|
u8 tsn;
|
|
|
|
|
} __packed;
|
|
|
|
|
|
|
|
|
|
struct digital_sensf_res {
|
|
|
|
|
u8 cmd;
|
|
|
|
|
u8 nfcid2[8];
|
|
|
|
|
u8 pad0[2];
|
|
|
|
|
u8 pad1[3];
|
|
|
|
|
u8 mrti_check;
|
|
|
|
|
u8 mrti_update;
|
|
|
|
|
u8 pad2;
|
|
|
|
|
u8 rd[2];
|
|
|
|
|
} __packed;
|
|
|
|
|
|
2014-01-22 07:23:59 +08:00
|
|
|
struct digital_iso15693_inv_req {
|
|
|
|
|
u8 flags;
|
|
|
|
|
u8 cmd;
|
|
|
|
|
u8 mask_len;
|
|
|
|
|
u64 mask;
|
|
|
|
|
} __packed;
|
|
|
|
|
|
|
|
|
|
struct digital_iso15693_inv_res {
|
|
|
|
|
u8 flags;
|
|
|
|
|
u8 dsfid;
|
|
|
|
|
u64 uid;
|
|
|
|
|
} __packed;
|
|
|
|
|
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
static int digital_in_send_sdd_req(struct nfc_digital_dev *ddev,
|
|
|
|
|
struct nfc_target *target);
|
|
|
|
|
|
2014-01-27 07:31:32 +08:00
|
|
|
int digital_in_iso_dep_pull_sod(struct nfc_digital_dev *ddev,
|
|
|
|
|
struct sk_buff *skb)
|
|
|
|
|
{
|
|
|
|
|
u8 pcb;
|
|
|
|
|
u8 block_type;
|
|
|
|
|
|
|
|
|
|
if (skb->len < 1)
|
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
|
|
pcb = *skb->data;
|
|
|
|
|
block_type = DIGITAL_ISO_DEP_PCB_TYPE(pcb);
|
|
|
|
|
|
|
|
|
|
/* No support fo R-block nor S-block */
|
|
|
|
|
if (block_type != DIGITAL_ISO_DEP_I_BLOCK) {
|
|
|
|
|
pr_err("ISO_DEP R-block and S-block not supported\n");
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (DIGITAL_ISO_DEP_BLOCK_HAS_DID(pcb)) {
|
|
|
|
|
pr_err("DID field in ISO_DEP PCB not supported\n");
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
skb_pull(skb, 1);
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int digital_in_iso_dep_push_sod(struct nfc_digital_dev *ddev,
|
|
|
|
|
struct sk_buff *skb)
|
|
|
|
|
{
|
|
|
|
|
/*
|
|
|
|
|
* Chaining not supported so skb->len + 1 PCB byte + 2 CRC bytes must
|
|
|
|
|
* not be greater than remote FSC
|
|
|
|
|
*/
|
|
|
|
|
if (skb->len + 3 > ddev->target_fsc)
|
|
|
|
|
return -EIO;
|
|
|
|
|
|
|
|
|
|
skb_push(skb, 1);
|
|
|
|
|
|
|
|
|
|
*skb->data = DIGITAL_ISO_DEP_I_PCB | ddev->curr_nfc_dep_pni;
|
|
|
|
|
|
|
|
|
|
ddev->curr_nfc_dep_pni =
|
|
|
|
|
DIGITAL_ISO_DEP_PNI(ddev->curr_nfc_dep_pni + 1);
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
2014-01-27 07:31:31 +08:00
|
|
|
static void digital_in_recv_ats(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
struct nfc_target *target = arg;
|
|
|
|
|
u8 fsdi;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (resp->len < 2) {
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
fsdi = DIGITAL_ATS_FSCI(resp->data[1]);
|
|
|
|
|
if (fsdi >= 8)
|
|
|
|
|
ddev->target_fsc = DIGITAL_ATS_MAX_FSC;
|
|
|
|
|
else
|
|
|
|
|
ddev->target_fsc = digital_ats_fsc[fsdi];
|
|
|
|
|
|
|
|
|
|
ddev->curr_nfc_dep_pni = 0;
|
|
|
|
|
|
|
|
|
|
rc = digital_target_found(ddev, target, NFC_PROTO_ISO14443);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
kfree(target);
|
|
|
|
|
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int digital_in_send_rats(struct nfc_digital_dev *ddev,
|
|
|
|
|
struct nfc_target *target)
|
|
|
|
|
{
|
|
|
|
|
int rc;
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, 2);
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
networking: add and use skb_put_u8()
Joe and Bjørn suggested that it'd be nicer to not have the
cast in the fairly common case of doing
*(u8 *)skb_put(skb, 1) = c;
Add skb_put_u8() for this case, and use it across the code,
using the following spatch:
@@
expression SKB, C, S;
typedef u8;
identifier fn = {skb_put};
fresh identifier fn2 = fn ## "_u8";
@@
- *(u8 *)fn(SKB, S) = C;
+ fn2(SKB, C);
Note that due to the "S", the spatch isn't perfect, it should
have checked that S is 1, but there's also places that use a
sizeof expression like sizeof(var) or sizeof(u8) etc. Turns
out that nobody ever did something like
*(u8 *)skb_put(skb, 2) = c;
which would be wrong anyway since the second byte wouldn't be
initialized.
Suggested-by: Joe Perches <joe@perches.com>
Suggested-by: Bjørn Mork <bjorn@mork.no>
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:24 +08:00
|
|
|
skb_put_u8(skb, DIGITAL_RATS_BYTE1);
|
|
|
|
|
skb_put_u8(skb, DIGITAL_RATS_PARAM);
|
2014-01-27 07:31:31 +08:00
|
|
|
|
|
|
|
|
rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_ats,
|
|
|
|
|
target);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
static void digital_in_recv_sel_res(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
struct nfc_target *target = arg;
|
|
|
|
|
int rc;
|
|
|
|
|
u8 sel_res;
|
|
|
|
|
u8 nfc_proto;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (!DIGITAL_DRV_CAPS_IN_CRC(ddev)) {
|
|
|
|
|
rc = digital_skb_check_crc_a(resp);
|
|
|
|
|
if (rc) {
|
|
|
|
|
PROTOCOL_ERR("4.4.1.3");
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
2017-06-16 01:46:15 +08:00
|
|
|
if (resp->len != DIGITAL_SEL_RES_LEN) {
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
sel_res = resp->data[0];
|
|
|
|
|
|
|
|
|
|
if (!DIGITAL_SEL_RES_NFCID1_COMPLETE(sel_res)) {
|
|
|
|
|
rc = digital_in_send_sdd_req(ddev, target);
|
|
|
|
|
if (rc)
|
|
|
|
|
goto exit;
|
|
|
|
|
|
|
|
|
|
goto exit_free_skb;
|
|
|
|
|
}
|
|
|
|
|
|
2014-01-27 07:31:31 +08:00
|
|
|
target->sel_res = sel_res;
|
|
|
|
|
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
if (DIGITAL_SEL_RES_IS_T2T(sel_res)) {
|
|
|
|
|
nfc_proto = NFC_PROTO_MIFARE;
|
2014-07-03 00:01:56 +08:00
|
|
|
} else if (DIGITAL_SEL_RES_IS_NFC_DEP(sel_res)) {
|
|
|
|
|
nfc_proto = NFC_PROTO_NFC_DEP;
|
2014-01-27 07:31:31 +08:00
|
|
|
} else if (DIGITAL_SEL_RES_IS_T4T(sel_res)) {
|
|
|
|
|
rc = digital_in_send_rats(ddev, target);
|
|
|
|
|
if (rc)
|
|
|
|
|
goto exit;
|
|
|
|
|
/*
|
|
|
|
|
* Skip target_found and don't free it for now. This will be
|
|
|
|
|
* done when receiving the ATS
|
|
|
|
|
*/
|
|
|
|
|
goto exit_free_skb;
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
} else {
|
|
|
|
|
rc = -EOPNOTSUPP;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rc = digital_target_found(ddev, target, nfc_proto);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
kfree(target);
|
|
|
|
|
|
|
|
|
|
exit_free_skb:
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int digital_in_send_sel_req(struct nfc_digital_dev *ddev,
|
|
|
|
|
struct nfc_target *target,
|
|
|
|
|
struct digital_sdd_res *sdd_res)
|
|
|
|
|
{
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
struct digital_sel_req *sel_req;
|
|
|
|
|
u8 sel_cmd;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, sizeof(struct digital_sel_req));
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
skb_put(skb, sizeof(struct digital_sel_req));
|
|
|
|
|
sel_req = (struct digital_sel_req *)skb->data;
|
|
|
|
|
|
|
|
|
|
if (target->nfcid1_len <= 4)
|
|
|
|
|
sel_cmd = DIGITAL_CMD_SEL_REQ_CL1;
|
|
|
|
|
else if (target->nfcid1_len < 10)
|
|
|
|
|
sel_cmd = DIGITAL_CMD_SEL_REQ_CL2;
|
|
|
|
|
else
|
|
|
|
|
sel_cmd = DIGITAL_CMD_SEL_REQ_CL3;
|
|
|
|
|
|
|
|
|
|
sel_req->sel_cmd = sel_cmd;
|
|
|
|
|
sel_req->b2 = 0x70;
|
|
|
|
|
memcpy(sel_req->nfcid1, sdd_res->nfcid1, 4);
|
|
|
|
|
sel_req->bcc = sdd_res->bcc;
|
|
|
|
|
|
|
|
|
|
if (DIGITAL_DRV_CAPS_IN_CRC(ddev)) {
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCA_STANDARD_WITH_CRC_A);
|
|
|
|
|
if (rc)
|
|
|
|
|
goto exit;
|
|
|
|
|
} else {
|
|
|
|
|
digital_skb_add_crc_a(skb);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sel_res,
|
|
|
|
|
target);
|
|
|
|
|
exit:
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void digital_in_recv_sdd_res(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
struct nfc_target *target = arg;
|
|
|
|
|
struct digital_sdd_res *sdd_res;
|
|
|
|
|
int rc;
|
|
|
|
|
u8 offset, size;
|
|
|
|
|
u8 i, bcc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (resp->len < DIGITAL_SDD_RES_LEN) {
|
|
|
|
|
PROTOCOL_ERR("4.7.2.8");
|
|
|
|
|
rc = -EINVAL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
sdd_res = (struct digital_sdd_res *)resp->data;
|
|
|
|
|
|
|
|
|
|
for (i = 0, bcc = 0; i < 4; i++)
|
|
|
|
|
bcc ^= sdd_res->nfcid1[i];
|
|
|
|
|
|
|
|
|
|
if (bcc != sdd_res->bcc) {
|
|
|
|
|
PROTOCOL_ERR("4.7.2.6");
|
|
|
|
|
rc = -EINVAL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (sdd_res->nfcid1[0] == DIGITAL_SDD_RES_CT) {
|
|
|
|
|
offset = 1;
|
|
|
|
|
size = 3;
|
|
|
|
|
} else {
|
|
|
|
|
offset = 0;
|
|
|
|
|
size = 4;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
memcpy(target->nfcid1 + target->nfcid1_len, sdd_res->nfcid1 + offset,
|
|
|
|
|
size);
|
|
|
|
|
target->nfcid1_len += size;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_send_sel_req(ddev, target, sdd_res);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
|
|
|
|
|
if (rc) {
|
|
|
|
|
kfree(target);
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int digital_in_send_sdd_req(struct nfc_digital_dev *ddev,
|
|
|
|
|
struct nfc_target *target)
|
|
|
|
|
{
|
|
|
|
|
int rc;
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
u8 sel_cmd;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCA_STANDARD);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, 2);
|
2013-09-20 22:56:40 +08:00
|
|
|
if (!skb)
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
if (target->nfcid1_len == 0)
|
|
|
|
|
sel_cmd = DIGITAL_CMD_SEL_REQ_CL1;
|
|
|
|
|
else if (target->nfcid1_len == 3)
|
|
|
|
|
sel_cmd = DIGITAL_CMD_SEL_REQ_CL2;
|
|
|
|
|
else
|
|
|
|
|
sel_cmd = DIGITAL_CMD_SEL_REQ_CL3;
|
|
|
|
|
|
networking: add and use skb_put_u8()
Joe and Bjørn suggested that it'd be nicer to not have the
cast in the fairly common case of doing
*(u8 *)skb_put(skb, 1) = c;
Add skb_put_u8() for this case, and use it across the code,
using the following spatch:
@@
expression SKB, C, S;
typedef u8;
identifier fn = {skb_put};
fresh identifier fn2 = fn ## "_u8";
@@
- *(u8 *)fn(SKB, S) = C;
+ fn2(SKB, C);
Note that due to the "S", the spatch isn't perfect, it should
have checked that S is 1, but there's also places that use a
sizeof expression like sizeof(var) or sizeof(u8) etc. Turns
out that nobody ever did something like
*(u8 *)skb_put(skb, 2) = c;
which would be wrong anyway since the second byte wouldn't be
initialized.
Suggested-by: Joe Perches <joe@perches.com>
Suggested-by: Bjørn Mork <bjorn@mork.no>
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:24 +08:00
|
|
|
skb_put_u8(skb, sel_cmd);
|
|
|
|
|
skb_put_u8(skb, DIGITAL_SDD_REQ_SEL_PAR);
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
|
|
|
|
|
return digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sdd_res,
|
|
|
|
|
target);
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-19 23:55:26 +08:00
|
|
|
static void digital_in_recv_sens_res(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
struct nfc_target *target = NULL;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (resp->len < sizeof(u16)) {
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
target = kzalloc(sizeof(struct nfc_target), GFP_KERNEL);
|
|
|
|
|
if (!target) {
|
|
|
|
|
rc = -ENOMEM;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-24 17:47:34 +08:00
|
|
|
target->sens_res = __le16_to_cpu(*(__le16 *)resp->data);
|
2013-09-19 23:55:26 +08:00
|
|
|
|
2013-09-24 17:47:34 +08:00
|
|
|
if (!DIGITAL_SENS_RES_IS_VALID(target->sens_res)) {
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
PROTOCOL_ERR("4.6.3.3");
|
|
|
|
|
rc = -EINVAL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-24 17:47:34 +08:00
|
|
|
if (DIGITAL_SENS_RES_IS_T1T(target->sens_res))
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
rc = digital_target_found(ddev, target, NFC_PROTO_JEWEL);
|
|
|
|
|
else
|
|
|
|
|
rc = digital_in_send_sdd_req(ddev, target);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
|
|
|
|
|
if (rc) {
|
|
|
|
|
kfree(target);
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
}
|
2013-09-19 23:55:26 +08:00
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int digital_in_send_sens_req(struct nfc_digital_dev *ddev, u8 rf_tech)
|
|
|
|
|
{
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
|
|
|
|
|
NFC_DIGITAL_RF_TECH_106A);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCA_SHORT);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, 1);
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
networking: add and use skb_put_u8()
Joe and Bjørn suggested that it'd be nicer to not have the
cast in the fairly common case of doing
*(u8 *)skb_put(skb, 1) = c;
Add skb_put_u8() for this case, and use it across the code,
using the following spatch:
@@
expression SKB, C, S;
typedef u8;
identifier fn = {skb_put};
fresh identifier fn2 = fn ## "_u8";
@@
- *(u8 *)fn(SKB, S) = C;
+ fn2(SKB, C);
Note that due to the "S", the spatch isn't perfect, it should
have checked that S is 1, but there's also places that use a
sizeof expression like sizeof(var) or sizeof(u8) etc. Turns
out that nobody ever did something like
*(u8 *)skb_put(skb, 2) = c;
which would be wrong anyway since the second byte wouldn't be
initialized.
Suggested-by: Joe Perches <joe@perches.com>
Suggested-by: Bjørn Mork <bjorn@mork.no>
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:24 +08:00
|
|
|
skb_put_u8(skb, DIGITAL_CMD_SENS_REQ);
|
2013-09-19 23:55:26 +08:00
|
|
|
|
|
|
|
|
rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sens_res, NULL);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
NFC Digital: Add NFC-A technology support
This adds support for NFC-A technology at 106 kbits/s. The stack can
detect tags of type 1 and 2. There is no support for collision
detection. Tags can be read and written by using a user space
application or a daemon like neard.
The flow of polling operations for NFC-A detection is as follow:
1 - The digital stack sends the SENS_REQ command to the NFC device.
2 - The NFC device receives a SENS_RES response from a peer device and
passes it to the digital stack.
3 - If the SENS_RES response identifies a type 1 tag, detection ends.
NFC core is notified through nfc_targets_found().
4 - Otherwise, the digital stack sets the cascade level of NFCID1 to
CL1 and sends the SDD_REQ command.
5 - The digital stack selects SEL_CMD and SEL_PAR according to the
cascade level and sends the SDD_REQ command.
4 - The digital stack receives a SDD_RES response for the cascade level
passed in the SDD_REQ command.
5 - The digital stack analyses (part of) NFCID1 and verify BCC.
6 - The digital stack sends the SEL_REQ command with the NFCID1
received in the SDD_RES.
6 - The peer device replies with a SEL_RES response
7 - Detection ends if NFCID1 is complete. NFC core notified of new
target by nfc_targets_found().
8 - If NFCID1 is not complete, the cascade level is incremented (up
to and including CL3) and the execution continues at step 5 to
get the remaining bytes of NFCID1.
Once target detection is done, type 1 and 2 tag commands must be
handled by a user space application (i.e neard) through the NFC core.
Responses for type 1 tag are returned directly to user space via NFC
core.
Responses of type 2 commands are handled differently. The digital stack
doesn't analyse the type of commands sent through im_transceive() and
must differentiate valid responses from error ones.
The response process flow is as follow:
1 - If the response length is 16 bytes, it is a valid response of a
READ command. the packet is returned to the NFC core through the
callback passed to im_transceive(). Processing stops.
2 - If the response is 1 byte long and is a ACK byte (0x0A), it is a
valid response of a WRITE command for example. First packet byte
is set to 0 for no-error and passed back to the NFC core.
Processing stops.
3 - Any other response is treated as an error and -EIO error code is
returned to the NFC core through the response callback.
Moreover, since the driver can't differentiate success response from a
NACK response, the digital stack has to handle CRC calculation.
Thus, this patch also adds support for CRC calculation. If the driver
doesn't handle it, the digital stack will calculate CRC and will add it
to sent frames. CRC will also be checked and removed from received
frames. Pointers to the correct CRC calculation functions are stored in
the digital stack device structure when a target is detected. This
avoids the need to check the current target type for every call to
im_transceive() and for every response received from a peer device.
Signed-off-by: Thierry Escande <thierry.escande@linux.intel.com>
Signed-off-by: Samuel Ortiz <sameo@linux.intel.com>
2013-09-19 23:55:27 +08:00
|
|
|
|
|
|
|
|
int digital_in_recv_mifare_res(struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
/* Successful READ command response is 16 data bytes + 2 CRC bytes long.
|
|
|
|
|
* Since the driver can't differentiate a ACK/NACK response from a valid
|
|
|
|
|
* READ response, the CRC calculation must be handled at digital level
|
|
|
|
|
* even if the driver supports it for this technology.
|
|
|
|
|
*/
|
|
|
|
|
if (resp->len == DIGITAL_MIFARE_READ_RES_LEN + DIGITAL_CRC_LEN) {
|
|
|
|
|
if (digital_skb_check_crc_a(resp)) {
|
|
|
|
|
PROTOCOL_ERR("9.4.1.2");
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* ACK response (i.e. successful WRITE). */
|
|
|
|
|
if (resp->len == 1 && resp->data[0] == DIGITAL_MIFARE_ACK_RES) {
|
|
|
|
|
resp->data[0] = 0;
|
|
|
|
|
return 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* NACK and any other responses are treated as error. */
|
|
|
|
|
return -EIO;
|
|
|
|
|
}
|
2013-09-19 23:55:28 +08:00
|
|
|
|
2014-04-01 08:36:38 +08:00
|
|
|
static void digital_in_recv_attrib_res(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
struct nfc_target *target = arg;
|
|
|
|
|
struct digital_attrib_res *attrib_res;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (resp->len < sizeof(*attrib_res)) {
|
|
|
|
|
PROTOCOL_ERR("12.6.2");
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
attrib_res = (struct digital_attrib_res *)resp->data;
|
|
|
|
|
|
|
|
|
|
if (attrib_res->mbli_did & 0x0f) {
|
|
|
|
|
PROTOCOL_ERR("12.6.2.1");
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rc = digital_target_found(ddev, target, NFC_PROTO_ISO14443_B);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
kfree(target);
|
|
|
|
|
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
}
|
|
|
|
|
|
2014-05-26 06:52:15 +08:00
|
|
|
static int digital_in_send_attrib_req(struct nfc_digital_dev *ddev,
|
2014-04-01 08:36:38 +08:00
|
|
|
struct nfc_target *target,
|
|
|
|
|
struct digital_sensb_res *sensb_res)
|
|
|
|
|
{
|
|
|
|
|
struct digital_attrib_req *attrib_req;
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, sizeof(*attrib_req));
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
networking: make skb_put & friends return void pointers
It seems like a historic accident that these return unsigned char *,
and in many places that means casts are required, more often than not.
Make these functions (skb_put, __skb_put and pskb_put) return void *
and remove all the casts across the tree, adding a (u8 *) cast only
where the unsigned char pointer was used directly, all done with the
following spatch:
@@
expression SKB, LEN;
typedef u8;
identifier fn = { skb_put, __skb_put };
@@
- *(fn(SKB, LEN))
+ *(u8 *)fn(SKB, LEN)
@@
expression E, SKB, LEN;
identifier fn = { skb_put, __skb_put };
type T;
@@
- E = ((T *)(fn(SKB, LEN)))
+ E = fn(SKB, LEN)
which actually doesn't cover pskb_put since there are only three
users overall.
A handful of stragglers were converted manually, notably a macro in
drivers/isdn/i4l/isdn_bsdcomp.c and, oddly enough, one of the many
instances in net/bluetooth/hci_sock.c. In the former file, I also
had to fix one whitespace problem spatch introduced.
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:21 +08:00
|
|
|
attrib_req = skb_put(skb, sizeof(*attrib_req));
|
2014-04-01 08:36:38 +08:00
|
|
|
|
|
|
|
|
attrib_req->cmd = DIGITAL_CMD_ATTRIB_REQ;
|
|
|
|
|
memcpy(attrib_req->nfcid0, sensb_res->nfcid0,
|
|
|
|
|
sizeof(attrib_req->nfcid0));
|
|
|
|
|
attrib_req->param1 = DIGITAL_ATTRIB_P1_TR0_DEFAULT |
|
|
|
|
|
DIGITAL_ATTRIB_P1_TR1_DEFAULT;
|
|
|
|
|
attrib_req->param2 = DIGITAL_ATTRIB_P2_LISTEN_POLL_1 |
|
|
|
|
|
DIGITAL_ATTRIB_P2_POLL_LISTEN_1 |
|
|
|
|
|
DIGITAL_ATTRIB_P2_MAX_FRAME_256;
|
|
|
|
|
attrib_req->param3 = sensb_res->proto_info[1] & 0x07;
|
|
|
|
|
attrib_req->param4 = DIGITAL_ATTRIB_P4_DID(0);
|
|
|
|
|
|
|
|
|
|
rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_attrib_res,
|
|
|
|
|
target);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void digital_in_recv_sensb_res(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
struct nfc_target *target = NULL;
|
|
|
|
|
struct digital_sensb_res *sensb_res;
|
|
|
|
|
u8 fsci;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (resp->len != sizeof(*sensb_res)) {
|
|
|
|
|
PROTOCOL_ERR("5.6.2.1");
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
sensb_res = (struct digital_sensb_res *)resp->data;
|
|
|
|
|
|
|
|
|
|
if (sensb_res->cmd != DIGITAL_CMD_SENSB_RES) {
|
|
|
|
|
PROTOCOL_ERR("5.6.2");
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (!(sensb_res->proto_info[1] & BIT(0))) {
|
|
|
|
|
PROTOCOL_ERR("5.6.2.12");
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (sensb_res->proto_info[1] & BIT(3)) {
|
|
|
|
|
PROTOCOL_ERR("5.6.2.16");
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
fsci = DIGITAL_SENSB_FSCI(sensb_res->proto_info[1]);
|
|
|
|
|
if (fsci >= 8)
|
|
|
|
|
ddev->target_fsc = DIGITAL_ATS_MAX_FSC;
|
|
|
|
|
else
|
|
|
|
|
ddev->target_fsc = digital_ats_fsc[fsci];
|
|
|
|
|
|
|
|
|
|
target = kzalloc(sizeof(struct nfc_target), GFP_KERNEL);
|
|
|
|
|
if (!target) {
|
|
|
|
|
rc = -ENOMEM;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rc = digital_in_send_attrib_req(ddev, target, sensb_res);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
|
|
|
|
|
if (rc) {
|
|
|
|
|
kfree(target);
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int digital_in_send_sensb_req(struct nfc_digital_dev *ddev, u8 rf_tech)
|
|
|
|
|
{
|
|
|
|
|
struct digital_sensb_req *sensb_req;
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
|
|
|
|
|
NFC_DIGITAL_RF_TECH_106B);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCB);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, sizeof(*sensb_req));
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
networking: make skb_put & friends return void pointers
It seems like a historic accident that these return unsigned char *,
and in many places that means casts are required, more often than not.
Make these functions (skb_put, __skb_put and pskb_put) return void *
and remove all the casts across the tree, adding a (u8 *) cast only
where the unsigned char pointer was used directly, all done with the
following spatch:
@@
expression SKB, LEN;
typedef u8;
identifier fn = { skb_put, __skb_put };
@@
- *(fn(SKB, LEN))
+ *(u8 *)fn(SKB, LEN)
@@
expression E, SKB, LEN;
identifier fn = { skb_put, __skb_put };
type T;
@@
- E = ((T *)(fn(SKB, LEN)))
+ E = fn(SKB, LEN)
which actually doesn't cover pskb_put since there are only three
users overall.
A handful of stragglers were converted manually, notably a macro in
drivers/isdn/i4l/isdn_bsdcomp.c and, oddly enough, one of the many
instances in net/bluetooth/hci_sock.c. In the former file, I also
had to fix one whitespace problem spatch introduced.
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:21 +08:00
|
|
|
sensb_req = skb_put(skb, sizeof(*sensb_req));
|
2014-04-01 08:36:38 +08:00
|
|
|
|
|
|
|
|
sensb_req->cmd = DIGITAL_CMD_SENSB_REQ;
|
|
|
|
|
sensb_req->afi = 0x00; /* All families and sub-families */
|
|
|
|
|
sensb_req->param = DIGITAL_SENSB_N(0);
|
|
|
|
|
|
|
|
|
|
rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sensb_res,
|
|
|
|
|
NULL);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-19 23:55:28 +08:00
|
|
|
static void digital_in_recv_sensf_res(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
int rc;
|
2013-09-19 23:55:29 +08:00
|
|
|
u8 proto;
|
2013-09-19 23:55:28 +08:00
|
|
|
struct nfc_target target;
|
|
|
|
|
struct digital_sensf_res *sensf_res;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (resp->len < DIGITAL_SENSF_RES_MIN_LENGTH) {
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (!DIGITAL_DRV_CAPS_IN_CRC(ddev)) {
|
|
|
|
|
rc = digital_skb_check_crc_f(resp);
|
|
|
|
|
if (rc) {
|
|
|
|
|
PROTOCOL_ERR("6.4.1.8");
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
skb_pull(resp, 1);
|
|
|
|
|
|
|
|
|
|
memset(&target, 0, sizeof(struct nfc_target));
|
|
|
|
|
|
|
|
|
|
sensf_res = (struct digital_sensf_res *)resp->data;
|
|
|
|
|
|
|
|
|
|
memcpy(target.sensf_res, sensf_res, resp->len);
|
|
|
|
|
target.sensf_res_len = resp->len;
|
|
|
|
|
|
|
|
|
|
memcpy(target.nfcid2, sensf_res->nfcid2, NFC_NFCID2_MAXSIZE);
|
|
|
|
|
target.nfcid2_len = NFC_NFCID2_MAXSIZE;
|
|
|
|
|
|
2013-09-19 23:55:29 +08:00
|
|
|
if (target.nfcid2[0] == DIGITAL_SENSF_NFCID2_NFC_DEP_B1 &&
|
|
|
|
|
target.nfcid2[1] == DIGITAL_SENSF_NFCID2_NFC_DEP_B2)
|
|
|
|
|
proto = NFC_PROTO_NFC_DEP;
|
|
|
|
|
else
|
|
|
|
|
proto = NFC_PROTO_FELICA;
|
|
|
|
|
|
|
|
|
|
rc = digital_target_found(ddev, &target, proto);
|
2013-09-19 23:55:28 +08:00
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int digital_in_send_sensf_req(struct nfc_digital_dev *ddev, u8 rf_tech)
|
|
|
|
|
{
|
|
|
|
|
struct digital_sensf_req *sensf_req;
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
int rc;
|
|
|
|
|
u8 size;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCF);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
size = sizeof(struct digital_sensf_req);
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, size);
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
skb_put(skb, size);
|
|
|
|
|
|
|
|
|
|
sensf_req = (struct digital_sensf_req *)skb->data;
|
|
|
|
|
sensf_req->cmd = DIGITAL_CMD_SENSF_REQ;
|
|
|
|
|
sensf_req->sc1 = 0xFF;
|
|
|
|
|
sensf_req->sc2 = 0xFF;
|
|
|
|
|
sensf_req->rc = 0;
|
|
|
|
|
sensf_req->tsn = 0;
|
|
|
|
|
|
networking: make skb_push & __skb_push return void pointers
It seems like a historic accident that these return unsigned char *,
and in many places that means casts are required, more often than not.
Make these functions return void * and remove all the casts across
the tree, adding a (u8 *) cast only where the unsigned char pointer
was used directly, all done with the following spatch:
@@
expression SKB, LEN;
typedef u8;
identifier fn = { skb_push, __skb_push, skb_push_rcsum };
@@
- *(fn(SKB, LEN))
+ *(u8 *)fn(SKB, LEN)
@@
expression E, SKB, LEN;
identifier fn = { skb_push, __skb_push, skb_push_rcsum };
type T;
@@
- E = ((T *)(fn(SKB, LEN)))
+ E = fn(SKB, LEN)
@@
expression SKB, LEN;
identifier fn = { skb_push, __skb_push, skb_push_rcsum };
@@
- fn(SKB, LEN)[0]
+ *(u8 *)fn(SKB, LEN)
Note that the last part there converts from push(...)[0] to the
more idiomatic *(u8 *)push(...).
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:23 +08:00
|
|
|
*(u8 *)skb_push(skb, 1) = size + 1;
|
2013-09-19 23:55:28 +08:00
|
|
|
|
|
|
|
|
if (!DIGITAL_DRV_CAPS_IN_CRC(ddev))
|
|
|
|
|
digital_skb_add_crc_f(skb);
|
|
|
|
|
|
|
|
|
|
rc = digital_in_send_cmd(ddev, skb, 30, digital_in_recv_sensf_res,
|
|
|
|
|
NULL);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
2013-09-19 23:55:30 +08:00
|
|
|
|
2014-01-22 07:23:59 +08:00
|
|
|
static void digital_in_recv_iso15693_inv_res(struct nfc_digital_dev *ddev,
|
|
|
|
|
void *arg, struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
struct digital_iso15693_inv_res *res;
|
|
|
|
|
struct nfc_target *target = NULL;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto out_free_skb;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (resp->len != sizeof(*res)) {
|
|
|
|
|
rc = -EIO;
|
|
|
|
|
goto out_free_skb;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
res = (struct digital_iso15693_inv_res *)resp->data;
|
|
|
|
|
|
|
|
|
|
if (!DIGITAL_ISO15693_RES_IS_VALID(res->flags)) {
|
|
|
|
|
PROTOCOL_ERR("ISO15693 - 10.3.1");
|
|
|
|
|
rc = -EINVAL;
|
|
|
|
|
goto out_free_skb;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
target = kzalloc(sizeof(*target), GFP_KERNEL);
|
|
|
|
|
if (!target) {
|
|
|
|
|
rc = -ENOMEM;
|
|
|
|
|
goto out_free_skb;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
target->is_iso15693 = 1;
|
|
|
|
|
target->iso15693_dsfid = res->dsfid;
|
|
|
|
|
memcpy(target->iso15693_uid, &res->uid, sizeof(target->iso15693_uid));
|
|
|
|
|
|
|
|
|
|
rc = digital_target_found(ddev, target, NFC_PROTO_ISO15693);
|
|
|
|
|
|
|
|
|
|
kfree(target);
|
|
|
|
|
|
|
|
|
|
out_free_skb:
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int digital_in_send_iso15693_inv_req(struct nfc_digital_dev *ddev, u8 rf_tech)
|
|
|
|
|
{
|
|
|
|
|
struct digital_iso15693_inv_req *req;
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
|
|
|
|
|
NFC_DIGITAL_RF_TECH_ISO15693);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_ISO15693_INVENTORY);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, sizeof(*req));
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
skb_put(skb, sizeof(*req) - sizeof(req->mask)); /* No mask */
|
|
|
|
|
req = (struct digital_iso15693_inv_req *)skb->data;
|
|
|
|
|
|
|
|
|
|
/* Single sub-carrier, high data rate, no AFI, single slot
|
|
|
|
|
* Inventory command
|
|
|
|
|
*/
|
|
|
|
|
req->flags = DIGITAL_ISO15693_REQ_FLAG_DATA_RATE |
|
|
|
|
|
DIGITAL_ISO15693_REQ_FLAG_INVENTORY |
|
|
|
|
|
DIGITAL_ISO15693_REQ_FLAG_NB_SLOTS;
|
|
|
|
|
req->cmd = DIGITAL_CMD_ISO15693_INVENTORY_REQ;
|
|
|
|
|
req->mask_len = 0;
|
|
|
|
|
|
|
|
|
|
rc = digital_in_send_cmd(ddev, skb, 30,
|
|
|
|
|
digital_in_recv_iso15693_inv_res, NULL);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-19 23:55:30 +08:00
|
|
|
static int digital_tg_send_sel_res(struct nfc_digital_dev *ddev)
|
|
|
|
|
{
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, 1);
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
networking: add and use skb_put_u8()
Joe and Bjørn suggested that it'd be nicer to not have the
cast in the fairly common case of doing
*(u8 *)skb_put(skb, 1) = c;
Add skb_put_u8() for this case, and use it across the code,
using the following spatch:
@@
expression SKB, C, S;
typedef u8;
identifier fn = {skb_put};
fresh identifier fn2 = fn ## "_u8";
@@
- *(u8 *)fn(SKB, S) = C;
+ fn2(SKB, C);
Note that due to the "S", the spatch isn't perfect, it should
have checked that S is 1, but there's also places that use a
sizeof expression like sizeof(var) or sizeof(u8) etc. Turns
out that nobody ever did something like
*(u8 *)skb_put(skb, 2) = c;
which would be wrong anyway since the second byte wouldn't be
initialized.
Suggested-by: Joe Perches <joe@perches.com>
Suggested-by: Bjørn Mork <bjorn@mork.no>
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:24 +08:00
|
|
|
skb_put_u8(skb, DIGITAL_SEL_RES_NFC_DEP);
|
2013-09-19 23:55:30 +08:00
|
|
|
|
|
|
|
|
if (!DIGITAL_DRV_CAPS_TG_CRC(ddev))
|
|
|
|
|
digital_skb_add_crc_a(skb);
|
|
|
|
|
|
2014-07-03 01:16:15 +08:00
|
|
|
rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCA_ANTICOL_COMPLETE);
|
|
|
|
|
if (rc) {
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-19 23:55:30 +08:00
|
|
|
rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_atr_req,
|
|
|
|
|
NULL);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void digital_tg_recv_sel_req(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (!DIGITAL_DRV_CAPS_TG_CRC(ddev)) {
|
|
|
|
|
rc = digital_skb_check_crc_a(resp);
|
|
|
|
|
if (rc) {
|
|
|
|
|
PROTOCOL_ERR("4.4.1.3");
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/* Silently ignore SEL_REQ content and send a SEL_RES for NFC-DEP */
|
|
|
|
|
|
|
|
|
|
rc = digital_tg_send_sel_res(ddev);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int digital_tg_send_sdd_res(struct nfc_digital_dev *ddev)
|
|
|
|
|
{
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
struct digital_sdd_res *sdd_res;
|
|
|
|
|
int rc, i;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, sizeof(struct digital_sdd_res));
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
skb_put(skb, sizeof(struct digital_sdd_res));
|
|
|
|
|
sdd_res = (struct digital_sdd_res *)skb->data;
|
|
|
|
|
|
|
|
|
|
sdd_res->nfcid1[0] = 0x08;
|
|
|
|
|
get_random_bytes(sdd_res->nfcid1 + 1, 3);
|
|
|
|
|
|
|
|
|
|
sdd_res->bcc = 0;
|
|
|
|
|
for (i = 0; i < 4; i++)
|
|
|
|
|
sdd_res->bcc ^= sdd_res->nfcid1[i];
|
|
|
|
|
|
2014-07-03 01:16:15 +08:00
|
|
|
rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCA_STANDARD_WITH_CRC_A);
|
|
|
|
|
if (rc) {
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-19 23:55:30 +08:00
|
|
|
rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_sel_req,
|
|
|
|
|
NULL);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static void digital_tg_recv_sdd_req(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
u8 *sdd_req;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
sdd_req = resp->data;
|
|
|
|
|
|
|
|
|
|
if (resp->len < 2 || sdd_req[0] != DIGITAL_CMD_SEL_REQ_CL1 ||
|
|
|
|
|
sdd_req[1] != DIGITAL_SDD_REQ_SEL_PAR) {
|
|
|
|
|
rc = -EINVAL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rc = digital_tg_send_sdd_res(ddev);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
static int digital_tg_send_sens_res(struct nfc_digital_dev *ddev)
|
|
|
|
|
{
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
u8 *sens_res;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, 2);
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
sens_res = skb_put(skb, 2);
|
|
|
|
|
|
|
|
|
|
sens_res[0] = (DIGITAL_SENS_RES_NFC_DEP >> 8) & 0xFF;
|
|
|
|
|
sens_res[1] = DIGITAL_SENS_RES_NFC_DEP & 0xFF;
|
|
|
|
|
|
2014-07-03 01:16:15 +08:00
|
|
|
rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCA_STANDARD);
|
|
|
|
|
if (rc) {
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-19 23:55:30 +08:00
|
|
|
rc = digital_tg_send_cmd(ddev, skb, 300, digital_tg_recv_sdd_req,
|
|
|
|
|
NULL);
|
|
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void digital_tg_recv_sens_req(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
u8 sens_req;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
sens_req = resp->data[0];
|
|
|
|
|
|
|
|
|
|
if (!resp->len || (sens_req != DIGITAL_CMD_SENS_REQ &&
|
|
|
|
|
sens_req != DIGITAL_CMD_ALL_REQ)) {
|
|
|
|
|
rc = -EINVAL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rc = digital_tg_send_sens_res(ddev);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
}
|
|
|
|
|
|
2014-04-24 02:00:56 +08:00
|
|
|
static void digital_tg_recv_atr_or_sensf_req(struct nfc_digital_dev *ddev,
|
|
|
|
|
void *arg, struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
if (!IS_ERR(resp) && (resp->len >= 2) &&
|
|
|
|
|
(resp->data[1] == DIGITAL_CMD_SENSF_REQ))
|
|
|
|
|
digital_tg_recv_sensf_req(ddev, arg, resp);
|
|
|
|
|
else
|
|
|
|
|
digital_tg_recv_atr_req(ddev, arg, resp);
|
|
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
|
2013-09-20 23:08:08 +08:00
|
|
|
static int digital_tg_send_sensf_res(struct nfc_digital_dev *ddev,
|
2013-09-19 23:55:30 +08:00
|
|
|
struct digital_sensf_req *sensf_req)
|
|
|
|
|
{
|
|
|
|
|
struct sk_buff *skb;
|
|
|
|
|
u8 size;
|
|
|
|
|
int rc;
|
|
|
|
|
struct digital_sensf_res *sensf_res;
|
|
|
|
|
|
|
|
|
|
size = sizeof(struct digital_sensf_res);
|
|
|
|
|
|
2014-04-24 02:00:55 +08:00
|
|
|
if (sensf_req->rc == DIGITAL_SENSF_REQ_RC_NONE)
|
2013-09-19 23:55:30 +08:00
|
|
|
size -= sizeof(sensf_res->rd);
|
|
|
|
|
|
|
|
|
|
skb = digital_skb_alloc(ddev, size);
|
|
|
|
|
if (!skb)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
skb_put(skb, size);
|
|
|
|
|
|
|
|
|
|
sensf_res = (struct digital_sensf_res *)skb->data;
|
|
|
|
|
|
|
|
|
|
memset(sensf_res, 0, size);
|
|
|
|
|
|
|
|
|
|
sensf_res->cmd = DIGITAL_CMD_SENSF_RES;
|
|
|
|
|
sensf_res->nfcid2[0] = DIGITAL_SENSF_NFCID2_NFC_DEP_B1;
|
|
|
|
|
sensf_res->nfcid2[1] = DIGITAL_SENSF_NFCID2_NFC_DEP_B2;
|
|
|
|
|
get_random_bytes(&sensf_res->nfcid2[2], 6);
|
|
|
|
|
|
|
|
|
|
switch (sensf_req->rc) {
|
|
|
|
|
case DIGITAL_SENSF_REQ_RC_SC:
|
|
|
|
|
sensf_res->rd[0] = sensf_req->sc1;
|
|
|
|
|
sensf_res->rd[1] = sensf_req->sc2;
|
|
|
|
|
break;
|
|
|
|
|
case DIGITAL_SENSF_REQ_RC_AP:
|
|
|
|
|
sensf_res->rd[0] = DIGITAL_SENSF_RES_RD_AP_B1;
|
|
|
|
|
sensf_res->rd[1] = DIGITAL_SENSF_RES_RD_AP_B2;
|
|
|
|
|
break;
|
|
|
|
|
}
|
|
|
|
|
|
networking: make skb_push & __skb_push return void pointers
It seems like a historic accident that these return unsigned char *,
and in many places that means casts are required, more often than not.
Make these functions return void * and remove all the casts across
the tree, adding a (u8 *) cast only where the unsigned char pointer
was used directly, all done with the following spatch:
@@
expression SKB, LEN;
typedef u8;
identifier fn = { skb_push, __skb_push, skb_push_rcsum };
@@
- *(fn(SKB, LEN))
+ *(u8 *)fn(SKB, LEN)
@@
expression E, SKB, LEN;
identifier fn = { skb_push, __skb_push, skb_push_rcsum };
type T;
@@
- E = ((T *)(fn(SKB, LEN)))
+ E = fn(SKB, LEN)
@@
expression SKB, LEN;
identifier fn = { skb_push, __skb_push, skb_push_rcsum };
@@
- fn(SKB, LEN)[0]
+ *(u8 *)fn(SKB, LEN)
Note that the last part there converts from push(...)[0] to the
more idiomatic *(u8 *)push(...).
Signed-off-by: Johannes Berg <johannes.berg@intel.com>
Signed-off-by: David S. Miller <davem@davemloft.net>
2017-06-16 20:29:23 +08:00
|
|
|
*(u8 *)skb_push(skb, sizeof(u8)) = size + 1;
|
2013-09-19 23:55:30 +08:00
|
|
|
|
|
|
|
|
if (!DIGITAL_DRV_CAPS_TG_CRC(ddev))
|
|
|
|
|
digital_skb_add_crc_f(skb);
|
|
|
|
|
|
|
|
|
|
rc = digital_tg_send_cmd(ddev, skb, 300,
|
2014-04-24 02:00:56 +08:00
|
|
|
digital_tg_recv_atr_or_sensf_req, NULL);
|
2013-09-19 23:55:30 +08:00
|
|
|
if (rc)
|
|
|
|
|
kfree_skb(skb);
|
|
|
|
|
|
|
|
|
|
return rc;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
void digital_tg_recv_sensf_req(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
struct digital_sensf_req *sensf_req;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
rc = PTR_ERR(resp);
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (!DIGITAL_DRV_CAPS_TG_CRC(ddev)) {
|
|
|
|
|
rc = digital_skb_check_crc_f(resp);
|
|
|
|
|
if (rc) {
|
|
|
|
|
PROTOCOL_ERR("6.4.1.8");
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
if (resp->len != sizeof(struct digital_sensf_req) + 1) {
|
|
|
|
|
rc = -EINVAL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
skb_pull(resp, 1);
|
|
|
|
|
sensf_req = (struct digital_sensf_req *)resp->data;
|
|
|
|
|
|
|
|
|
|
if (sensf_req->cmd != DIGITAL_CMD_SENSF_REQ) {
|
|
|
|
|
rc = -EINVAL;
|
|
|
|
|
goto exit;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rc = digital_tg_send_sensf_res(ddev, sensf_req);
|
|
|
|
|
|
|
|
|
|
exit:
|
|
|
|
|
if (rc)
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
}
|
|
|
|
|
|
2014-07-22 12:24:39 +08:00
|
|
|
static int digital_tg_config_nfca(struct nfc_digital_dev *ddev)
|
2013-09-19 23:55:30 +08:00
|
|
|
{
|
|
|
|
|
int rc;
|
|
|
|
|
|
2014-07-22 12:24:39 +08:00
|
|
|
rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH,
|
|
|
|
|
NFC_DIGITAL_RF_TECH_106A);
|
2013-09-19 23:55:30 +08:00
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
2014-07-22 12:24:39 +08:00
|
|
|
return digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCA_NFC_DEP);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int digital_tg_listen_nfca(struct nfc_digital_dev *ddev, u8 rf_tech)
|
|
|
|
|
{
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_tg_config_nfca(ddev);
|
2013-09-19 23:55:30 +08:00
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
|
|
|
|
return digital_tg_listen(ddev, 300, digital_tg_recv_sens_req, NULL);
|
|
|
|
|
}
|
|
|
|
|
|
2014-07-22 12:24:39 +08:00
|
|
|
static int digital_tg_config_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech)
|
2013-09-19 23:55:30 +08:00
|
|
|
{
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_RF_TECH, rf_tech);
|
|
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
2014-07-22 12:24:39 +08:00
|
|
|
return digital_tg_configure_hw(ddev, NFC_DIGITAL_CONFIG_FRAMING,
|
|
|
|
|
NFC_DIGITAL_FRAMING_NFCF_NFC_DEP);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
int digital_tg_listen_nfcf(struct nfc_digital_dev *ddev, u8 rf_tech)
|
|
|
|
|
{
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
rc = digital_tg_config_nfcf(ddev, rf_tech);
|
2013-09-19 23:55:30 +08:00
|
|
|
if (rc)
|
|
|
|
|
return rc;
|
|
|
|
|
|
2016-06-17 02:24:41 +08:00
|
|
|
return digital_tg_listen(ddev, 300, digital_tg_recv_sensf_req, NULL);
|
2013-09-19 23:55:30 +08:00
|
|
|
}
|
2014-07-22 12:24:39 +08:00
|
|
|
|
|
|
|
|
void digital_tg_recv_md_req(struct nfc_digital_dev *ddev, void *arg,
|
|
|
|
|
struct sk_buff *resp)
|
|
|
|
|
{
|
|
|
|
|
u8 rf_tech;
|
|
|
|
|
int rc;
|
|
|
|
|
|
|
|
|
|
if (IS_ERR(resp)) {
|
|
|
|
|
resp = NULL;
|
|
|
|
|
goto exit_free_skb;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
rc = ddev->ops->tg_get_rf_tech(ddev, &rf_tech);
|
|
|
|
|
if (rc)
|
|
|
|
|
goto exit_free_skb;
|
|
|
|
|
|
|
|
|
|
switch (rf_tech) {
|
|
|
|
|
case NFC_DIGITAL_RF_TECH_106A:
|
|
|
|
|
rc = digital_tg_config_nfca(ddev);
|
|
|
|
|
if (rc)
|
|
|
|
|
goto exit_free_skb;
|
|
|
|
|
digital_tg_recv_sens_req(ddev, arg, resp);
|
|
|
|
|
break;
|
|
|
|
|
case NFC_DIGITAL_RF_TECH_212F:
|
|
|
|
|
case NFC_DIGITAL_RF_TECH_424F:
|
|
|
|
|
rc = digital_tg_config_nfcf(ddev, rf_tech);
|
|
|
|
|
if (rc)
|
|
|
|
|
goto exit_free_skb;
|
|
|
|
|
digital_tg_recv_sensf_req(ddev, arg, resp);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
goto exit_free_skb;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
return;
|
|
|
|
|
|
|
|
|
|
exit_free_skb:
|
|
|
|
|
digital_poll_next_tech(ddev);
|
|
|
|
|
dev_kfree_skb(resp);
|
|
|
|
|
}
|
