blob: d46a700a9637a9152aee5bc5c41b58eacfbe8ec5 [file] [log] [blame]
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001/*
2 * Copyright (C) 2011 Instituto Nokia de Tecnologia
Waldemar Rymarkiewicze70b96e2013-04-03 08:02:01 +02003 * Copyright (C) 2012-2013 Tieto Poland
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03004 *
5 * This program is free software; you can redistribute it and/or modify
6 * it under the terms of the GNU General Public License as published by
7 * the Free Software Foundation; either version 2 of the License, or
8 * (at your option) any later version.
9 *
10 * This program is distributed in the hope that it will be useful,
11 * but WITHOUT ANY WARRANTY; without even the implied warranty of
12 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
13 * GNU General Public License for more details.
14 *
15 * You should have received a copy of the GNU General Public License
Jeff Kirsher98b32de2013-12-06 08:56:16 -080016 * along with this program; if not, see <http://www.gnu.org/licenses/>.
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -030017 */
18
19#include <linux/device.h>
20#include <linux/kernel.h>
21#include <linux/module.h>
22#include <linux/slab.h>
23#include <linux/usb.h>
24#include <linux/nfc.h>
25#include <linux/netdevice.h>
Ilan Elias55eb94f2011-09-18 11:19:34 +030026#include <net/nfc/nfc.h>
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -030027
Waldemar Rymarkiewicz495af722013-04-03 08:02:16 +020028#define VERSION "0.2"
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -030029
30#define PN533_VENDOR_ID 0x4CC
31#define PN533_PRODUCT_ID 0x2533
32
33#define SCM_VENDOR_ID 0x4E6
34#define SCL3711_PRODUCT_ID 0x5591
35
Samuel Ortiz5c7b0532012-07-02 20:04:01 +020036#define SONY_VENDOR_ID 0x054c
37#define PASORI_PRODUCT_ID 0x02e1
38
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +020039#define ACS_VENDOR_ID 0x072f
40#define ACR122U_PRODUCT_ID 0x2200
41
42#define PN533_DEVICE_STD 0x1
43#define PN533_DEVICE_PASORI 0x2
44#define PN533_DEVICE_ACR122U 0x3
Samuel Ortiz5c7b0532012-07-02 20:04:01 +020045
Samuel Ortiz01d719a2012-07-04 00:14:04 +020046#define PN533_ALL_PROTOCOLS (NFC_PROTO_JEWEL_MASK | NFC_PROTO_MIFARE_MASK |\
47 NFC_PROTO_FELICA_MASK | NFC_PROTO_ISO14443_MASK |\
48 NFC_PROTO_NFC_DEP_MASK |\
49 NFC_PROTO_ISO14443_B_MASK)
Samuel Ortiz5c7b0532012-07-02 20:04:01 +020050
51#define PN533_NO_TYPE_B_PROTOCOLS (NFC_PROTO_JEWEL_MASK | \
52 NFC_PROTO_MIFARE_MASK | \
53 NFC_PROTO_FELICA_MASK | \
Samuel Ortiz01d719a2012-07-04 00:14:04 +020054 NFC_PROTO_ISO14443_MASK | \
Samuel Ortiz5c7b0532012-07-02 20:04:01 +020055 NFC_PROTO_NFC_DEP_MASK)
56
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -030057static const struct usb_device_id pn533_table[] = {
Axel Lin99968e02014-02-14 17:40:48 +080058 { USB_DEVICE(PN533_VENDOR_ID, PN533_PRODUCT_ID),
59 .driver_info = PN533_DEVICE_STD },
60 { USB_DEVICE(SCM_VENDOR_ID, SCL3711_PRODUCT_ID),
61 .driver_info = PN533_DEVICE_STD },
62 { USB_DEVICE(SONY_VENDOR_ID, PASORI_PRODUCT_ID),
63 .driver_info = PN533_DEVICE_PASORI },
64 { USB_DEVICE(ACS_VENDOR_ID, ACR122U_PRODUCT_ID),
65 .driver_info = PN533_DEVICE_ACR122U },
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -030066 { }
67};
68MODULE_DEVICE_TABLE(usb, pn533_table);
69
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +020070/* How much time we spend listening for initiators */
71#define PN533_LISTEN_TIME 2
Samuel Ortiz46f793b2013-07-03 14:50:36 +020072/* Delay between each poll frame (ms) */
73#define PN533_POLL_INTERVAL 10
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +020074
Olivier Guiter1575b9d2013-06-13 15:43:27 +020075/* Standard pn533 frame definitions (standard and extended)*/
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +020076#define PN533_STD_FRAME_HEADER_LEN (sizeof(struct pn533_std_frame) \
Waldemar Rymarkiewiczb1bb2902012-11-26 14:18:32 +010077 + 2) /* data[0] TFI, data[1] CC */
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +020078#define PN533_STD_FRAME_TAIL_LEN 2 /* data[len] DCS, data[len + 1] postamble*/
Waldemar Rymarkiewicz82dec342012-10-11 14:03:58 +020079
Olivier Guiter1575b9d2013-06-13 15:43:27 +020080#define PN533_EXT_FRAME_HEADER_LEN (sizeof(struct pn533_ext_frame) \
81 + 2) /* data[0] TFI, data[1] CC */
82
83#define PN533_CMD_DATAEXCH_DATA_MAXLEN 262
84#define PN533_CMD_DATAFRAME_MAXLEN 240 /* max data length (send) */
85
Waldemar Rymarkiewicz15461ae2012-11-26 14:18:35 +010086/*
87 * Max extended frame payload len, excluding TFI and CC
88 * which are already in PN533_FRAME_HEADER_LEN.
89 */
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +020090#define PN533_STD_FRAME_MAX_PAYLOAD_LEN 263
Waldemar Rymarkiewicz15461ae2012-11-26 14:18:35 +010091
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +020092#define PN533_STD_FRAME_ACK_SIZE 6 /* Preamble (1), SoPC (2), ACK Code (2),
Waldemar Rymarkiewicz5b5a4432012-12-10 14:42:56 +010093 Postamble (1) */
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +020094#define PN533_STD_FRAME_CHECKSUM(f) (f->data[f->datalen])
95#define PN533_STD_FRAME_POSTAMBLE(f) (f->data[f->datalen + 1])
Olivier Guiter1575b9d2013-06-13 15:43:27 +020096/* Half start code (3), LEN (4) should be 0xffff for extended frame */
97#define PN533_STD_IS_EXTENDED(hdr) ((hdr)->datalen == 0xFF \
98 && (hdr)->datalen_checksum == 0xFF)
99#define PN533_EXT_FRAME_CHECKSUM(f) (f->data[be16_to_cpu(f->datalen)])
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300100
101/* start of frame */
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200102#define PN533_STD_FRAME_SOF 0x00FF
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300103
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200104/* standard frame identifier: in/out/error */
105#define PN533_STD_FRAME_IDENTIFIER(f) (f->data[0]) /* TFI */
106#define PN533_STD_FRAME_DIR_OUT 0xD4
107#define PN533_STD_FRAME_DIR_IN 0xD5
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300108
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +0200109/* ACS ACR122 pn533 frame definitions */
110#define PN533_ACR122_TX_FRAME_HEADER_LEN (sizeof(struct pn533_acr122_tx_frame) \
111 + 2)
112#define PN533_ACR122_TX_FRAME_TAIL_LEN 0
113#define PN533_ACR122_RX_FRAME_HEADER_LEN (sizeof(struct pn533_acr122_rx_frame) \
114 + 2)
115#define PN533_ACR122_RX_FRAME_TAIL_LEN 2
116#define PN533_ACR122_FRAME_MAX_PAYLOAD_LEN PN533_STD_FRAME_MAX_PAYLOAD_LEN
117
118/* CCID messages types */
119#define PN533_ACR122_PC_TO_RDR_ICCPOWERON 0x62
120#define PN533_ACR122_PC_TO_RDR_ESCAPE 0x6B
121
122#define PN533_ACR122_RDR_TO_PC_ESCAPE 0x83
123
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300124/* PN533 Commands */
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200125#define PN533_FRAME_CMD(f) (f->data[1])
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300126
127#define PN533_CMD_GET_FIRMWARE_VERSION 0x02
128#define PN533_CMD_RF_CONFIGURATION 0x32
129#define PN533_CMD_IN_DATA_EXCHANGE 0x40
Samuel Ortiz5c7b0532012-07-02 20:04:01 +0200130#define PN533_CMD_IN_COMM_THRU 0x42
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300131#define PN533_CMD_IN_LIST_PASSIVE_TARGET 0x4A
132#define PN533_CMD_IN_ATR 0x50
133#define PN533_CMD_IN_RELEASE 0x52
Samuel Ortiz361f3cb2011-12-14 16:43:11 +0100134#define PN533_CMD_IN_JUMP_FOR_DEP 0x56
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300135
Samuel Ortizad3823c2012-05-30 23:54:55 +0200136#define PN533_CMD_TG_INIT_AS_TARGET 0x8c
Samuel Ortiz103b34c2012-05-31 00:07:51 +0200137#define PN533_CMD_TG_GET_DATA 0x86
Samuel Ortizdadb06f2012-05-31 00:09:11 +0200138#define PN533_CMD_TG_SET_DATA 0x8e
Olivier Guiter93ad4202013-09-23 12:24:39 +0200139#define PN533_CMD_TG_SET_META_DATA 0x94
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100140#define PN533_CMD_UNDEF 0xff
Samuel Ortizad3823c2012-05-30 23:54:55 +0200141
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300142#define PN533_CMD_RESPONSE(cmd) (cmd + 1)
143
144/* PN533 Return codes */
145#define PN533_CMD_RET_MASK 0x3F
146#define PN533_CMD_MI_MASK 0x40
147#define PN533_CMD_RET_SUCCESS 0x00
148
149struct pn533;
150
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100151typedef int (*pn533_send_async_complete_t) (struct pn533 *dev, void *arg,
152 struct sk_buff *resp);
153
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300154/* structs for pn533 commands */
155
156/* PN533_CMD_GET_FIRMWARE_VERSION */
157struct pn533_fw_version {
158 u8 ic;
159 u8 ver;
160 u8 rev;
161 u8 support;
162};
163
164/* PN533_CMD_RF_CONFIGURATION */
Samuel Ortiz60d9edd52013-04-11 11:45:41 +0200165#define PN533_CFGITEM_RF_FIELD 0x01
166#define PN533_CFGITEM_TIMING 0x02
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300167#define PN533_CFGITEM_MAX_RETRIES 0x05
Samuel Ortiz60d9edd52013-04-11 11:45:41 +0200168#define PN533_CFGITEM_PASORI 0x82
169
Samuel Ortiz3a8eab32013-07-01 17:26:58 +0200170#define PN533_CFGITEM_RF_FIELD_AUTO_RFCA 0x2
171#define PN533_CFGITEM_RF_FIELD_ON 0x1
172#define PN533_CFGITEM_RF_FIELD_OFF 0x0
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300173
Samuel Ortiz34a85bf2012-05-29 21:34:08 +0200174#define PN533_CONFIG_TIMING_102 0xb
175#define PN533_CONFIG_TIMING_204 0xc
176#define PN533_CONFIG_TIMING_409 0xd
177#define PN533_CONFIG_TIMING_819 0xe
178
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300179#define PN533_CONFIG_MAX_RETRIES_NO_RETRY 0x00
180#define PN533_CONFIG_MAX_RETRIES_ENDLESS 0xFF
181
182struct pn533_config_max_retries {
183 u8 mx_rty_atr;
184 u8 mx_rty_psl;
185 u8 mx_rty_passive_act;
186} __packed;
187
Samuel Ortiz34a85bf2012-05-29 21:34:08 +0200188struct pn533_config_timing {
189 u8 rfu;
190 u8 atr_res_timeout;
191 u8 dep_timeout;
192} __packed;
193
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300194/* PN533_CMD_IN_LIST_PASSIVE_TARGET */
195
196/* felica commands opcode */
197#define PN533_FELICA_OPC_SENSF_REQ 0
198#define PN533_FELICA_OPC_SENSF_RES 1
199/* felica SENSF_REQ parameters */
200#define PN533_FELICA_SENSF_SC_ALL 0xFFFF
201#define PN533_FELICA_SENSF_RC_NO_SYSTEM_CODE 0
202#define PN533_FELICA_SENSF_RC_SYSTEM_CODE 1
203#define PN533_FELICA_SENSF_RC_ADVANCED_PROTOCOL 2
204
205/* type B initiator_data values */
206#define PN533_TYPE_B_AFI_ALL_FAMILIES 0
207#define PN533_TYPE_B_POLL_METHOD_TIMESLOT 0
208#define PN533_TYPE_B_POLL_METHOD_PROBABILISTIC 1
209
210union pn533_cmd_poll_initdata {
211 struct {
212 u8 afi;
213 u8 polling_method;
214 } __packed type_b;
215 struct {
216 u8 opcode;
217 __be16 sc;
218 u8 rc;
219 u8 tsn;
220 } __packed felica;
221};
222
223/* Poll modulations */
224enum {
225 PN533_POLL_MOD_106KBPS_A,
226 PN533_POLL_MOD_212KBPS_FELICA,
227 PN533_POLL_MOD_424KBPS_FELICA,
228 PN533_POLL_MOD_106KBPS_JEWEL,
229 PN533_POLL_MOD_847KBPS_B,
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +0200230 PN533_LISTEN_MOD,
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300231
232 __PN533_POLL_MOD_AFTER_LAST,
233};
234#define PN533_POLL_MOD_MAX (__PN533_POLL_MOD_AFTER_LAST - 1)
235
236struct pn533_poll_modulations {
237 struct {
238 u8 maxtg;
239 u8 brty;
240 union pn533_cmd_poll_initdata initiator_data;
241 } __packed data;
242 u8 len;
243};
244
Waldemar Rymarkiewiczef3d56e2013-01-16 15:51:51 +0100245static const struct pn533_poll_modulations poll_mod[] = {
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300246 [PN533_POLL_MOD_106KBPS_A] = {
247 .data = {
248 .maxtg = 1,
249 .brty = 0,
250 },
251 .len = 2,
252 },
253 [PN533_POLL_MOD_212KBPS_FELICA] = {
254 .data = {
255 .maxtg = 1,
256 .brty = 1,
257 .initiator_data.felica = {
258 .opcode = PN533_FELICA_OPC_SENSF_REQ,
259 .sc = PN533_FELICA_SENSF_SC_ALL,
Samuel Ortiza94e10f2013-06-28 15:43:19 +0200260 .rc = PN533_FELICA_SENSF_RC_SYSTEM_CODE,
Samuel Ortiz31c44462013-05-27 14:59:40 +0200261 .tsn = 0x03,
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300262 },
263 },
264 .len = 7,
265 },
266 [PN533_POLL_MOD_424KBPS_FELICA] = {
267 .data = {
268 .maxtg = 1,
269 .brty = 2,
270 .initiator_data.felica = {
271 .opcode = PN533_FELICA_OPC_SENSF_REQ,
272 .sc = PN533_FELICA_SENSF_SC_ALL,
Samuel Ortiza94e10f2013-06-28 15:43:19 +0200273 .rc = PN533_FELICA_SENSF_RC_SYSTEM_CODE,
Samuel Ortiz31c44462013-05-27 14:59:40 +0200274 .tsn = 0x03,
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300275 },
276 },
277 .len = 7,
278 },
279 [PN533_POLL_MOD_106KBPS_JEWEL] = {
280 .data = {
281 .maxtg = 1,
282 .brty = 4,
283 },
284 .len = 2,
285 },
286 [PN533_POLL_MOD_847KBPS_B] = {
287 .data = {
288 .maxtg = 1,
289 .brty = 8,
290 .initiator_data.type_b = {
291 .afi = PN533_TYPE_B_AFI_ALL_FAMILIES,
292 .polling_method =
293 PN533_TYPE_B_POLL_METHOD_TIMESLOT,
294 },
295 },
296 .len = 3,
297 },
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +0200298 [PN533_LISTEN_MOD] = {
299 .len = 0,
300 },
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300301};
302
303/* PN533_CMD_IN_ATR */
304
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300305struct pn533_cmd_activate_response {
306 u8 status;
307 u8 nfcid3t[10];
308 u8 didt;
309 u8 bst;
310 u8 brt;
311 u8 to;
312 u8 ppt;
313 /* optional */
314 u8 gt[];
315} __packed;
316
Samuel Ortiz361f3cb2011-12-14 16:43:11 +0100317struct pn533_cmd_jump_dep_response {
318 u8 status;
319 u8 tg;
320 u8 nfcid3t[10];
321 u8 didt;
322 u8 bst;
323 u8 brt;
324 u8 to;
325 u8 ppt;
326 /* optional */
327 u8 gt[];
328} __packed;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300329
Samuel Ortizad3823c2012-05-30 23:54:55 +0200330
331/* PN533_TG_INIT_AS_TARGET */
332#define PN533_INIT_TARGET_PASSIVE 0x1
333#define PN533_INIT_TARGET_DEP 0x2
334
Samuel Ortizfc40a8c2012-06-01 13:21:13 +0200335#define PN533_INIT_TARGET_RESP_FRAME_MASK 0x3
336#define PN533_INIT_TARGET_RESP_ACTIVE 0x1
337#define PN533_INIT_TARGET_RESP_DEP 0x4
338
Waldemar Rymarkiewicz58520372013-04-03 08:02:12 +0200339enum pn533_protocol_type {
340 PN533_PROTO_REQ_ACK_RESP = 0,
341 PN533_PROTO_REQ_RESP
342};
343
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300344struct pn533 {
345 struct usb_device *udev;
346 struct usb_interface *interface;
347 struct nfc_dev *nfc_dev;
Waldemar Rymarkiewiczd5590bb2013-04-03 08:02:10 +0200348 u32 device_type;
Waldemar Rymarkiewicz58520372013-04-03 08:02:12 +0200349 enum pn533_protocol_type protocol_type;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300350
351 struct urb *out_urb;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300352 struct urb *in_urb;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300353
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +0200354 struct sk_buff_head resp_q;
Olivier Guiter963a82e2013-06-13 13:43:28 +0000355 struct sk_buff_head fragment_skb;
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +0200356
Samuel Ortiz4849f852012-04-10 19:43:17 +0200357 struct workqueue_struct *wq;
358 struct work_struct cmd_work;
Samuel Ortiz5d50b362012-08-17 23:47:54 +0200359 struct work_struct cmd_complete_work;
Samuel Ortiz46f793b2013-07-03 14:50:36 +0200360 struct delayed_work poll_work;
Olivier Guiter963a82e2013-06-13 13:43:28 +0000361 struct work_struct mi_rx_work;
362 struct work_struct mi_tx_work;
Olivier Guiter3c13b242013-09-23 12:24:38 +0200363 struct work_struct mi_tm_rx_work;
Olivier Guiter93ad4202013-09-23 12:24:39 +0200364 struct work_struct mi_tm_tx_work;
Samuel Ortiz103b34c2012-05-31 00:07:51 +0200365 struct work_struct tg_work;
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +0200366 struct work_struct rf_work;
Waldemar Rymarkiewiczd5590bb2013-04-03 08:02:10 +0200367
368 struct list_head cmd_queue;
369 struct pn533_cmd *cmd;
370 u8 cmd_pending;
Waldemar Rymarkiewiczd5590bb2013-04-03 08:02:10 +0200371 struct mutex cmd_lock; /* protects cmd queue */
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300372
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +0100373 void *cmd_complete_mi_arg;
Olivier Guiter963a82e2013-06-13 13:43:28 +0000374 void *cmd_complete_dep_arg;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300375
376 struct pn533_poll_modulations *poll_mod_active[PN533_POLL_MOD_MAX + 1];
377 u8 poll_mod_count;
378 u8 poll_mod_curr;
Samuel Ortiz673088f2013-08-21 15:06:55 +0200379 u8 poll_dep;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300380 u32 poll_protocols;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +0200381 u32 listen_protocols;
Waldemar Rymarkiewiczd5590bb2013-04-03 08:02:10 +0200382 struct timer_list listen_timer;
383 int cancel_listen;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +0200384
385 u8 *gb;
386 size_t gb_len;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300387
388 u8 tgt_available_prots;
389 u8 tgt_active_prot;
Samuel Ortiz51ad3042012-05-31 20:01:32 +0200390 u8 tgt_mode;
Samuel Ortiz5c7b0532012-07-02 20:04:01 +0200391
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100392 struct pn533_frame_ops *ops;
Samuel Ortiz5d50b362012-08-17 23:47:54 +0200393};
394
395struct pn533_cmd {
396 struct list_head queue;
Waldemar Rymarkiewicz4b2a9532013-04-03 08:02:06 +0200397 u8 code;
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200398 int status;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100399 struct sk_buff *req;
400 struct sk_buff *resp;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100401 int resp_len;
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +0200402 pn533_send_async_complete_t complete_cb;
403 void *complete_cb_context;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300404};
405
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200406struct pn533_std_frame {
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300407 u8 preamble;
408 __be16 start_frame;
409 u8 datalen;
410 u8 datalen_checksum;
411 u8 data[];
412} __packed;
413
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200414struct pn533_ext_frame { /* Extended Information frame */
415 u8 preamble;
416 __be16 start_frame;
417 __be16 eif_flag; /* fixed to 0xFFFF */
418 __be16 datalen;
419 u8 datalen_checksum;
420 u8 data[];
421} __packed;
422
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100423struct pn533_frame_ops {
424 void (*tx_frame_init)(void *frame, u8 cmd_code);
425 void (*tx_frame_finish)(void *frame);
426 void (*tx_update_payload_len)(void *frame, int len);
427 int tx_header_len;
428 int tx_tail_len;
429
Olivier Guiter56a63c822013-06-13 13:43:29 +0000430 bool (*rx_is_frame_valid)(void *frame, struct pn533 *dev);
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100431 int (*rx_frame_size)(void *frame);
432 int rx_header_len;
433 int rx_tail_len;
434
435 int max_payload_len;
436 u8 (*get_cmd_code)(void *frame);
437};
438
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +0200439struct pn533_acr122_ccid_hdr {
440 u8 type;
441 u32 datalen;
442 u8 slot;
443 u8 seq;
444 u8 params[3]; /* 3 msg specific bytes or status, error and 1 specific
445 byte for reposnse msg */
446 u8 data[]; /* payload */
447} __packed;
448
449struct pn533_acr122_apdu_hdr {
450 u8 class;
451 u8 ins;
452 u8 p1;
453 u8 p2;
454} __packed;
455
456struct pn533_acr122_tx_frame {
457 struct pn533_acr122_ccid_hdr ccid;
458 struct pn533_acr122_apdu_hdr apdu;
459 u8 datalen;
460 u8 data[]; /* pn533 frame: TFI ... */
461} __packed;
462
463struct pn533_acr122_rx_frame {
464 struct pn533_acr122_ccid_hdr ccid;
465 u8 data[]; /* pn533 frame : TFI ... */
466} __packed;
467
468static void pn533_acr122_tx_frame_init(void *_frame, u8 cmd_code)
469{
470 struct pn533_acr122_tx_frame *frame = _frame;
471
472 frame->ccid.type = PN533_ACR122_PC_TO_RDR_ESCAPE;
473 frame->ccid.datalen = sizeof(frame->apdu) + 1; /* sizeof(apdu_hdr) +
474 sizeof(datalen) */
475 frame->ccid.slot = 0;
476 frame->ccid.seq = 0;
477 frame->ccid.params[0] = 0;
478 frame->ccid.params[1] = 0;
479 frame->ccid.params[2] = 0;
480
481 frame->data[0] = PN533_STD_FRAME_DIR_OUT;
482 frame->data[1] = cmd_code;
483 frame->datalen = 2; /* data[0] + data[1] */
484
485 frame->apdu.class = 0xFF;
486 frame->apdu.ins = 0;
487 frame->apdu.p1 = 0;
488 frame->apdu.p2 = 0;
489}
490
491static void pn533_acr122_tx_frame_finish(void *_frame)
492{
493 struct pn533_acr122_tx_frame *frame = _frame;
494
495 frame->ccid.datalen += frame->datalen;
496}
497
498static void pn533_acr122_tx_update_payload_len(void *_frame, int len)
499{
500 struct pn533_acr122_tx_frame *frame = _frame;
501
502 frame->datalen += len;
503}
504
Olivier Guiter56a63c822013-06-13 13:43:29 +0000505static bool pn533_acr122_is_rx_frame_valid(void *_frame, struct pn533 *dev)
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +0200506{
507 struct pn533_acr122_rx_frame *frame = _frame;
508
509 if (frame->ccid.type != 0x83)
510 return false;
511
Samuel Ortizea87a5e2014-01-04 03:23:35 +0100512 if (!frame->ccid.datalen)
513 return false;
514
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +0200515 if (frame->data[frame->ccid.datalen - 2] == 0x63)
516 return false;
517
518 return true;
519}
520
521static int pn533_acr122_rx_frame_size(void *frame)
522{
523 struct pn533_acr122_rx_frame *f = frame;
524
525 /* f->ccid.datalen already includes tail length */
526 return sizeof(struct pn533_acr122_rx_frame) + f->ccid.datalen;
527}
528
529static u8 pn533_acr122_get_cmd_code(void *frame)
530{
531 struct pn533_acr122_rx_frame *f = frame;
532
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200533 return PN533_FRAME_CMD(f);
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +0200534}
535
536static struct pn533_frame_ops pn533_acr122_frame_ops = {
537 .tx_frame_init = pn533_acr122_tx_frame_init,
538 .tx_frame_finish = pn533_acr122_tx_frame_finish,
539 .tx_update_payload_len = pn533_acr122_tx_update_payload_len,
540 .tx_header_len = PN533_ACR122_TX_FRAME_HEADER_LEN,
541 .tx_tail_len = PN533_ACR122_TX_FRAME_TAIL_LEN,
542
543 .rx_is_frame_valid = pn533_acr122_is_rx_frame_valid,
544 .rx_header_len = PN533_ACR122_RX_FRAME_HEADER_LEN,
545 .rx_tail_len = PN533_ACR122_RX_FRAME_TAIL_LEN,
546 .rx_frame_size = pn533_acr122_rx_frame_size,
547
548 .max_payload_len = PN533_ACR122_FRAME_MAX_PAYLOAD_LEN,
549 .get_cmd_code = pn533_acr122_get_cmd_code,
550};
551
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200552/* The rule: value(high byte) + value(low byte) + checksum = 0 */
553static inline u8 pn533_ext_checksum(u16 value)
554{
555 return ~(u8)(((value & 0xFF00) >> 8) + (u8)(value & 0xFF)) + 1;
556}
557
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300558/* The rule: value + checksum = 0 */
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200559static inline u8 pn533_std_checksum(u8 value)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300560{
561 return ~value + 1;
562}
563
564/* The rule: sum(data elements) + checksum = 0 */
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200565static u8 pn533_std_data_checksum(u8 *data, int datalen)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300566{
567 u8 sum = 0;
568 int i;
569
570 for (i = 0; i < datalen; i++)
571 sum += data[i];
572
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200573 return pn533_std_checksum(sum);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300574}
575
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200576static void pn533_std_tx_frame_init(void *_frame, u8 cmd_code)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300577{
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200578 struct pn533_std_frame *frame = _frame;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100579
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300580 frame->preamble = 0;
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200581 frame->start_frame = cpu_to_be16(PN533_STD_FRAME_SOF);
582 PN533_STD_FRAME_IDENTIFIER(frame) = PN533_STD_FRAME_DIR_OUT;
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200583 PN533_FRAME_CMD(frame) = cmd_code;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300584 frame->datalen = 2;
585}
586
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200587static void pn533_std_tx_frame_finish(void *_frame)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300588{
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200589 struct pn533_std_frame *frame = _frame;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100590
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200591 frame->datalen_checksum = pn533_std_checksum(frame->datalen);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300592
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200593 PN533_STD_FRAME_CHECKSUM(frame) =
594 pn533_std_data_checksum(frame->data, frame->datalen);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300595
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200596 PN533_STD_FRAME_POSTAMBLE(frame) = 0;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300597}
598
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200599static void pn533_std_tx_update_payload_len(void *_frame, int len)
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100600{
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200601 struct pn533_std_frame *frame = _frame;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100602
603 frame->datalen += len;
604}
605
Olivier Guiter56a63c822013-06-13 13:43:29 +0000606static bool pn533_std_rx_frame_is_valid(void *_frame, struct pn533 *dev)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300607{
608 u8 checksum;
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200609 struct pn533_std_frame *stdf = _frame;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300610
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200611 if (stdf->start_frame != cpu_to_be16(PN533_STD_FRAME_SOF))
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300612 return false;
613
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200614 if (likely(!PN533_STD_IS_EXTENDED(stdf))) {
615 /* Standard frame code */
Olivier Guiter56a63c822013-06-13 13:43:29 +0000616 dev->ops->rx_header_len = PN533_STD_FRAME_HEADER_LEN;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300617
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200618 checksum = pn533_std_checksum(stdf->datalen);
619 if (checksum != stdf->datalen_checksum)
620 return false;
621
622 checksum = pn533_std_data_checksum(stdf->data, stdf->datalen);
623 if (checksum != PN533_STD_FRAME_CHECKSUM(stdf))
624 return false;
625 } else {
626 /* Extended */
627 struct pn533_ext_frame *eif = _frame;
628
Olivier Guiter56a63c822013-06-13 13:43:29 +0000629 dev->ops->rx_header_len = PN533_EXT_FRAME_HEADER_LEN;
630
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200631 checksum = pn533_ext_checksum(be16_to_cpu(eif->datalen));
632 if (checksum != eif->datalen_checksum)
633 return false;
634
635 /* check data checksum */
636 checksum = pn533_std_data_checksum(eif->data,
637 be16_to_cpu(eif->datalen));
638 if (checksum != PN533_EXT_FRAME_CHECKSUM(eif))
639 return false;
640 }
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300641
642 return true;
643}
644
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200645static bool pn533_std_rx_frame_is_ack(struct pn533_std_frame *frame)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300646{
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200647 if (frame->start_frame != cpu_to_be16(PN533_STD_FRAME_SOF))
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300648 return false;
649
650 if (frame->datalen != 0 || frame->datalen_checksum != 0xFF)
651 return false;
652
653 return true;
654}
655
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200656static inline int pn533_std_rx_frame_size(void *frame)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300657{
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200658 struct pn533_std_frame *f = frame;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100659
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200660 /* check for Extended Information frame */
661 if (PN533_STD_IS_EXTENDED(f)) {
662 struct pn533_ext_frame *eif = frame;
663
664 return sizeof(struct pn533_ext_frame)
665 + be16_to_cpu(eif->datalen) + PN533_STD_FRAME_TAIL_LEN;
666 }
667
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200668 return sizeof(struct pn533_std_frame) + f->datalen +
669 PN533_STD_FRAME_TAIL_LEN;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100670}
671
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200672static u8 pn533_std_get_cmd_code(void *frame)
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100673{
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200674 struct pn533_std_frame *f = frame;
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200675 struct pn533_ext_frame *eif = frame;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100676
Olivier Guiter1575b9d2013-06-13 15:43:27 +0200677 if (PN533_STD_IS_EXTENDED(f))
678 return PN533_FRAME_CMD(eif);
679 else
680 return PN533_FRAME_CMD(f);
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100681}
682
Waldemar Rymarkiewiczef3d56e2013-01-16 15:51:51 +0100683static struct pn533_frame_ops pn533_std_frame_ops = {
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200684 .tx_frame_init = pn533_std_tx_frame_init,
685 .tx_frame_finish = pn533_std_tx_frame_finish,
686 .tx_update_payload_len = pn533_std_tx_update_payload_len,
687 .tx_header_len = PN533_STD_FRAME_HEADER_LEN,
688 .tx_tail_len = PN533_STD_FRAME_TAIL_LEN,
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100689
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200690 .rx_is_frame_valid = pn533_std_rx_frame_is_valid,
691 .rx_frame_size = pn533_std_rx_frame_size,
692 .rx_header_len = PN533_STD_FRAME_HEADER_LEN,
693 .rx_tail_len = PN533_STD_FRAME_TAIL_LEN,
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100694
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200695 .max_payload_len = PN533_STD_FRAME_MAX_PAYLOAD_LEN,
696 .get_cmd_code = pn533_std_get_cmd_code,
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100697};
698
699static bool pn533_rx_frame_is_cmd_response(struct pn533 *dev, void *frame)
700{
Waldemar Rymarkiewicz2c206fb2013-04-03 08:02:05 +0200701 return (dev->ops->get_cmd_code(frame) ==
Waldemar Rymarkiewicz4b2a9532013-04-03 08:02:06 +0200702 PN533_CMD_RESPONSE(dev->cmd->code));
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300703}
704
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300705static void pn533_recv_response(struct urb *urb)
706{
707 struct pn533 *dev = urb->context;
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200708 struct pn533_cmd *cmd = dev->cmd;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100709 u8 *in_frame;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300710
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200711 cmd->status = urb->status;
712
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300713 switch (urb->status) {
714 case 0:
Waldemar Rymarkiewiczf8f99172012-12-10 14:42:54 +0100715 break; /* success */
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300716 case -ECONNRESET:
717 case -ENOENT:
Joe Perchesb4834832013-04-05 12:27:37 -0700718 dev_dbg(&dev->interface->dev,
719 "The urb has been canceled (status %d)\n",
720 urb->status);
Samuel Ortiz4849f852012-04-10 19:43:17 +0200721 goto sched_wq;
Waldemar Rymarkiewiczf8f99172012-12-10 14:42:54 +0100722 case -ESHUTDOWN:
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300723 default:
Joe Perches073a6252013-04-05 12:27:38 -0700724 nfc_err(&dev->interface->dev,
725 "Urb failure (status %d)\n", urb->status);
Samuel Ortiz4849f852012-04-10 19:43:17 +0200726 goto sched_wq;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300727 }
728
729 in_frame = dev->in_urb->transfer_buffer;
730
Joe Perchesb4834832013-04-05 12:27:37 -0700731 dev_dbg(&dev->interface->dev, "Received a frame\n");
Samuel Ortize279f842013-03-20 11:27:57 +0100732 print_hex_dump_debug("PN533 RX: ", DUMP_PREFIX_NONE, 16, 1, in_frame,
733 dev->ops->rx_frame_size(in_frame), false);
Waldemar Rymarkiewicz99e591b2012-12-10 14:42:47 +0100734
Olivier Guiter56a63c822013-06-13 13:43:29 +0000735 if (!dev->ops->rx_is_frame_valid(in_frame, dev)) {
Joe Perches073a6252013-04-05 12:27:38 -0700736 nfc_err(&dev->interface->dev, "Received an invalid frame\n");
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200737 cmd->status = -EIO;
Samuel Ortiz4849f852012-04-10 19:43:17 +0200738 goto sched_wq;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300739 }
740
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100741 if (!pn533_rx_frame_is_cmd_response(dev, in_frame)) {
Joe Perches073a6252013-04-05 12:27:38 -0700742 nfc_err(&dev->interface->dev,
743 "It it not the response to the last command\n");
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200744 cmd->status = -EIO;
Samuel Ortiz4849f852012-04-10 19:43:17 +0200745 goto sched_wq;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300746 }
747
Samuel Ortiz4849f852012-04-10 19:43:17 +0200748sched_wq:
Samuel Ortiz5d50b362012-08-17 23:47:54 +0200749 queue_work(dev->wq, &dev->cmd_complete_work);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300750}
751
752static int pn533_submit_urb_for_response(struct pn533 *dev, gfp_t flags)
753{
754 dev->in_urb->complete = pn533_recv_response;
755
756 return usb_submit_urb(dev->in_urb, flags);
757}
758
759static void pn533_recv_ack(struct urb *urb)
760{
761 struct pn533 *dev = urb->context;
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200762 struct pn533_cmd *cmd = dev->cmd;
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200763 struct pn533_std_frame *in_frame;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300764 int rc;
765
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200766 cmd->status = urb->status;
767
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300768 switch (urb->status) {
769 case 0:
Waldemar Rymarkiewiczf8f99172012-12-10 14:42:54 +0100770 break; /* success */
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300771 case -ECONNRESET:
772 case -ENOENT:
Joe Perchesb4834832013-04-05 12:27:37 -0700773 dev_dbg(&dev->interface->dev,
774 "The urb has been stopped (status %d)\n",
775 urb->status);
Samuel Ortiz4849f852012-04-10 19:43:17 +0200776 goto sched_wq;
Waldemar Rymarkiewiczf8f99172012-12-10 14:42:54 +0100777 case -ESHUTDOWN:
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300778 default:
Joe Perches073a6252013-04-05 12:27:38 -0700779 nfc_err(&dev->interface->dev,
780 "Urb failure (status %d)\n", urb->status);
Samuel Ortiz4849f852012-04-10 19:43:17 +0200781 goto sched_wq;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300782 }
783
784 in_frame = dev->in_urb->transfer_buffer;
785
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200786 if (!pn533_std_rx_frame_is_ack(in_frame)) {
Joe Perches073a6252013-04-05 12:27:38 -0700787 nfc_err(&dev->interface->dev, "Received an invalid ack\n");
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200788 cmd->status = -EIO;
Samuel Ortiz4849f852012-04-10 19:43:17 +0200789 goto sched_wq;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300790 }
791
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300792 rc = pn533_submit_urb_for_response(dev, GFP_ATOMIC);
793 if (rc) {
Joe Perches073a6252013-04-05 12:27:38 -0700794 nfc_err(&dev->interface->dev,
795 "usb_submit_urb failed with result %d\n", rc);
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200796 cmd->status = rc;
Samuel Ortiz4849f852012-04-10 19:43:17 +0200797 goto sched_wq;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300798 }
799
800 return;
801
Samuel Ortiz4849f852012-04-10 19:43:17 +0200802sched_wq:
Samuel Ortiz5d50b362012-08-17 23:47:54 +0200803 queue_work(dev->wq, &dev->cmd_complete_work);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300804}
805
806static int pn533_submit_urb_for_ack(struct pn533 *dev, gfp_t flags)
807{
808 dev->in_urb->complete = pn533_recv_ack;
809
810 return usb_submit_urb(dev->in_urb, flags);
811}
812
813static int pn533_send_ack(struct pn533 *dev, gfp_t flags)
814{
Waldemar Rymarkiewicz63123102013-04-03 08:01:58 +0200815 u8 ack[PN533_STD_FRAME_ACK_SIZE] = {0x00, 0x00, 0xff, 0x00, 0xff, 0x00};
Waldemar Rymarkiewicz5b5a4432012-12-10 14:42:56 +0100816 /* spec 7.1.1.3: Preamble, SoPC (2), ACK Code (2), Postamble */
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300817 int rc;
818
Waldemar Rymarkiewicz5b5a4432012-12-10 14:42:56 +0100819 dev->out_urb->transfer_buffer = ack;
820 dev->out_urb->transfer_buffer_length = sizeof(ack);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300821 rc = usb_submit_urb(dev->out_urb, flags);
822
823 return rc;
824}
825
Waldemar Rymarkiewicze8f40532012-12-10 14:42:57 +0100826static int __pn533_send_frame_async(struct pn533 *dev,
827 struct sk_buff *out,
828 struct sk_buff *in,
Waldemar Rymarkiewiczddf19d22013-04-03 08:02:08 +0200829 int in_len)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300830{
831 int rc;
832
Waldemar Rymarkiewicze8f40532012-12-10 14:42:57 +0100833 dev->out_urb->transfer_buffer = out->data;
834 dev->out_urb->transfer_buffer_length = out->len;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300835
Waldemar Rymarkiewicze8f40532012-12-10 14:42:57 +0100836 dev->in_urb->transfer_buffer = in->data;
837 dev->in_urb->transfer_buffer_length = in_len;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300838
Samuel Ortize279f842013-03-20 11:27:57 +0100839 print_hex_dump_debug("PN533 TX: ", DUMP_PREFIX_NONE, 16, 1,
840 out->data, out->len, false);
Waldemar Rymarkiewicz99e591b2012-12-10 14:42:47 +0100841
Waldemar Rymarkiewiczd94ea4f2012-11-26 14:18:33 +0100842 rc = usb_submit_urb(dev->out_urb, GFP_KERNEL);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300843 if (rc)
844 return rc;
845
Waldemar Rymarkiewicz58520372013-04-03 08:02:12 +0200846 if (dev->protocol_type == PN533_PROTO_REQ_RESP) {
847 /* request for response for sent packet directly */
848 rc = pn533_submit_urb_for_response(dev, GFP_ATOMIC);
849 if (rc)
850 goto error;
851 } else if (dev->protocol_type == PN533_PROTO_REQ_ACK_RESP) {
852 /* request for ACK if that's the case */
853 rc = pn533_submit_urb_for_ack(dev, GFP_KERNEL);
854 if (rc)
855 goto error;
856 }
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -0300857
858 return 0;
859
860error:
861 usb_unlink_urb(dev->out_urb);
862 return rc;
863}
864
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100865static void pn533_build_cmd_frame(struct pn533 *dev, u8 cmd_code,
866 struct sk_buff *skb)
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100867{
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100868 /* payload is already there, just update datalen */
869 int payload_len = skb->len;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100870 struct pn533_frame_ops *ops = dev->ops;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100871
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100872
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100873 skb_push(skb, ops->tx_header_len);
874 skb_put(skb, ops->tx_tail_len);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100875
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100876 ops->tx_frame_init(skb->data, cmd_code);
877 ops->tx_update_payload_len(skb->data, payload_len);
878 ops->tx_frame_finish(skb->data);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100879}
880
Waldemar Rymarkiewiczddf19d22013-04-03 08:02:08 +0200881static int pn533_send_async_complete(struct pn533 *dev)
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100882{
Waldemar Rymarkiewiczddf19d22013-04-03 08:02:08 +0200883 struct pn533_cmd *cmd = dev->cmd;
Waldemar Rymarkiewiczf87bc9f2013-04-03 08:02:11 +0200884 int status = cmd->status;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100885
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +0200886 struct sk_buff *req = cmd->req;
887 struct sk_buff *resp = cmd->resp;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100888
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100889 int rc;
890
891 dev_kfree_skb(req);
892
Waldemar Rymarkiewicz0c33d262012-12-10 14:42:59 +0100893 if (status < 0) {
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +0200894 rc = cmd->complete_cb(dev, cmd->complete_cb_context,
895 ERR_PTR(status));
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100896 dev_kfree_skb(resp);
Waldemar Rymarkiewicz2c206fb2013-04-03 08:02:05 +0200897 goto done;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100898 }
899
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100900 skb_put(resp, dev->ops->rx_frame_size(resp->data));
901 skb_pull(resp, dev->ops->rx_header_len);
902 skb_trim(resp, resp->len - dev->ops->rx_tail_len);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100903
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +0200904 rc = cmd->complete_cb(dev, cmd->complete_cb_context, resp);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100905
Waldemar Rymarkiewicz2c206fb2013-04-03 08:02:05 +0200906done:
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +0200907 kfree(cmd);
Waldemar Rymarkiewicz2c206fb2013-04-03 08:02:05 +0200908 dev->cmd = NULL;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100909 return rc;
910}
911
912static int __pn533_send_async(struct pn533 *dev, u8 cmd_code,
913 struct sk_buff *req, struct sk_buff *resp,
914 int resp_len,
915 pn533_send_async_complete_t complete_cb,
916 void *complete_cb_context)
917{
918 struct pn533_cmd *cmd;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100919 int rc = 0;
920
Joe Perchesb4834832013-04-05 12:27:37 -0700921 dev_dbg(&dev->interface->dev, "Sending command 0x%x\n", cmd_code);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100922
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +0200923 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
924 if (!cmd)
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100925 return -ENOMEM;
926
Waldemar Rymarkiewicz4b2a9532013-04-03 08:02:06 +0200927 cmd->code = cmd_code;
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +0200928 cmd->req = req;
929 cmd->resp = resp;
930 cmd->resp_len = resp_len;
931 cmd->complete_cb = complete_cb;
932 cmd->complete_cb_context = complete_cb_context;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100933
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100934 pn533_build_cmd_frame(dev, cmd_code, req);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100935
936 mutex_lock(&dev->cmd_lock);
937
938 if (!dev->cmd_pending) {
Waldemar Rymarkiewiczddf19d22013-04-03 08:02:08 +0200939 rc = __pn533_send_frame_async(dev, req, resp, resp_len);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100940 if (rc)
941 goto error;
942
943 dev->cmd_pending = 1;
Waldemar Rymarkiewicz2c206fb2013-04-03 08:02:05 +0200944 dev->cmd = cmd;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100945 goto unlock;
946 }
947
Joe Perchesb4834832013-04-05 12:27:37 -0700948 dev_dbg(&dev->interface->dev, "%s Queueing command 0x%x\n",
949 __func__, cmd_code);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100950
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100951 INIT_LIST_HEAD(&cmd->queue);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100952 list_add_tail(&cmd->queue, &dev->cmd_queue);
953
954 goto unlock;
955
956error:
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +0200957 kfree(cmd);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100958unlock:
959 mutex_unlock(&dev->cmd_lock);
960 return rc;
961}
962
Waldemar Rymarkiewicz15461ae2012-11-26 14:18:35 +0100963static int pn533_send_data_async(struct pn533 *dev, u8 cmd_code,
964 struct sk_buff *req,
965 pn533_send_async_complete_t complete_cb,
966 void *complete_cb_context)
967{
968 struct sk_buff *resp;
969 int rc;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100970 int resp_len = dev->ops->rx_header_len +
971 dev->ops->max_payload_len +
972 dev->ops->rx_tail_len;
Waldemar Rymarkiewicz15461ae2012-11-26 14:18:35 +0100973
Waldemar Rymarkiewicz15461ae2012-11-26 14:18:35 +0100974 resp = nfc_alloc_recv_skb(resp_len, GFP_KERNEL);
975 if (!resp)
976 return -ENOMEM;
977
978 rc = __pn533_send_async(dev, cmd_code, req, resp, resp_len, complete_cb,
979 complete_cb_context);
980 if (rc)
981 dev_kfree_skb(resp);
982
983 return rc;
984}
985
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100986static int pn533_send_cmd_async(struct pn533 *dev, u8 cmd_code,
987 struct sk_buff *req,
988 pn533_send_async_complete_t complete_cb,
989 void *complete_cb_context)
990{
991 struct sk_buff *resp;
992 int rc;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100993 int resp_len = dev->ops->rx_header_len +
994 dev->ops->max_payload_len +
995 dev->ops->rx_tail_len;
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100996
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +0100997 resp = alloc_skb(resp_len, GFP_KERNEL);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +0100998 if (!resp)
999 return -ENOMEM;
1000
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001001 rc = __pn533_send_async(dev, cmd_code, req, resp, resp_len, complete_cb,
1002 complete_cb_context);
Waldemar Rymarkiewiczaada17a2012-11-26 14:18:34 +01001003 if (rc)
1004 dev_kfree_skb(resp);
1005
1006 return rc;
1007}
1008
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001009/*
1010 * pn533_send_cmd_direct_async
1011 *
1012 * The function sends a piority cmd directly to the chip omiting the cmd
1013 * queue. It's intended to be used by chaining mechanism of received responses
1014 * where the host has to request every single chunk of data before scheduling
1015 * next cmd from the queue.
1016 */
1017static int pn533_send_cmd_direct_async(struct pn533 *dev, u8 cmd_code,
1018 struct sk_buff *req,
1019 pn533_send_async_complete_t complete_cb,
1020 void *complete_cb_context)
1021{
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001022 struct sk_buff *resp;
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +02001023 struct pn533_cmd *cmd;
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001024 int rc;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001025 int resp_len = dev->ops->rx_header_len +
1026 dev->ops->max_payload_len +
1027 dev->ops->rx_tail_len;
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001028
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001029 resp = alloc_skb(resp_len, GFP_KERNEL);
1030 if (!resp)
1031 return -ENOMEM;
1032
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +02001033 cmd = kzalloc(sizeof(*cmd), GFP_KERNEL);
1034 if (!cmd) {
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001035 dev_kfree_skb(resp);
1036 return -ENOMEM;
1037 }
1038
Waldemar Rymarkiewicz4b2a9532013-04-03 08:02:06 +02001039 cmd->code = cmd_code;
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +02001040 cmd->req = req;
1041 cmd->resp = resp;
1042 cmd->resp_len = resp_len;
1043 cmd->complete_cb = complete_cb;
1044 cmd->complete_cb_context = complete_cb_context;
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001045
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001046 pn533_build_cmd_frame(dev, cmd_code, req);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001047
Waldemar Rymarkiewiczddf19d22013-04-03 08:02:08 +02001048 rc = __pn533_send_frame_async(dev, req, resp, resp_len);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001049 if (rc < 0) {
1050 dev_kfree_skb(resp);
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +02001051 kfree(cmd);
Waldemar Rymarkiewicz2c206fb2013-04-03 08:02:05 +02001052 } else {
1053 dev->cmd = cmd;
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01001054 }
1055
1056 return rc;
1057}
1058
Waldemar Rymarkiewiczc79490e2013-04-03 08:02:09 +02001059static void pn533_wq_cmd_complete(struct work_struct *work)
1060{
1061 struct pn533 *dev = container_of(work, struct pn533, cmd_complete_work);
1062 int rc;
1063
1064 rc = pn533_send_async_complete(dev);
1065 if (rc != -EINPROGRESS)
1066 queue_work(dev->wq, &dev->cmd_work);
1067}
1068
Samuel Ortiz5d50b362012-08-17 23:47:54 +02001069static void pn533_wq_cmd(struct work_struct *work)
1070{
1071 struct pn533 *dev = container_of(work, struct pn533, cmd_work);
1072 struct pn533_cmd *cmd;
Waldemar Rymarkiewicz0ce1fbd2013-04-03 08:02:03 +02001073 int rc;
Samuel Ortiz5d50b362012-08-17 23:47:54 +02001074
1075 mutex_lock(&dev->cmd_lock);
1076
1077 if (list_empty(&dev->cmd_queue)) {
1078 dev->cmd_pending = 0;
1079 mutex_unlock(&dev->cmd_lock);
1080 return;
1081 }
1082
1083 cmd = list_first_entry(&dev->cmd_queue, struct pn533_cmd, queue);
1084
Szymon Janc60ad07a2012-10-25 17:29:45 +02001085 list_del(&cmd->queue);
1086
Samuel Ortiz5d50b362012-08-17 23:47:54 +02001087 mutex_unlock(&dev->cmd_lock);
1088
Waldemar Rymarkiewiczddf19d22013-04-03 08:02:08 +02001089 rc = __pn533_send_frame_async(dev, cmd->req, cmd->resp, cmd->resp_len);
Waldemar Rymarkiewicz0ce1fbd2013-04-03 08:02:03 +02001090 if (rc < 0) {
1091 dev_kfree_skb(cmd->req);
1092 dev_kfree_skb(cmd->resp);
Waldemar Rymarkiewicz42316042013-04-03 08:02:04 +02001093 kfree(cmd);
Waldemar Rymarkiewicz2c206fb2013-04-03 08:02:05 +02001094 return;
Waldemar Rymarkiewicz0ce1fbd2013-04-03 08:02:03 +02001095 }
Waldemar Rymarkiewicz2c206fb2013-04-03 08:02:05 +02001096
1097 dev->cmd = cmd;
Samuel Ortiz5d50b362012-08-17 23:47:54 +02001098}
1099
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001100struct pn533_sync_cmd_response {
Waldemar Rymarkiewicz94c5c152012-11-26 14:18:36 +01001101 struct sk_buff *resp;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001102 struct completion done;
1103};
1104
Waldemar Rymarkiewicz94c5c152012-11-26 14:18:36 +01001105static int pn533_send_sync_complete(struct pn533 *dev, void *_arg,
1106 struct sk_buff *resp)
1107{
1108 struct pn533_sync_cmd_response *arg = _arg;
1109
Waldemar Rymarkiewicz94c5c152012-11-26 14:18:36 +01001110 arg->resp = resp;
1111 complete(&arg->done);
1112
1113 return 0;
1114}
1115
1116/* pn533_send_cmd_sync
1117 *
1118 * Please note the req parameter is freed inside the function to
1119 * limit a number of return value interpretations by the caller.
1120 *
1121 * 1. negative in case of error during TX path -> req should be freed
1122 *
1123 * 2. negative in case of error during RX path -> req should not be freed
1124 * as it's been already freed at the begining of RX path by
1125 * async_complete_cb.
1126 *
1127 * 3. valid pointer in case of succesfult RX path
1128 *
1129 * A caller has to check a return value with IS_ERR macro. If the test pass,
1130 * the returned pointer is valid.
1131 *
1132 * */
1133static struct sk_buff *pn533_send_cmd_sync(struct pn533 *dev, u8 cmd_code,
1134 struct sk_buff *req)
1135{
1136 int rc;
1137 struct pn533_sync_cmd_response arg;
1138
Waldemar Rymarkiewicz94c5c152012-11-26 14:18:36 +01001139 init_completion(&arg.done);
1140
1141 rc = pn533_send_cmd_async(dev, cmd_code, req,
1142 pn533_send_sync_complete, &arg);
1143 if (rc) {
1144 dev_kfree_skb(req);
1145 return ERR_PTR(rc);
1146 }
1147
1148 wait_for_completion(&arg.done);
1149
1150 return arg.resp;
1151}
1152
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001153static void pn533_send_complete(struct urb *urb)
1154{
1155 struct pn533 *dev = urb->context;
1156
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001157 switch (urb->status) {
1158 case 0:
Waldemar Rymarkiewiczf8f99172012-12-10 14:42:54 +01001159 break; /* success */
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001160 case -ECONNRESET:
1161 case -ENOENT:
Joe Perchesb4834832013-04-05 12:27:37 -07001162 dev_dbg(&dev->interface->dev,
1163 "The urb has been stopped (status %d)\n",
1164 urb->status);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001165 break;
Waldemar Rymarkiewiczf8f99172012-12-10 14:42:54 +01001166 case -ESHUTDOWN:
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001167 default:
Joe Perches073a6252013-04-05 12:27:38 -07001168 nfc_err(&dev->interface->dev, "Urb failure (status %d)\n",
1169 urb->status);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001170 }
1171}
1172
Waldemar Rymarkiewicz10cff292013-04-03 08:02:14 +02001173static void pn533_abort_cmd(struct pn533 *dev, gfp_t flags)
1174{
1175 /* ACR122U does not support any command which aborts last
1176 * issued command i.e. as ACK for standard PN533. Additionally,
1177 * it behaves stange, sending broken or incorrect responses,
1178 * when we cancel urb before the chip will send response.
1179 */
1180 if (dev->device_type == PN533_DEVICE_ACR122U)
1181 return;
1182
1183 /* An ack will cancel the last issued command */
1184 pn533_send_ack(dev, flags);
1185
1186 /* cancel the urb request */
1187 usb_kill_urb(dev->in_urb);
1188}
1189
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001190static struct sk_buff *pn533_alloc_skb(struct pn533 *dev, unsigned int size)
Waldemar Rymarkiewiczd22b2db2012-11-26 14:18:37 +01001191{
1192 struct sk_buff *skb;
1193
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001194 skb = alloc_skb(dev->ops->tx_header_len +
Waldemar Rymarkiewiczd22b2db2012-11-26 14:18:37 +01001195 size +
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001196 dev->ops->tx_tail_len, GFP_KERNEL);
Waldemar Rymarkiewiczd22b2db2012-11-26 14:18:37 +01001197
1198 if (skb)
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001199 skb_reserve(skb, dev->ops->tx_header_len);
Waldemar Rymarkiewiczd22b2db2012-11-26 14:18:37 +01001200
1201 return skb;
1202}
1203
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001204struct pn533_target_type_a {
1205 __be16 sens_res;
1206 u8 sel_res;
1207 u8 nfcid_len;
1208 u8 nfcid_data[];
1209} __packed;
1210
1211
1212#define PN533_TYPE_A_SENS_RES_NFCID1(x) ((u8)((be16_to_cpu(x) & 0x00C0) >> 6))
1213#define PN533_TYPE_A_SENS_RES_SSD(x) ((u8)((be16_to_cpu(x) & 0x001F) >> 0))
1214#define PN533_TYPE_A_SENS_RES_PLATCONF(x) ((u8)((be16_to_cpu(x) & 0x0F00) >> 8))
1215
1216#define PN533_TYPE_A_SENS_RES_SSD_JEWEL 0x00
1217#define PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL 0x0C
1218
1219#define PN533_TYPE_A_SEL_PROT(x) (((x) & 0x60) >> 5)
1220#define PN533_TYPE_A_SEL_CASCADE(x) (((x) & 0x04) >> 2)
1221
1222#define PN533_TYPE_A_SEL_PROT_MIFARE 0
1223#define PN533_TYPE_A_SEL_PROT_ISO14443 1
1224#define PN533_TYPE_A_SEL_PROT_DEP 2
1225#define PN533_TYPE_A_SEL_PROT_ISO14443_DEP 3
1226
1227static bool pn533_target_type_a_is_valid(struct pn533_target_type_a *type_a,
1228 int target_data_len)
1229{
1230 u8 ssd;
1231 u8 platconf;
1232
1233 if (target_data_len < sizeof(struct pn533_target_type_a))
1234 return false;
1235
1236 /* The lenght check of nfcid[] and ats[] are not being performed because
1237 the values are not being used */
1238
1239 /* Requirement 4.6.3.3 from NFC Forum Digital Spec */
1240 ssd = PN533_TYPE_A_SENS_RES_SSD(type_a->sens_res);
1241 platconf = PN533_TYPE_A_SENS_RES_PLATCONF(type_a->sens_res);
1242
1243 if ((ssd == PN533_TYPE_A_SENS_RES_SSD_JEWEL &&
Waldemar Rymarkiewicz5d467742012-12-10 14:42:51 +01001244 platconf != PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL) ||
1245 (ssd != PN533_TYPE_A_SENS_RES_SSD_JEWEL &&
1246 platconf == PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL))
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001247 return false;
1248
1249 /* Requirements 4.8.2.1, 4.8.2.3, 4.8.2.5 and 4.8.2.7 from NFC Forum */
1250 if (PN533_TYPE_A_SEL_CASCADE(type_a->sel_res) != 0)
1251 return false;
1252
1253 return true;
1254}
1255
1256static int pn533_target_found_type_a(struct nfc_target *nfc_tgt, u8 *tgt_data,
1257 int tgt_data_len)
1258{
1259 struct pn533_target_type_a *tgt_type_a;
1260
Waldemar Rymarkiewicz37cf4fc2012-12-10 14:42:50 +01001261 tgt_type_a = (struct pn533_target_type_a *)tgt_data;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001262
1263 if (!pn533_target_type_a_is_valid(tgt_type_a, tgt_data_len))
1264 return -EPROTO;
1265
1266 switch (PN533_TYPE_A_SEL_PROT(tgt_type_a->sel_res)) {
1267 case PN533_TYPE_A_SEL_PROT_MIFARE:
1268 nfc_tgt->supported_protocols = NFC_PROTO_MIFARE_MASK;
1269 break;
1270 case PN533_TYPE_A_SEL_PROT_ISO14443:
1271 nfc_tgt->supported_protocols = NFC_PROTO_ISO14443_MASK;
1272 break;
1273 case PN533_TYPE_A_SEL_PROT_DEP:
1274 nfc_tgt->supported_protocols = NFC_PROTO_NFC_DEP_MASK;
1275 break;
1276 case PN533_TYPE_A_SEL_PROT_ISO14443_DEP:
1277 nfc_tgt->supported_protocols = NFC_PROTO_ISO14443_MASK |
1278 NFC_PROTO_NFC_DEP_MASK;
1279 break;
1280 }
1281
1282 nfc_tgt->sens_res = be16_to_cpu(tgt_type_a->sens_res);
1283 nfc_tgt->sel_res = tgt_type_a->sel_res;
Samuel Ortizc3b1e1e2012-03-05 01:03:33 +01001284 nfc_tgt->nfcid1_len = tgt_type_a->nfcid_len;
1285 memcpy(nfc_tgt->nfcid1, tgt_type_a->nfcid_data, nfc_tgt->nfcid1_len);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001286
1287 return 0;
1288}
1289
1290struct pn533_target_felica {
1291 u8 pol_res;
1292 u8 opcode;
Samuel Ortiz322bce92013-05-27 15:29:11 +02001293 u8 nfcid2[NFC_NFCID2_MAXSIZE];
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001294 u8 pad[8];
1295 /* optional */
1296 u8 syst_code[];
1297} __packed;
1298
1299#define PN533_FELICA_SENSF_NFCID2_DEP_B1 0x01
1300#define PN533_FELICA_SENSF_NFCID2_DEP_B2 0xFE
1301
1302static bool pn533_target_felica_is_valid(struct pn533_target_felica *felica,
1303 int target_data_len)
1304{
1305 if (target_data_len < sizeof(struct pn533_target_felica))
1306 return false;
1307
1308 if (felica->opcode != PN533_FELICA_OPC_SENSF_RES)
1309 return false;
1310
1311 return true;
1312}
1313
1314static int pn533_target_found_felica(struct nfc_target *nfc_tgt, u8 *tgt_data,
1315 int tgt_data_len)
1316{
1317 struct pn533_target_felica *tgt_felica;
1318
Waldemar Rymarkiewicz37cf4fc2012-12-10 14:42:50 +01001319 tgt_felica = (struct pn533_target_felica *)tgt_data;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001320
1321 if (!pn533_target_felica_is_valid(tgt_felica, tgt_data_len))
1322 return -EPROTO;
1323
Waldemar Rymarkiewicz5d467742012-12-10 14:42:51 +01001324 if ((tgt_felica->nfcid2[0] == PN533_FELICA_SENSF_NFCID2_DEP_B1) &&
1325 (tgt_felica->nfcid2[1] == PN533_FELICA_SENSF_NFCID2_DEP_B2))
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001326 nfc_tgt->supported_protocols = NFC_PROTO_NFC_DEP_MASK;
1327 else
1328 nfc_tgt->supported_protocols = NFC_PROTO_FELICA_MASK;
1329
Samuel Ortiz79757542012-03-05 01:03:45 +01001330 memcpy(nfc_tgt->sensf_res, &tgt_felica->opcode, 9);
1331 nfc_tgt->sensf_res_len = 9;
1332
Samuel Ortiz322bce92013-05-27 15:29:11 +02001333 memcpy(nfc_tgt->nfcid2, tgt_felica->nfcid2, NFC_NFCID2_MAXSIZE);
1334 nfc_tgt->nfcid2_len = NFC_NFCID2_MAXSIZE;
1335
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001336 return 0;
1337}
1338
1339struct pn533_target_jewel {
1340 __be16 sens_res;
1341 u8 jewelid[4];
1342} __packed;
1343
1344static bool pn533_target_jewel_is_valid(struct pn533_target_jewel *jewel,
1345 int target_data_len)
1346{
1347 u8 ssd;
1348 u8 platconf;
1349
1350 if (target_data_len < sizeof(struct pn533_target_jewel))
1351 return false;
1352
1353 /* Requirement 4.6.3.3 from NFC Forum Digital Spec */
1354 ssd = PN533_TYPE_A_SENS_RES_SSD(jewel->sens_res);
1355 platconf = PN533_TYPE_A_SENS_RES_PLATCONF(jewel->sens_res);
1356
1357 if ((ssd == PN533_TYPE_A_SENS_RES_SSD_JEWEL &&
Waldemar Rymarkiewicz5d467742012-12-10 14:42:51 +01001358 platconf != PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL) ||
1359 (ssd != PN533_TYPE_A_SENS_RES_SSD_JEWEL &&
1360 platconf == PN533_TYPE_A_SENS_RES_PLATCONF_JEWEL))
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001361 return false;
1362
1363 return true;
1364}
1365
1366static int pn533_target_found_jewel(struct nfc_target *nfc_tgt, u8 *tgt_data,
1367 int tgt_data_len)
1368{
1369 struct pn533_target_jewel *tgt_jewel;
1370
Waldemar Rymarkiewicz37cf4fc2012-12-10 14:42:50 +01001371 tgt_jewel = (struct pn533_target_jewel *)tgt_data;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001372
1373 if (!pn533_target_jewel_is_valid(tgt_jewel, tgt_data_len))
1374 return -EPROTO;
1375
1376 nfc_tgt->supported_protocols = NFC_PROTO_JEWEL_MASK;
1377 nfc_tgt->sens_res = be16_to_cpu(tgt_jewel->sens_res);
Samuel Ortizd8dc1072012-03-05 01:03:46 +01001378 nfc_tgt->nfcid1_len = 4;
1379 memcpy(nfc_tgt->nfcid1, tgt_jewel->jewelid, nfc_tgt->nfcid1_len);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001380
1381 return 0;
1382}
1383
1384struct pn533_type_b_prot_info {
1385 u8 bitrate;
1386 u8 fsci_type;
1387 u8 fwi_adc_fo;
1388} __packed;
1389
1390#define PN533_TYPE_B_PROT_FCSI(x) (((x) & 0xF0) >> 4)
1391#define PN533_TYPE_B_PROT_TYPE(x) (((x) & 0x0F) >> 0)
1392#define PN533_TYPE_B_PROT_TYPE_RFU_MASK 0x8
1393
1394struct pn533_type_b_sens_res {
1395 u8 opcode;
1396 u8 nfcid[4];
1397 u8 appdata[4];
1398 struct pn533_type_b_prot_info prot_info;
1399} __packed;
1400
1401#define PN533_TYPE_B_OPC_SENSB_RES 0x50
1402
1403struct pn533_target_type_b {
1404 struct pn533_type_b_sens_res sensb_res;
1405 u8 attrib_res_len;
1406 u8 attrib_res[];
1407} __packed;
1408
1409static bool pn533_target_type_b_is_valid(struct pn533_target_type_b *type_b,
1410 int target_data_len)
1411{
1412 if (target_data_len < sizeof(struct pn533_target_type_b))
1413 return false;
1414
1415 if (type_b->sensb_res.opcode != PN533_TYPE_B_OPC_SENSB_RES)
1416 return false;
1417
1418 if (PN533_TYPE_B_PROT_TYPE(type_b->sensb_res.prot_info.fsci_type) &
1419 PN533_TYPE_B_PROT_TYPE_RFU_MASK)
1420 return false;
1421
1422 return true;
1423}
1424
1425static int pn533_target_found_type_b(struct nfc_target *nfc_tgt, u8 *tgt_data,
1426 int tgt_data_len)
1427{
1428 struct pn533_target_type_b *tgt_type_b;
1429
Waldemar Rymarkiewicz37cf4fc2012-12-10 14:42:50 +01001430 tgt_type_b = (struct pn533_target_type_b *)tgt_data;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001431
1432 if (!pn533_target_type_b_is_valid(tgt_type_b, tgt_data_len))
1433 return -EPROTO;
1434
Samuel Ortiz01d719a2012-07-04 00:14:04 +02001435 nfc_tgt->supported_protocols = NFC_PROTO_ISO14443_B_MASK;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001436
1437 return 0;
1438}
1439
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001440static int pn533_target_found(struct pn533 *dev, u8 tg, u8 *tgdata,
1441 int tgdata_len)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001442{
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001443 struct nfc_target nfc_tgt;
1444 int rc;
1445
Joe Perches17936b42013-04-05 12:27:39 -07001446 dev_dbg(&dev->interface->dev, "%s: modulation=%d\n",
Joe Perchesb4834832013-04-05 12:27:37 -07001447 __func__, dev->poll_mod_curr);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001448
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001449 if (tg != 1)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001450 return -EPROTO;
1451
Samuel Ortiz98b3ac12012-03-05 01:03:39 +01001452 memset(&nfc_tgt, 0, sizeof(struct nfc_target));
1453
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001454 switch (dev->poll_mod_curr) {
1455 case PN533_POLL_MOD_106KBPS_A:
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001456 rc = pn533_target_found_type_a(&nfc_tgt, tgdata, tgdata_len);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001457 break;
1458 case PN533_POLL_MOD_212KBPS_FELICA:
1459 case PN533_POLL_MOD_424KBPS_FELICA:
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001460 rc = pn533_target_found_felica(&nfc_tgt, tgdata, tgdata_len);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001461 break;
1462 case PN533_POLL_MOD_106KBPS_JEWEL:
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001463 rc = pn533_target_found_jewel(&nfc_tgt, tgdata, tgdata_len);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001464 break;
1465 case PN533_POLL_MOD_847KBPS_B:
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001466 rc = pn533_target_found_type_b(&nfc_tgt, tgdata, tgdata_len);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001467 break;
1468 default:
Joe Perches073a6252013-04-05 12:27:38 -07001469 nfc_err(&dev->interface->dev,
1470 "Unknown current poll modulation\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001471 return -EPROTO;
1472 }
1473
1474 if (rc)
1475 return rc;
1476
1477 if (!(nfc_tgt.supported_protocols & dev->poll_protocols)) {
Joe Perchesb4834832013-04-05 12:27:37 -07001478 dev_dbg(&dev->interface->dev,
1479 "The Tg found doesn't have the desired protocol\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001480 return -EAGAIN;
1481 }
1482
Joe Perchesb4834832013-04-05 12:27:37 -07001483 dev_dbg(&dev->interface->dev,
1484 "Target found - supported protocols: 0x%x\n",
1485 nfc_tgt.supported_protocols);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001486
1487 dev->tgt_available_prots = nfc_tgt.supported_protocols;
1488
1489 nfc_targets_found(dev->nfc_dev, &nfc_tgt, 1);
1490
1491 return 0;
1492}
1493
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001494static inline void pn533_poll_next_mod(struct pn533 *dev)
1495{
1496 dev->poll_mod_curr = (dev->poll_mod_curr + 1) % dev->poll_mod_count;
1497}
1498
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001499static void pn533_poll_reset_mod_list(struct pn533 *dev)
1500{
1501 dev->poll_mod_count = 0;
1502}
1503
1504static void pn533_poll_add_mod(struct pn533 *dev, u8 mod_index)
1505{
1506 dev->poll_mod_active[dev->poll_mod_count] =
Waldemar Rymarkiewicz37cf4fc2012-12-10 14:42:50 +01001507 (struct pn533_poll_modulations *)&poll_mod[mod_index];
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001508 dev->poll_mod_count++;
1509}
1510
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001511static void pn533_poll_create_mod_list(struct pn533 *dev,
1512 u32 im_protocols, u32 tm_protocols)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001513{
1514 pn533_poll_reset_mod_list(dev);
1515
Waldemar Rymarkiewiczb08e8602012-12-10 14:42:52 +01001516 if ((im_protocols & NFC_PROTO_MIFARE_MASK) ||
1517 (im_protocols & NFC_PROTO_ISO14443_MASK) ||
1518 (im_protocols & NFC_PROTO_NFC_DEP_MASK))
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001519 pn533_poll_add_mod(dev, PN533_POLL_MOD_106KBPS_A);
1520
Waldemar Rymarkiewiczb08e8602012-12-10 14:42:52 +01001521 if (im_protocols & NFC_PROTO_FELICA_MASK ||
1522 im_protocols & NFC_PROTO_NFC_DEP_MASK) {
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001523 pn533_poll_add_mod(dev, PN533_POLL_MOD_212KBPS_FELICA);
1524 pn533_poll_add_mod(dev, PN533_POLL_MOD_424KBPS_FELICA);
1525 }
1526
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001527 if (im_protocols & NFC_PROTO_JEWEL_MASK)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001528 pn533_poll_add_mod(dev, PN533_POLL_MOD_106KBPS_JEWEL);
1529
Samuel Ortiz01d719a2012-07-04 00:14:04 +02001530 if (im_protocols & NFC_PROTO_ISO14443_B_MASK)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001531 pn533_poll_add_mod(dev, PN533_POLL_MOD_847KBPS_B);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001532
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001533 if (tm_protocols)
1534 pn533_poll_add_mod(dev, PN533_LISTEN_MOD);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001535}
1536
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001537static int pn533_start_poll_complete(struct pn533 *dev, struct sk_buff *resp)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001538{
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001539 u8 nbtg, tg, *tgdata;
1540 int rc, tgdata_len;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001541
Samuel Ortiz673088f2013-08-21 15:06:55 +02001542 /* Toggle the DEP polling */
1543 dev->poll_dep = 1;
1544
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001545 nbtg = resp->data[0];
1546 tg = resp->data[1];
1547 tgdata = &resp->data[2];
1548 tgdata_len = resp->len - 2; /* nbtg + tg */
1549
1550 if (nbtg) {
1551 rc = pn533_target_found(dev, tg, tgdata, tgdata_len);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001552
1553 /* We must stop the poll after a valid target found */
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001554 if (rc == 0) {
1555 pn533_poll_reset_mod_list(dev);
1556 return 0;
1557 }
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001558 }
1559
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001560 return -EAGAIN;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03001561}
1562
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001563static struct sk_buff *pn533_alloc_poll_tg_frame(struct pn533 *dev)
Samuel Ortizad3823c2012-05-30 23:54:55 +02001564{
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001565 struct sk_buff *skb;
1566 u8 *felica, *nfcid3, *gb;
1567
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001568 u8 *gbytes = dev->gb;
1569 size_t gbytes_len = dev->gb_len;
1570
Samuel Ortiz51d9e802012-05-30 01:48:46 +02001571 u8 felica_params[18] = {0x1, 0xfe, /* DEP */
1572 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, /* random */
1573 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0, 0x0,
1574 0xff, 0xff}; /* System code */
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001575
Samuel Ortiz51d9e802012-05-30 01:48:46 +02001576 u8 mifare_params[6] = {0x1, 0x1, /* SENS_RES */
1577 0x0, 0x0, 0x0,
1578 0x40}; /* SEL_RES for DEP */
Samuel Ortizad3823c2012-05-30 23:54:55 +02001579
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001580 unsigned int skb_len = 36 + /* mode (1), mifare (6),
1581 felica (18), nfcid3 (10), gb_len (1) */
1582 gbytes_len +
1583 1; /* len Tk*/
Samuel Ortizad3823c2012-05-30 23:54:55 +02001584
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001585 skb = pn533_alloc_skb(dev, skb_len);
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001586 if (!skb)
1587 return NULL;
Samuel Ortizad3823c2012-05-30 23:54:55 +02001588
1589 /* DEP support only */
Thierry Escande52f2eae2013-02-05 10:08:35 +01001590 *skb_put(skb, 1) = PN533_INIT_TARGET_DEP;
Samuel Ortiz51d9e802012-05-30 01:48:46 +02001591
1592 /* MIFARE params */
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001593 memcpy(skb_put(skb, 6), mifare_params, 6);
1594
1595 /* Felica params */
1596 felica = skb_put(skb, 18);
1597 memcpy(felica, felica_params, 18);
1598 get_random_bytes(felica + 2, 6);
1599
1600 /* NFCID3 */
1601 nfcid3 = skb_put(skb, 10);
1602 memset(nfcid3, 0, 10);
1603 memcpy(nfcid3, felica, 8);
Samuel Ortiz51d9e802012-05-30 01:48:46 +02001604
1605 /* General bytes */
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001606 *skb_put(skb, 1) = gbytes_len;
1607
1608 gb = skb_put(skb, gbytes_len);
1609 memcpy(gb, gbytes, gbytes_len);
Samuel Ortiz51d9e802012-05-30 01:48:46 +02001610
Samuel Ortizad3823c2012-05-30 23:54:55 +02001611 /* Len Tk */
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001612 *skb_put(skb, 1) = 0;
Samuel Ortizad3823c2012-05-30 23:54:55 +02001613
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001614 return skb;
Samuel Ortizad3823c2012-05-30 23:54:55 +02001615}
1616
Waldemar Rymarkiewiczb1bb2902012-11-26 14:18:32 +01001617#define PN533_CMD_DATAEXCH_HEAD_LEN 1
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001618#define PN533_CMD_DATAEXCH_DATA_MAXLEN 262
Olivier Guiter3c13b242013-09-23 12:24:38 +02001619static void pn533_wq_tm_mi_recv(struct work_struct *work);
1620static struct sk_buff *pn533_build_response(struct pn533 *dev);
1621
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001622static int pn533_tm_get_data_complete(struct pn533 *dev, void *arg,
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01001623 struct sk_buff *resp)
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001624{
Olivier Guiter3c13b242013-09-23 12:24:38 +02001625 struct sk_buff *skb;
1626 u8 status, ret, mi;
1627 int rc;
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001628
Joe Perchesb4834832013-04-05 12:27:37 -07001629 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001630
Olivier Guiter3c13b242013-09-23 12:24:38 +02001631 if (IS_ERR(resp)) {
1632 skb_queue_purge(&dev->resp_q);
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01001633 return PTR_ERR(resp);
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001634 }
1635
Olivier Guiter3c13b242013-09-23 12:24:38 +02001636 status = resp->data[0];
1637
1638 ret = status & PN533_CMD_RET_MASK;
1639 mi = status & PN533_CMD_MI_MASK;
1640
1641 skb_pull(resp, sizeof(status));
1642
1643 if (ret != PN533_CMD_RET_SUCCESS) {
1644 rc = -EIO;
1645 goto error;
1646 }
1647
1648 skb_queue_tail(&dev->resp_q, resp);
1649
1650 if (mi) {
1651 queue_work(dev->wq, &dev->mi_tm_rx_work);
1652 return -EINPROGRESS;
1653 }
1654
1655 skb = pn533_build_response(dev);
1656 if (!skb) {
1657 rc = -EIO;
1658 goto error;
1659 }
1660
1661 return nfc_tm_data_received(dev->nfc_dev, skb);
1662
1663error:
1664 nfc_tm_deactivated(dev->nfc_dev);
1665 dev->tgt_mode = 0;
1666 skb_queue_purge(&dev->resp_q);
1667 dev_kfree_skb(resp);
1668
1669 return rc;
1670}
1671
1672static void pn533_wq_tm_mi_recv(struct work_struct *work)
1673{
1674 struct pn533 *dev = container_of(work, struct pn533, mi_tm_rx_work);
1675 struct sk_buff *skb;
1676 int rc;
1677
1678 dev_dbg(&dev->interface->dev, "%s\n", __func__);
1679
1680 skb = pn533_alloc_skb(dev, 0);
1681 if (!skb)
1682 return;
1683
1684 rc = pn533_send_cmd_direct_async(dev,
1685 PN533_CMD_TG_GET_DATA,
1686 skb,
1687 pn533_tm_get_data_complete,
1688 NULL);
1689
1690 if (rc < 0)
1691 dev_kfree_skb(skb);
1692
1693 return;
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001694}
1695
Olivier Guiter93ad4202013-09-23 12:24:39 +02001696static int pn533_tm_send_complete(struct pn533 *dev, void *arg,
1697 struct sk_buff *resp);
1698static void pn533_wq_tm_mi_send(struct work_struct *work)
1699{
1700 struct pn533 *dev = container_of(work, struct pn533, mi_tm_tx_work);
1701 struct sk_buff *skb;
1702 int rc;
1703
1704 dev_dbg(&dev->interface->dev, "%s\n", __func__);
1705
1706 /* Grab the first skb in the queue */
1707 skb = skb_dequeue(&dev->fragment_skb);
1708 if (skb == NULL) { /* No more data */
1709 /* Reset the queue for future use */
1710 skb_queue_head_init(&dev->fragment_skb);
1711 goto error;
1712 }
1713
1714 /* last entry - remove MI bit */
1715 if (skb_queue_len(&dev->fragment_skb) == 0) {
1716 rc = pn533_send_cmd_direct_async(dev, PN533_CMD_TG_SET_DATA,
1717 skb, pn533_tm_send_complete, NULL);
1718 } else
1719 rc = pn533_send_cmd_direct_async(dev,
1720 PN533_CMD_TG_SET_META_DATA,
1721 skb, pn533_tm_send_complete, NULL);
1722
1723 if (rc == 0) /* success */
1724 return;
1725
1726 dev_err(&dev->interface->dev,
1727 "Error %d when trying to perform set meta data_exchange", rc);
1728
1729 dev_kfree_skb(skb);
1730
1731error:
1732 pn533_send_ack(dev, GFP_KERNEL);
1733 queue_work(dev->wq, &dev->cmd_work);
1734}
1735
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001736static void pn533_wq_tg_get_data(struct work_struct *work)
1737{
1738 struct pn533 *dev = container_of(work, struct pn533, tg_work);
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01001739 struct sk_buff *skb;
1740 int rc;
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001741
Joe Perchesb4834832013-04-05 12:27:37 -07001742 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001743
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01001744 skb = pn533_alloc_skb(dev, 0);
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01001745 if (!skb)
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001746 return;
1747
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01001748 rc = pn533_send_data_async(dev, PN533_CMD_TG_GET_DATA, skb,
1749 pn533_tm_get_data_complete, NULL);
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001750
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01001751 if (rc < 0)
1752 dev_kfree_skb(skb);
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001753
1754 return;
1755}
1756
Samuel Ortizfc40a8c2012-06-01 13:21:13 +02001757#define ATR_REQ_GB_OFFSET 17
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001758static int pn533_init_target_complete(struct pn533 *dev, struct sk_buff *resp)
Samuel Ortizad3823c2012-05-30 23:54:55 +02001759{
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001760 u8 mode, *cmd, comm_mode = NFC_COMM_PASSIVE, *gb;
Samuel Ortizfc40a8c2012-06-01 13:21:13 +02001761 size_t gb_len;
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001762 int rc;
Samuel Ortizad3823c2012-05-30 23:54:55 +02001763
Joe Perchesb4834832013-04-05 12:27:37 -07001764 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortizad3823c2012-05-30 23:54:55 +02001765
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001766 if (resp->len < ATR_REQ_GB_OFFSET + 1)
Samuel Ortizfc40a8c2012-06-01 13:21:13 +02001767 return -EINVAL;
1768
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001769 mode = resp->data[0];
1770 cmd = &resp->data[1];
Samuel Ortizad3823c2012-05-30 23:54:55 +02001771
Joe Perchesb4834832013-04-05 12:27:37 -07001772 dev_dbg(&dev->interface->dev, "Target mode 0x%x len %d\n",
1773 mode, resp->len);
Samuel Ortizad3823c2012-05-30 23:54:55 +02001774
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001775 if ((mode & PN533_INIT_TARGET_RESP_FRAME_MASK) ==
1776 PN533_INIT_TARGET_RESP_ACTIVE)
Samuel Ortizfc40a8c2012-06-01 13:21:13 +02001777 comm_mode = NFC_COMM_ACTIVE;
1778
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001779 if ((mode & PN533_INIT_TARGET_RESP_DEP) == 0) /* Only DEP supported */
Samuel Ortizfc40a8c2012-06-01 13:21:13 +02001780 return -EOPNOTSUPP;
1781
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001782 gb = cmd + ATR_REQ_GB_OFFSET;
1783 gb_len = resp->len - (ATR_REQ_GB_OFFSET + 1);
Samuel Ortizfc40a8c2012-06-01 13:21:13 +02001784
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001785 rc = nfc_tm_activated(dev->nfc_dev, NFC_PROTO_NFC_DEP_MASK,
1786 comm_mode, gb, gb_len);
1787 if (rc < 0) {
Joe Perches073a6252013-04-05 12:27:38 -07001788 nfc_err(&dev->interface->dev,
1789 "Error when signaling target activation\n");
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001790 return rc;
1791 }
1792
Samuel Ortiz51ad3042012-05-31 20:01:32 +02001793 dev->tgt_mode = 1;
Samuel Ortiz103b34c2012-05-31 00:07:51 +02001794 queue_work(dev->wq, &dev->tg_work);
1795
1796 return 0;
Samuel Ortizad3823c2012-05-30 23:54:55 +02001797}
1798
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001799static void pn533_listen_mode_timer(unsigned long data)
Samuel Ortizfe7c5802012-05-15 15:57:06 +02001800{
Waldemar Rymarkiewicz37cf4fc2012-12-10 14:42:50 +01001801 struct pn533 *dev = (struct pn533 *)data;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001802
Joe Perchesb4834832013-04-05 12:27:37 -07001803 dev_dbg(&dev->interface->dev, "Listen mode timeout\n");
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001804
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001805 dev->cancel_listen = 1;
1806
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001807 pn533_poll_next_mod(dev);
1808
Samuel Ortiz46f793b2013-07-03 14:50:36 +02001809 queue_delayed_work(dev->wq, &dev->poll_work,
1810 msecs_to_jiffies(PN533_POLL_INTERVAL));
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001811}
1812
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02001813static int pn533_rf_complete(struct pn533 *dev, void *arg,
1814 struct sk_buff *resp)
1815{
1816 int rc = 0;
1817
Joe Perchesb4834832013-04-05 12:27:37 -07001818 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02001819
1820 if (IS_ERR(resp)) {
1821 rc = PTR_ERR(resp);
1822
Joe Perches073a6252013-04-05 12:27:38 -07001823 nfc_err(&dev->interface->dev, "RF setting error %d", rc);
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02001824
1825 return rc;
1826 }
1827
Samuel Ortiz46f793b2013-07-03 14:50:36 +02001828 queue_delayed_work(dev->wq, &dev->poll_work,
1829 msecs_to_jiffies(PN533_POLL_INTERVAL));
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02001830
1831 dev_kfree_skb(resp);
1832 return rc;
1833}
1834
1835static void pn533_wq_rf(struct work_struct *work)
1836{
1837 struct pn533 *dev = container_of(work, struct pn533, rf_work);
1838 struct sk_buff *skb;
1839 int rc;
1840
Joe Perchesb4834832013-04-05 12:27:37 -07001841 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02001842
1843 skb = pn533_alloc_skb(dev, 2);
1844 if (!skb)
1845 return;
1846
1847 *skb_put(skb, 1) = PN533_CFGITEM_RF_FIELD;
Samuel Ortiz3a8eab32013-07-01 17:26:58 +02001848 *skb_put(skb, 1) = PN533_CFGITEM_RF_FIELD_AUTO_RFCA;
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02001849
1850 rc = pn533_send_cmd_async(dev, PN533_CMD_RF_CONFIGURATION, skb,
1851 pn533_rf_complete, NULL);
1852 if (rc < 0) {
1853 dev_kfree_skb(skb);
Joe Perches073a6252013-04-05 12:27:38 -07001854 nfc_err(&dev->interface->dev, "RF setting error %d\n", rc);
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02001855 }
1856
1857 return;
1858}
1859
Samuel Ortiz673088f2013-08-21 15:06:55 +02001860static int pn533_poll_dep_complete(struct pn533 *dev, void *arg,
1861 struct sk_buff *resp)
1862{
1863 struct pn533_cmd_jump_dep_response *rsp;
1864 struct nfc_target nfc_target;
1865 u8 target_gt_len;
1866 int rc;
1867
1868 if (IS_ERR(resp))
1869 return PTR_ERR(resp);
1870
1871 rsp = (struct pn533_cmd_jump_dep_response *)resp->data;
1872
1873 rc = rsp->status & PN533_CMD_RET_MASK;
1874 if (rc != PN533_CMD_RET_SUCCESS) {
1875 /* Not target found, turn radio off */
1876 queue_work(dev->wq, &dev->rf_work);
1877
1878 dev_kfree_skb(resp);
1879 return 0;
1880 }
1881
1882 dev_dbg(&dev->interface->dev, "Creating new target");
1883
1884 nfc_target.supported_protocols = NFC_PROTO_NFC_DEP_MASK;
1885 nfc_target.nfcid1_len = 10;
1886 memcpy(nfc_target.nfcid1, rsp->nfcid3t, nfc_target.nfcid1_len);
1887 rc = nfc_targets_found(dev->nfc_dev, &nfc_target, 1);
1888 if (rc)
1889 goto error;
1890
1891 dev->tgt_available_prots = 0;
1892 dev->tgt_active_prot = NFC_PROTO_NFC_DEP;
1893
1894 /* ATR_RES general bytes are located at offset 17 */
1895 target_gt_len = resp->len - 17;
1896 rc = nfc_set_remote_general_bytes(dev->nfc_dev,
1897 rsp->gt, target_gt_len);
1898 if (!rc) {
1899 rc = nfc_dep_link_is_up(dev->nfc_dev,
1900 dev->nfc_dev->targets[0].idx,
1901 0, NFC_RF_INITIATOR);
1902
1903 if (!rc)
1904 pn533_poll_reset_mod_list(dev);
1905 }
1906error:
1907 dev_kfree_skb(resp);
1908 return rc;
1909}
1910
1911#define PASSIVE_DATA_LEN 5
1912static int pn533_poll_dep(struct nfc_dev *nfc_dev)
1913{
1914 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
1915 struct sk_buff *skb;
1916 int rc, skb_len;
1917 u8 *next, nfcid3[NFC_NFCID3_MAXSIZE];
1918 u8 passive_data[PASSIVE_DATA_LEN] = {0x00, 0xff, 0xff, 0x00, 0x3};
1919
1920 dev_dbg(&dev->interface->dev, "%s", __func__);
1921
1922 if (!dev->gb) {
1923 dev->gb = nfc_get_local_general_bytes(nfc_dev, &dev->gb_len);
1924
1925 if (!dev->gb || !dev->gb_len) {
1926 dev->poll_dep = 0;
1927 queue_work(dev->wq, &dev->rf_work);
1928 }
1929 }
1930
1931 skb_len = 3 + dev->gb_len; /* ActPass + BR + Next */
1932 skb_len += PASSIVE_DATA_LEN;
1933
1934 /* NFCID3 */
1935 skb_len += NFC_NFCID3_MAXSIZE;
1936 nfcid3[0] = 0x1;
1937 nfcid3[1] = 0xfe;
1938 get_random_bytes(nfcid3 + 2, 6);
1939
1940 skb = pn533_alloc_skb(dev, skb_len);
1941 if (!skb)
1942 return -ENOMEM;
1943
1944 *skb_put(skb, 1) = 0x01; /* Active */
1945 *skb_put(skb, 1) = 0x02; /* 424 kbps */
1946
1947 next = skb_put(skb, 1); /* Next */
1948 *next = 0;
1949
1950 /* Copy passive data */
1951 memcpy(skb_put(skb, PASSIVE_DATA_LEN), passive_data, PASSIVE_DATA_LEN);
1952 *next |= 1;
1953
1954 /* Copy NFCID3 (which is NFCID2 from SENSF_RES) */
1955 memcpy(skb_put(skb, NFC_NFCID3_MAXSIZE), nfcid3,
1956 NFC_NFCID3_MAXSIZE);
1957 *next |= 2;
1958
1959 memcpy(skb_put(skb, dev->gb_len), dev->gb, dev->gb_len);
1960 *next |= 4; /* We have some Gi */
1961
1962 rc = pn533_send_cmd_async(dev, PN533_CMD_IN_JUMP_FOR_DEP, skb,
1963 pn533_poll_dep_complete, NULL);
1964
1965 if (rc < 0)
1966 dev_kfree_skb(skb);
1967
1968 return rc;
1969}
1970
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001971static int pn533_poll_complete(struct pn533 *dev, void *arg,
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001972 struct sk_buff *resp)
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001973{
1974 struct pn533_poll_modulations *cur_mod;
Samuel Ortizad3823c2012-05-30 23:54:55 +02001975 int rc;
1976
Joe Perchesb4834832013-04-05 12:27:37 -07001977 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001978
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001979 if (IS_ERR(resp)) {
1980 rc = PTR_ERR(resp);
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001981
Joe Perches073a6252013-04-05 12:27:38 -07001982 nfc_err(&dev->interface->dev, "%s Poll complete error %d\n",
1983 __func__, rc);
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001984
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001985 if (rc == -ENOENT) {
1986 if (dev->poll_mod_count != 0)
1987 return rc;
1988 else
1989 goto stop_poll;
1990 } else if (rc < 0) {
Joe Perches073a6252013-04-05 12:27:38 -07001991 nfc_err(&dev->interface->dev,
1992 "Error %d when running poll\n", rc);
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001993 goto stop_poll;
1994 }
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02001995 }
1996
1997 cur_mod = dev->poll_mod_active[dev->poll_mod_curr];
1998
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01001999 if (cur_mod->len == 0) { /* Target mode */
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002000 del_timer(&dev->listen_timer);
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002001 rc = pn533_init_target_complete(dev, resp);
2002 goto done;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002003 }
2004
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002005 /* Initiator mode */
2006 rc = pn533_start_poll_complete(dev, resp);
2007 if (!rc)
2008 goto done;
2009
Waldemar Rymarkiewicz95cb9e12013-04-03 08:02:00 +02002010 if (!dev->poll_mod_count) {
Joe Perchesb4834832013-04-05 12:27:37 -07002011 dev_dbg(&dev->interface->dev, "Polling has been stopped\n");
Waldemar Rymarkiewicz95cb9e12013-04-03 08:02:00 +02002012 goto done;
2013 }
2014
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002015 pn533_poll_next_mod(dev);
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02002016 /* Not target found, turn radio off */
2017 queue_work(dev->wq, &dev->rf_work);
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002018
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002019done:
2020 dev_kfree_skb(resp);
2021 return rc;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002022
2023stop_poll:
Joe Perches073a6252013-04-05 12:27:38 -07002024 nfc_err(&dev->interface->dev, "Polling operation has been stopped\n");
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002025
Samuel Ortizad3823c2012-05-30 23:54:55 +02002026 pn533_poll_reset_mod_list(dev);
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002027 dev->poll_protocols = 0;
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002028 return rc;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002029}
Samuel Ortizad3823c2012-05-30 23:54:55 +02002030
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002031static struct sk_buff *pn533_alloc_poll_in_frame(struct pn533 *dev,
2032 struct pn533_poll_modulations *mod)
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002033{
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002034 struct sk_buff *skb;
Samuel Ortizad3823c2012-05-30 23:54:55 +02002035
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002036 skb = pn533_alloc_skb(dev, mod->len);
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002037 if (!skb)
2038 return NULL;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002039
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002040 memcpy(skb_put(skb, mod->len), &mod->data, mod->len);
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002041
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002042 return skb;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002043}
2044
2045static int pn533_send_poll_frame(struct pn533 *dev)
2046{
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002047 struct pn533_poll_modulations *mod;
2048 struct sk_buff *skb;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002049 int rc;
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002050 u8 cmd_code;
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002051
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002052 mod = dev->poll_mod_active[dev->poll_mod_curr];
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002053
Joe Perchesb4834832013-04-05 12:27:37 -07002054 dev_dbg(&dev->interface->dev, "%s mod len %d\n",
2055 __func__, mod->len);
Samuel Ortizad3823c2012-05-30 23:54:55 +02002056
Samuel Ortiz673088f2013-08-21 15:06:55 +02002057 if (dev->poll_dep) {
2058 dev->poll_dep = 0;
2059 return pn533_poll_dep(dev->nfc_dev);
2060 }
2061
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002062 if (mod->len == 0) { /* Listen mode */
2063 cmd_code = PN533_CMD_TG_INIT_AS_TARGET;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002064 skb = pn533_alloc_poll_tg_frame(dev);
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002065 } else { /* Polling mode */
2066 cmd_code = PN533_CMD_IN_LIST_PASSIVE_TARGET;
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002067 skb = pn533_alloc_poll_in_frame(dev, mod);
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002068 }
2069
2070 if (!skb) {
Joe Perches073a6252013-04-05 12:27:38 -07002071 nfc_err(&dev->interface->dev, "Failed to allocate skb\n");
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002072 return -ENOMEM;
2073 }
2074
2075 rc = pn533_send_cmd_async(dev, cmd_code, skb, pn533_poll_complete,
2076 NULL);
2077 if (rc < 0) {
2078 dev_kfree_skb(skb);
Joe Perches073a6252013-04-05 12:27:38 -07002079 nfc_err(&dev->interface->dev, "Polling loop error %d\n", rc);
Waldemar Rymarkiewiczb5193e52012-12-10 14:42:48 +01002080 }
Samuel Ortizad3823c2012-05-30 23:54:55 +02002081
2082 return rc;
Samuel Ortizfe7c5802012-05-15 15:57:06 +02002083}
2084
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002085static void pn533_wq_poll(struct work_struct *work)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002086{
Samuel Ortiz46f793b2013-07-03 14:50:36 +02002087 struct pn533 *dev = container_of(work, struct pn533, poll_work.work);
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002088 struct pn533_poll_modulations *cur_mod;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002089 int rc;
2090
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002091 cur_mod = dev->poll_mod_active[dev->poll_mod_curr];
2092
Joe Perchesb4834832013-04-05 12:27:37 -07002093 dev_dbg(&dev->interface->dev,
2094 "%s cancel_listen %d modulation len %d\n",
2095 __func__, dev->cancel_listen, cur_mod->len);
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002096
2097 if (dev->cancel_listen == 1) {
2098 dev->cancel_listen = 0;
Waldemar Rymarkiewicz10cff292013-04-03 08:02:14 +02002099 pn533_abort_cmd(dev, GFP_ATOMIC);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002100 }
2101
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002102 rc = pn533_send_poll_frame(dev);
2103 if (rc)
2104 return;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002105
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002106 if (cur_mod->len == 0 && dev->poll_mod_count > 1)
2107 mod_timer(&dev->listen_timer, jiffies + PN533_LISTEN_TIME * HZ);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002108
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002109 return;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002110}
2111
Samuel Ortizfe7c5802012-05-15 15:57:06 +02002112static int pn533_start_poll(struct nfc_dev *nfc_dev,
2113 u32 im_protocols, u32 tm_protocols)
2114{
2115 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
Samuel Ortizcec4b8e2013-08-21 15:12:06 +02002116 struct pn533_poll_modulations *cur_mod;
Samuel Ortizdfccd0f2013-07-03 15:14:17 +02002117 u8 rand_mod;
Samuel Ortizcec4b8e2013-08-21 15:12:06 +02002118 int rc;
Samuel Ortizfe7c5802012-05-15 15:57:06 +02002119
Joe Perchesb4834832013-04-05 12:27:37 -07002120 dev_dbg(&dev->interface->dev,
2121 "%s: im protocols 0x%x tm protocols 0x%x\n",
2122 __func__, im_protocols, tm_protocols);
Samuel Ortizfe7c5802012-05-15 15:57:06 +02002123
2124 if (dev->tgt_active_prot) {
Joe Perches073a6252013-04-05 12:27:38 -07002125 nfc_err(&dev->interface->dev,
2126 "Cannot poll with a target already activated\n");
Samuel Ortizfe7c5802012-05-15 15:57:06 +02002127 return -EBUSY;
2128 }
2129
Samuel Ortiz51ad3042012-05-31 20:01:32 +02002130 if (dev->tgt_mode) {
Joe Perches073a6252013-04-05 12:27:38 -07002131 nfc_err(&dev->interface->dev,
2132 "Cannot poll while already being activated\n");
Samuel Ortiz51ad3042012-05-31 20:01:32 +02002133 return -EBUSY;
2134 }
2135
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002136 if (tm_protocols) {
2137 dev->gb = nfc_get_local_general_bytes(nfc_dev, &dev->gb_len);
2138 if (dev->gb == NULL)
2139 tm_protocols = 0;
2140 }
Samuel Ortizad3823c2012-05-30 23:54:55 +02002141
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002142 pn533_poll_create_mod_list(dev, im_protocols, tm_protocols);
2143 dev->poll_protocols = im_protocols;
2144 dev->listen_protocols = tm_protocols;
Samuel Ortizad3823c2012-05-30 23:54:55 +02002145
Samuel Ortizdfccd0f2013-07-03 15:14:17 +02002146 /* Do not always start polling from the same modulation */
2147 get_random_bytes(&rand_mod, sizeof(rand_mod));
2148 rand_mod %= dev->poll_mod_count;
2149 dev->poll_mod_curr = rand_mod;
2150
Samuel Ortizcec4b8e2013-08-21 15:12:06 +02002151 cur_mod = dev->poll_mod_active[dev->poll_mod_curr];
2152
2153 rc = pn533_send_poll_frame(dev);
2154
2155 /* Start listen timer */
2156 if (!rc && cur_mod->len == 0 && dev->poll_mod_count > 1)
2157 mod_timer(&dev->listen_timer, jiffies + PN533_LISTEN_TIME * HZ);
2158
2159 return rc;
Samuel Ortizfe7c5802012-05-15 15:57:06 +02002160}
2161
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002162static void pn533_stop_poll(struct nfc_dev *nfc_dev)
2163{
2164 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
2165
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002166 del_timer(&dev->listen_timer);
2167
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002168 if (!dev->poll_mod_count) {
Joe Perchesb4834832013-04-05 12:27:37 -07002169 dev_dbg(&dev->interface->dev,
2170 "Polling operation was not running\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002171 return;
2172 }
2173
Waldemar Rymarkiewicz10cff292013-04-03 08:02:14 +02002174 pn533_abort_cmd(dev, GFP_KERNEL);
Samuel Ortiz46f793b2013-07-03 14:50:36 +02002175 flush_delayed_work(&dev->poll_work);
Samuel Ortiz7c2a04a932012-05-21 16:20:01 +02002176 pn533_poll_reset_mod_list(dev);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002177}
2178
2179static int pn533_activate_target_nfcdep(struct pn533 *dev)
2180{
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002181 struct pn533_cmd_activate_response *rsp;
Samuel Ortiz541d9202011-12-14 16:43:10 +01002182 u16 gt_len;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002183 int rc;
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002184 struct sk_buff *skb;
2185 struct sk_buff *resp;
2186
Joe Perchesb4834832013-04-05 12:27:37 -07002187 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002188
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002189 skb = pn533_alloc_skb(dev, sizeof(u8) * 2); /*TG + Next*/
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002190 if (!skb)
2191 return -ENOMEM;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002192
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002193 *skb_put(skb, sizeof(u8)) = 1; /* TG */
2194 *skb_put(skb, sizeof(u8)) = 0; /* Next */
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002195
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002196 resp = pn533_send_cmd_sync(dev, PN533_CMD_IN_ATR, skb);
2197 if (IS_ERR(resp))
2198 return PTR_ERR(resp);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002199
Waldemar Rymarkiewicz37cf4fc2012-12-10 14:42:50 +01002200 rsp = (struct pn533_cmd_activate_response *)resp->data;
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002201 rc = rsp->status & PN533_CMD_RET_MASK;
Waldemar Rymarkiewicz8a0ecfe2012-12-21 10:39:01 +01002202 if (rc != PN533_CMD_RET_SUCCESS) {
Joe Perches073a6252013-04-05 12:27:38 -07002203 nfc_err(&dev->interface->dev,
2204 "Target activation failed (error 0x%x)\n", rc);
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002205 dev_kfree_skb(resp);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002206 return -EIO;
Waldemar Rymarkiewicz8a0ecfe2012-12-21 10:39:01 +01002207 }
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002208
Samuel Ortiz541d9202011-12-14 16:43:10 +01002209 /* ATR_RES general bytes are located at offset 16 */
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002210 gt_len = resp->len - 16;
2211 rc = nfc_set_remote_general_bytes(dev->nfc_dev, rsp->gt, gt_len);
Samuel Ortiz541d9202011-12-14 16:43:10 +01002212
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002213 dev_kfree_skb(resp);
Samuel Ortiz541d9202011-12-14 16:43:10 +01002214 return rc;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002215}
2216
Eric Lapuyade90099432012-05-07 12:31:13 +02002217static int pn533_activate_target(struct nfc_dev *nfc_dev,
2218 struct nfc_target *target, u32 protocol)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002219{
2220 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
2221 int rc;
2222
Joe Perches17936b42013-04-05 12:27:39 -07002223 dev_dbg(&dev->interface->dev, "%s: protocol=%u\n", __func__, protocol);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002224
2225 if (dev->poll_mod_count) {
Joe Perches073a6252013-04-05 12:27:38 -07002226 nfc_err(&dev->interface->dev,
Joe Perchesb4834832013-04-05 12:27:37 -07002227 "Cannot activate while polling\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002228 return -EBUSY;
2229 }
2230
2231 if (dev->tgt_active_prot) {
Joe Perches073a6252013-04-05 12:27:38 -07002232 nfc_err(&dev->interface->dev,
2233 "There is already an active target\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002234 return -EBUSY;
2235 }
2236
2237 if (!dev->tgt_available_prots) {
Joe Perches073a6252013-04-05 12:27:38 -07002238 nfc_err(&dev->interface->dev,
2239 "There is no available target to activate\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002240 return -EINVAL;
2241 }
2242
2243 if (!(dev->tgt_available_prots & (1 << protocol))) {
Joe Perches073a6252013-04-05 12:27:38 -07002244 nfc_err(&dev->interface->dev,
2245 "Target doesn't support requested proto %u\n",
2246 protocol);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002247 return -EINVAL;
2248 }
2249
2250 if (protocol == NFC_PROTO_NFC_DEP) {
2251 rc = pn533_activate_target_nfcdep(dev);
2252 if (rc) {
Joe Perches073a6252013-04-05 12:27:38 -07002253 nfc_err(&dev->interface->dev,
2254 "Activating target with DEP failed %d\n", rc);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002255 return rc;
2256 }
2257 }
2258
2259 dev->tgt_active_prot = protocol;
2260 dev->tgt_available_prots = 0;
2261
2262 return 0;
2263}
2264
Eric Lapuyade90099432012-05-07 12:31:13 +02002265static void pn533_deactivate_target(struct nfc_dev *nfc_dev,
2266 struct nfc_target *target)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002267{
2268 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002269 struct sk_buff *skb;
2270 struct sk_buff *resp;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002271 int rc;
2272
Joe Perchesb4834832013-04-05 12:27:37 -07002273 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002274
2275 if (!dev->tgt_active_prot) {
Joe Perches073a6252013-04-05 12:27:38 -07002276 nfc_err(&dev->interface->dev, "There is no active target\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002277 return;
2278 }
2279
2280 dev->tgt_active_prot = 0;
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002281 skb_queue_purge(&dev->resp_q);
2282
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002283 skb = pn533_alloc_skb(dev, sizeof(u8));
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002284 if (!skb)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002285 return;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002286
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002287 *skb_put(skb, 1) = 1; /* TG*/
2288
2289 resp = pn533_send_cmd_sync(dev, PN533_CMD_IN_RELEASE, skb);
2290 if (IS_ERR(resp))
2291 return;
2292
2293 rc = resp->data[0] & PN533_CMD_RET_MASK;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002294 if (rc != PN533_CMD_RET_SUCCESS)
Joe Perches073a6252013-04-05 12:27:38 -07002295 nfc_err(&dev->interface->dev,
2296 "Error 0x%x when releasing the target\n", rc);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002297
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002298 dev_kfree_skb(resp);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002299 return;
2300}
2301
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002302
2303static int pn533_in_dep_link_up_complete(struct pn533 *dev, void *arg,
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002304 struct sk_buff *resp)
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002305{
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002306 struct pn533_cmd_jump_dep_response *rsp;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002307 u8 target_gt_len;
2308 int rc;
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002309 u8 active = *(u8 *)arg;
Waldemar Rymarkiewicz70418e62012-10-11 14:04:00 +02002310
2311 kfree(arg);
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002312
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002313 if (IS_ERR(resp))
2314 return PTR_ERR(resp);
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002315
2316 if (dev->tgt_available_prots &&
2317 !(dev->tgt_available_prots & (1 << NFC_PROTO_NFC_DEP))) {
Joe Perches073a6252013-04-05 12:27:38 -07002318 nfc_err(&dev->interface->dev,
2319 "The target does not support DEP\n");
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002320 rc = -EINVAL;
2321 goto error;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002322 }
2323
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002324 rsp = (struct pn533_cmd_jump_dep_response *)resp->data;
2325
2326 rc = rsp->status & PN533_CMD_RET_MASK;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002327 if (rc != PN533_CMD_RET_SUCCESS) {
Joe Perches073a6252013-04-05 12:27:38 -07002328 nfc_err(&dev->interface->dev,
2329 "Bringing DEP link up failed (error 0x%x)\n", rc);
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002330 goto error;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002331 }
2332
2333 if (!dev->tgt_available_prots) {
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002334 struct nfc_target nfc_target;
2335
Joe Perchesb4834832013-04-05 12:27:37 -07002336 dev_dbg(&dev->interface->dev, "Creating new target\n");
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002337
2338 nfc_target.supported_protocols = NFC_PROTO_NFC_DEP_MASK;
Samuel Ortiz2fbabfa2012-03-05 01:03:47 +01002339 nfc_target.nfcid1_len = 10;
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002340 memcpy(nfc_target.nfcid1, rsp->nfcid3t, nfc_target.nfcid1_len);
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002341 rc = nfc_targets_found(dev->nfc_dev, &nfc_target, 1);
2342 if (rc)
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002343 goto error;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002344
2345 dev->tgt_available_prots = 0;
2346 }
2347
2348 dev->tgt_active_prot = NFC_PROTO_NFC_DEP;
2349
2350 /* ATR_RES general bytes are located at offset 17 */
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002351 target_gt_len = resp->len - 17;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002352 rc = nfc_set_remote_general_bytes(dev->nfc_dev,
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002353 rsp->gt, target_gt_len);
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002354 if (rc == 0)
2355 rc = nfc_dep_link_is_up(dev->nfc_dev,
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002356 dev->nfc_dev->targets[0].idx,
2357 !active, NFC_RF_INITIATOR);
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002358
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002359error:
2360 dev_kfree_skb(resp);
2361 return rc;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002362}
2363
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02002364static int pn533_rf_field(struct nfc_dev *nfc_dev, u8 rf);
Eric Lapuyade90099432012-05-07 12:31:13 +02002365static int pn533_dep_link_up(struct nfc_dev *nfc_dev, struct nfc_target *target,
Waldemar Rymarkiewicz37cf4fc2012-12-10 14:42:50 +01002366 u8 comm_mode, u8 *gb, size_t gb_len)
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002367{
2368 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002369 struct sk_buff *skb;
Samuel Ortiz5eef4842013-07-01 10:58:12 +02002370 int rc, skb_len;
2371 u8 *next, *arg, nfcid3[NFC_NFCID3_MAXSIZE];
Samuel Ortizd7f33452012-05-29 21:45:21 +02002372 u8 passive_data[PASSIVE_DATA_LEN] = {0x00, 0xff, 0xff, 0x00, 0x3};
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002373
Joe Perchesb4834832013-04-05 12:27:37 -07002374 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002375
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002376 if (dev->poll_mod_count) {
Joe Perches073a6252013-04-05 12:27:38 -07002377 nfc_err(&dev->interface->dev,
2378 "Cannot bring the DEP link up while polling\n");
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002379 return -EBUSY;
2380 }
2381
2382 if (dev->tgt_active_prot) {
Joe Perches073a6252013-04-05 12:27:38 -07002383 nfc_err(&dev->interface->dev,
2384 "There is already an active target\n");
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002385 return -EBUSY;
2386 }
2387
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002388 skb_len = 3 + gb_len; /* ActPass + BR + Next */
Samuel Ortiz5eef4842013-07-01 10:58:12 +02002389 skb_len += PASSIVE_DATA_LEN;
Samuel Ortizd7f33452012-05-29 21:45:21 +02002390
Samuel Ortiz5eef4842013-07-01 10:58:12 +02002391 /* NFCID3 */
2392 skb_len += NFC_NFCID3_MAXSIZE;
2393 if (target && !target->nfcid2_len) {
2394 nfcid3[0] = 0x1;
2395 nfcid3[1] = 0xfe;
2396 get_random_bytes(nfcid3 + 2, 6);
2397 }
Samuel Ortiz322bce92013-05-27 15:29:11 +02002398
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002399 skb = pn533_alloc_skb(dev, skb_len);
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002400 if (!skb)
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002401 return -ENOMEM;
2402
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002403 *skb_put(skb, 1) = !comm_mode; /* ActPass */
Samuel Ortiz5eef4842013-07-01 10:58:12 +02002404 *skb_put(skb, 1) = 0x02; /* 424 kbps */
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002405
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002406 next = skb_put(skb, 1); /* Next */
2407 *next = 0;
2408
Samuel Ortiz5eef4842013-07-01 10:58:12 +02002409 /* Copy passive data */
2410 memcpy(skb_put(skb, PASSIVE_DATA_LEN), passive_data, PASSIVE_DATA_LEN);
2411 *next |= 1;
Samuel Ortizd7f33452012-05-29 21:45:21 +02002412
Samuel Ortiz5eef4842013-07-01 10:58:12 +02002413 /* Copy NFCID3 (which is NFCID2 from SENSF_RES) */
2414 if (target && target->nfcid2_len)
Samuel Ortiz322bce92013-05-27 15:29:11 +02002415 memcpy(skb_put(skb, NFC_NFCID3_MAXSIZE), target->nfcid2,
2416 target->nfcid2_len);
Samuel Ortiz5eef4842013-07-01 10:58:12 +02002417 else
2418 memcpy(skb_put(skb, NFC_NFCID3_MAXSIZE), nfcid3,
2419 NFC_NFCID3_MAXSIZE);
2420 *next |= 2;
Samuel Ortiz322bce92013-05-27 15:29:11 +02002421
Samuel Ortiz47807d32012-03-05 01:03:50 +01002422 if (gb != NULL && gb_len > 0) {
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002423 memcpy(skb_put(skb, gb_len), gb, gb_len);
2424 *next |= 4; /* We have some Gi */
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002425 } else {
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002426 *next = 0;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002427 }
2428
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002429 arg = kmalloc(sizeof(*arg), GFP_KERNEL);
2430 if (!arg) {
2431 dev_kfree_skb(skb);
2432 return -ENOMEM;
2433 }
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002434
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002435 *arg = !comm_mode;
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002436
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02002437 pn533_rf_field(dev->nfc_dev, 0);
2438
Waldemar Rymarkiewicz13003642012-12-10 14:42:45 +01002439 rc = pn533_send_cmd_async(dev, PN533_CMD_IN_JUMP_FOR_DEP, skb,
2440 pn533_in_dep_link_up_complete, arg);
2441
2442 if (rc < 0) {
2443 dev_kfree_skb(skb);
2444 kfree(arg);
2445 }
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002446
2447 return rc;
2448}
2449
2450static int pn533_dep_link_down(struct nfc_dev *nfc_dev)
2451{
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002452 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
2453
Joe Perchesb4834832013-04-05 12:27:37 -07002454 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Waldemar Rymarkiewiczfcfafc72012-12-10 14:42:55 +01002455
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02002456 pn533_poll_reset_mod_list(dev);
2457
Waldemar Rymarkiewicz10cff292013-04-03 08:02:14 +02002458 if (dev->tgt_mode || dev->tgt_active_prot)
2459 pn533_abort_cmd(dev, GFP_KERNEL);
Samuel Ortiz51ad3042012-05-31 20:01:32 +02002460
2461 dev->tgt_active_prot = 0;
2462 dev->tgt_mode = 0;
2463
2464 skb_queue_purge(&dev->resp_q);
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01002465
2466 return 0;
2467}
2468
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002469struct pn533_data_exchange_arg {
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002470 data_exchange_cb_t cb;
2471 void *cb_context;
2472};
2473
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002474static struct sk_buff *pn533_build_response(struct pn533 *dev)
2475{
2476 struct sk_buff *skb, *tmp, *t;
2477 unsigned int skb_len = 0, tmp_len = 0;
2478
Joe Perchesb4834832013-04-05 12:27:37 -07002479 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002480
2481 if (skb_queue_empty(&dev->resp_q))
2482 return NULL;
2483
2484 if (skb_queue_len(&dev->resp_q) == 1) {
2485 skb = skb_dequeue(&dev->resp_q);
2486 goto out;
2487 }
2488
2489 skb_queue_walk_safe(&dev->resp_q, tmp, t)
2490 skb_len += tmp->len;
2491
Joe Perchesb4834832013-04-05 12:27:37 -07002492 dev_dbg(&dev->interface->dev, "%s total length %d\n",
2493 __func__, skb_len);
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002494
2495 skb = alloc_skb(skb_len, GFP_KERNEL);
2496 if (skb == NULL)
2497 goto out;
2498
2499 skb_put(skb, skb_len);
2500
2501 skb_queue_walk_safe(&dev->resp_q, tmp, t) {
2502 memcpy(skb->data + tmp_len, tmp->data, tmp->len);
2503 tmp_len += tmp->len;
2504 }
2505
2506out:
2507 skb_queue_purge(&dev->resp_q);
2508
2509 return skb;
2510}
2511
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002512static int pn533_data_exchange_complete(struct pn533 *dev, void *_arg,
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002513 struct sk_buff *resp)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002514{
2515 struct pn533_data_exchange_arg *arg = _arg;
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002516 struct sk_buff *skb;
2517 int rc = 0;
2518 u8 status, ret, mi;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002519
Joe Perchesb4834832013-04-05 12:27:37 -07002520 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002521
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002522 if (IS_ERR(resp)) {
2523 rc = PTR_ERR(resp);
2524 goto _error;
2525 }
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002526
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002527 status = resp->data[0];
2528 ret = status & PN533_CMD_RET_MASK;
2529 mi = status & PN533_CMD_MI_MASK;
2530
2531 skb_pull(resp, sizeof(status));
2532
2533 if (ret != PN533_CMD_RET_SUCCESS) {
Joe Perches073a6252013-04-05 12:27:38 -07002534 nfc_err(&dev->interface->dev,
2535 "Exchanging data failed (error 0x%x)\n", ret);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002536 rc = -EIO;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002537 goto error;
2538 }
2539
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002540 skb_queue_tail(&dev->resp_q, resp);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002541
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002542 if (mi) {
2543 dev->cmd_complete_mi_arg = arg;
Olivier Guiter963a82e2013-06-13 13:43:28 +00002544 queue_work(dev->wq, &dev->mi_rx_work);
2545 return -EINPROGRESS;
2546 }
2547
2548 /* Prepare for the next round */
2549 if (skb_queue_len(&dev->fragment_skb) > 0) {
2550 dev->cmd_complete_dep_arg = arg;
2551 queue_work(dev->wq, &dev->mi_tx_work);
2552
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002553 return -EINPROGRESS;
2554 }
2555
2556 skb = pn533_build_response(dev);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002557 if (!skb)
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002558 goto error;
2559
2560 arg->cb(arg->cb_context, skb, 0);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002561 kfree(arg);
2562 return 0;
2563
2564error:
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002565 dev_kfree_skb(resp);
2566_error:
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002567 skb_queue_purge(&dev->resp_q);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002568 arg->cb(arg->cb_context, NULL, rc);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002569 kfree(arg);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002570 return rc;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002571}
2572
Olivier Guiter963a82e2013-06-13 13:43:28 +00002573/* Split the Tx skb into small chunks */
2574static int pn533_fill_fragment_skbs(struct pn533 *dev, struct sk_buff *skb)
2575{
2576 struct sk_buff *frag;
2577 int frag_size;
2578
2579 do {
2580 /* Remaining size */
2581 if (skb->len > PN533_CMD_DATAFRAME_MAXLEN)
2582 frag_size = PN533_CMD_DATAFRAME_MAXLEN;
2583 else
2584 frag_size = skb->len;
2585
2586 /* Allocate and reserve */
2587 frag = pn533_alloc_skb(dev, frag_size);
2588 if (!frag) {
2589 skb_queue_purge(&dev->fragment_skb);
2590 break;
2591 }
2592
Olivier Guiter22953f92013-09-23 12:24:37 +02002593 if (!dev->tgt_mode) {
2594 /* Reserve the TG/MI byte */
2595 skb_reserve(frag, 1);
Olivier Guiter963a82e2013-06-13 13:43:28 +00002596
Olivier Guiter22953f92013-09-23 12:24:37 +02002597 /* MI + TG */
2598 if (frag_size == PN533_CMD_DATAFRAME_MAXLEN)
2599 *skb_push(frag, sizeof(u8)) =
2600 (PN533_CMD_MI_MASK | 1);
2601 else
2602 *skb_push(frag, sizeof(u8)) = 1; /* TG */
2603 }
Olivier Guiter963a82e2013-06-13 13:43:28 +00002604
2605 memcpy(skb_put(frag, frag_size), skb->data, frag_size);
2606
2607 /* Reduce the size of incoming buffer */
2608 skb_pull(skb, frag_size);
2609
2610 /* Add this to skb_queue */
2611 skb_queue_tail(&dev->fragment_skb, frag);
2612
2613 } while (skb->len > 0);
2614
2615 dev_kfree_skb(skb);
2616
2617 return skb_queue_len(&dev->fragment_skb);
2618}
2619
Samuel Ortizbe9ae4c2012-05-16 15:55:48 +02002620static int pn533_transceive(struct nfc_dev *nfc_dev,
2621 struct nfc_target *target, struct sk_buff *skb,
2622 data_exchange_cb_t cb, void *cb_context)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002623{
2624 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002625 struct pn533_data_exchange_arg *arg = NULL;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002626 int rc;
2627
Joe Perchesb4834832013-04-05 12:27:37 -07002628 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002629
2630 if (!dev->tgt_active_prot) {
Joe Perches073a6252013-04-05 12:27:38 -07002631 nfc_err(&dev->interface->dev,
2632 "Can't exchange data if there is no active target\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002633 rc = -EINVAL;
2634 goto error;
2635 }
2636
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002637 arg = kmalloc(sizeof(*arg), GFP_KERNEL);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002638 if (!arg) {
2639 rc = -ENOMEM;
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002640 goto error;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002641 }
2642
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002643 arg->cb = cb;
2644 arg->cb_context = cb_context;
2645
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002646 switch (dev->device_type) {
2647 case PN533_DEVICE_PASORI:
2648 if (dev->tgt_active_prot == NFC_PROTO_FELICA) {
2649 rc = pn533_send_data_async(dev, PN533_CMD_IN_COMM_THRU,
2650 skb,
2651 pn533_data_exchange_complete,
2652 arg);
2653
2654 break;
2655 }
2656 default:
Olivier Guiter963a82e2013-06-13 13:43:28 +00002657 /* jumbo frame ? */
2658 if (skb->len > PN533_CMD_DATAEXCH_DATA_MAXLEN) {
2659 rc = pn533_fill_fragment_skbs(dev, skb);
2660 if (rc <= 0)
2661 goto error;
2662
2663 skb = skb_dequeue(&dev->fragment_skb);
2664 if (!skb) {
2665 rc = -EIO;
2666 goto error;
2667 }
2668 } else {
2669 *skb_push(skb, sizeof(u8)) = 1; /* TG */
2670 }
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002671
2672 rc = pn533_send_data_async(dev, PN533_CMD_IN_DATA_EXCHANGE,
2673 skb, pn533_data_exchange_complete,
2674 arg);
2675
2676 break;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002677 }
2678
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002679 if (rc < 0) /* rc from send_async */
2680 goto error;
2681
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002682 return 0;
2683
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002684error:
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002685 kfree(arg);
2686 dev_kfree_skb(skb);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002687 return rc;
2688}
2689
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002690static int pn533_tm_send_complete(struct pn533 *dev, void *arg,
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01002691 struct sk_buff *resp)
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002692{
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01002693 u8 status;
Thierry Escande5b412fd2012-11-15 18:24:28 +01002694
Joe Perchesb4834832013-04-05 12:27:37 -07002695 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002696
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01002697 if (IS_ERR(resp))
2698 return PTR_ERR(resp);
Thierry Escande5b412fd2012-11-15 18:24:28 +01002699
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01002700 status = resp->data[0];
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002701
Olivier Guiter93ad4202013-09-23 12:24:39 +02002702 /* Prepare for the next round */
2703 if (skb_queue_len(&dev->fragment_skb) > 0) {
2704 queue_work(dev->wq, &dev->mi_tm_tx_work);
2705 return -EINPROGRESS;
2706 }
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01002707 dev_kfree_skb(resp);
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002708
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01002709 if (status != 0) {
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002710 nfc_tm_deactivated(dev->nfc_dev);
2711
Samuel Ortiz51ad3042012-05-31 20:01:32 +02002712 dev->tgt_mode = 0;
2713
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002714 return 0;
2715 }
2716
2717 queue_work(dev->wq, &dev->tg_work);
2718
2719 return 0;
2720}
2721
2722static int pn533_tm_send(struct nfc_dev *nfc_dev, struct sk_buff *skb)
2723{
2724 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002725 int rc;
2726
Joe Perchesb4834832013-04-05 12:27:37 -07002727 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002728
Olivier Guiter93ad4202013-09-23 12:24:39 +02002729 /* let's split in multiple chunks if size's too big */
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01002730 if (skb->len > PN533_CMD_DATAEXCH_DATA_MAXLEN) {
Olivier Guiter93ad4202013-09-23 12:24:39 +02002731 rc = pn533_fill_fragment_skbs(dev, skb);
2732 if (rc <= 0)
2733 goto error;
2734
2735 /* get the first skb */
2736 skb = skb_dequeue(&dev->fragment_skb);
2737 if (!skb) {
2738 rc = -EIO;
2739 goto error;
2740 }
2741
2742 rc = pn533_send_data_async(dev, PN533_CMD_TG_SET_META_DATA, skb,
2743 pn533_tm_send_complete, NULL);
2744 } else {
2745 /* Send th skb */
2746 rc = pn533_send_data_async(dev, PN533_CMD_TG_SET_DATA, skb,
2747 pn533_tm_send_complete, NULL);
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002748 }
2749
Olivier Guiter93ad4202013-09-23 12:24:39 +02002750error:
2751 if (rc < 0) {
Waldemar Rymarkiewicze4878822012-12-10 14:42:44 +01002752 dev_kfree_skb(skb);
Olivier Guiter93ad4202013-09-23 12:24:39 +02002753 skb_queue_purge(&dev->fragment_skb);
2754 }
Samuel Ortizdadb06f2012-05-31 00:09:11 +02002755
2756 return rc;
2757}
2758
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002759static void pn533_wq_mi_recv(struct work_struct *work)
2760{
Olivier Guiter963a82e2013-06-13 13:43:28 +00002761 struct pn533 *dev = container_of(work, struct pn533, mi_rx_work);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002762 struct sk_buff *skb;
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002763 int rc;
2764
Joe Perchesb4834832013-04-05 12:27:37 -07002765 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002766
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002767 skb = pn533_alloc_skb(dev, PN533_CMD_DATAEXCH_HEAD_LEN);
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002768 if (!skb)
2769 goto error;
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002770
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002771 switch (dev->device_type) {
2772 case PN533_DEVICE_PASORI:
2773 if (dev->tgt_active_prot == NFC_PROTO_FELICA) {
2774 rc = pn533_send_cmd_direct_async(dev,
2775 PN533_CMD_IN_COMM_THRU,
2776 skb,
2777 pn533_data_exchange_complete,
2778 dev->cmd_complete_mi_arg);
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002779
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002780 break;
2781 }
2782 default:
2783 *skb_put(skb, sizeof(u8)) = 1; /*TG*/
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002784
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002785 rc = pn533_send_cmd_direct_async(dev,
2786 PN533_CMD_IN_DATA_EXCHANGE,
2787 skb,
2788 pn533_data_exchange_complete,
2789 dev->cmd_complete_mi_arg);
Waldemar Rymarkiewiczb1bb2902012-11-26 14:18:32 +01002790
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002791 break;
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002792 }
2793
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002794 if (rc == 0) /* success */
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002795 return;
2796
Joe Perches073a6252013-04-05 12:27:38 -07002797 nfc_err(&dev->interface->dev,
2798 "Error %d when trying to perform data_exchange\n", rc);
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002799
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002800 dev_kfree_skb(skb);
Waldemar Rymarkiewicz140ef7f2013-04-03 08:02:07 +02002801 kfree(dev->cmd_complete_mi_arg);
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002802
Waldemar Rymarkiewiczb1e666f2012-12-10 14:42:46 +01002803error:
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002804 pn533_send_ack(dev, GFP_KERNEL);
Samuel Ortiz5d50b362012-08-17 23:47:54 +02002805 queue_work(dev->wq, &dev->cmd_work);
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02002806}
2807
Olivier Guiter963a82e2013-06-13 13:43:28 +00002808static void pn533_wq_mi_send(struct work_struct *work)
2809{
2810 struct pn533 *dev = container_of(work, struct pn533, mi_tx_work);
2811 struct sk_buff *skb;
2812 int rc;
2813
Joe Perchesb4834832013-04-05 12:27:37 -07002814 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Olivier Guiter963a82e2013-06-13 13:43:28 +00002815
2816 /* Grab the first skb in the queue */
2817 skb = skb_dequeue(&dev->fragment_skb);
2818
2819 if (skb == NULL) { /* No more data */
2820 /* Reset the queue for future use */
2821 skb_queue_head_init(&dev->fragment_skb);
2822 goto error;
2823 }
2824
2825 switch (dev->device_type) {
2826 case PN533_DEVICE_PASORI:
2827 if (dev->tgt_active_prot != NFC_PROTO_FELICA) {
2828 rc = -EIO;
2829 break;
2830 }
2831
2832 rc = pn533_send_cmd_direct_async(dev, PN533_CMD_IN_COMM_THRU,
2833 skb,
2834 pn533_data_exchange_complete,
2835 dev->cmd_complete_dep_arg);
2836
2837 break;
2838
2839 default:
2840 /* Still some fragments? */
2841 rc = pn533_send_cmd_direct_async(dev,PN533_CMD_IN_DATA_EXCHANGE,
2842 skb,
2843 pn533_data_exchange_complete,
2844 dev->cmd_complete_dep_arg);
2845
2846 break;
2847 }
2848
2849 if (rc == 0) /* success */
2850 return;
2851
Joe Perches073a6252013-04-05 12:27:38 -07002852 nfc_err(&dev->interface->dev,
2853 "Error %d when trying to perform data_exchange\n", rc);
Olivier Guiter963a82e2013-06-13 13:43:28 +00002854
2855 dev_kfree_skb(skb);
2856 kfree(dev->cmd_complete_dep_arg);
2857
2858error:
2859 pn533_send_ack(dev, GFP_KERNEL);
2860 queue_work(dev->wq, &dev->cmd_work);
2861}
2862
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002863static int pn533_set_configuration(struct pn533 *dev, u8 cfgitem, u8 *cfgdata,
2864 u8 cfgdata_len)
2865{
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002866 struct sk_buff *skb;
2867 struct sk_buff *resp;
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002868 int skb_len;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002869
Joe Perchesb4834832013-04-05 12:27:37 -07002870 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002871
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002872 skb_len = sizeof(cfgitem) + cfgdata_len; /* cfgitem + cfgdata */
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002873
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002874 skb = pn533_alloc_skb(dev, skb_len);
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002875 if (!skb)
2876 return -ENOMEM;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002877
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002878 *skb_put(skb, sizeof(cfgitem)) = cfgitem;
2879 memcpy(skb_put(skb, cfgdata_len), cfgdata, cfgdata_len);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002880
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002881 resp = pn533_send_cmd_sync(dev, PN533_CMD_RF_CONFIGURATION, skb);
2882 if (IS_ERR(resp))
2883 return PTR_ERR(resp);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002884
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002885 dev_kfree_skb(resp);
2886 return 0;
2887}
2888
2889static int pn533_get_firmware_version(struct pn533 *dev,
2890 struct pn533_fw_version *fv)
2891{
2892 struct sk_buff *skb;
2893 struct sk_buff *resp;
2894
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002895 skb = pn533_alloc_skb(dev, 0);
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002896 if (!skb)
2897 return -ENOMEM;
2898
2899 resp = pn533_send_cmd_sync(dev, PN533_CMD_GET_FIRMWARE_VERSION, skb);
2900 if (IS_ERR(resp))
2901 return PTR_ERR(resp);
2902
2903 fv->ic = resp->data[0];
2904 fv->ver = resp->data[1];
2905 fv->rev = resp->data[2];
2906 fv->support = resp->data[3];
2907
2908 dev_kfree_skb(resp);
2909 return 0;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03002910}
2911
Waldemar Rymarkiewiczf75c2912013-04-03 08:02:02 +02002912static int pn533_pasori_fw_reset(struct pn533 *dev)
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02002913{
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002914 struct sk_buff *skb;
2915 struct sk_buff *resp;
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02002916
Joe Perchesb4834832013-04-05 12:27:37 -07002917 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02002918
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01002919 skb = pn533_alloc_skb(dev, sizeof(u8));
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002920 if (!skb)
2921 return -ENOMEM;
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02002922
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002923 *skb_put(skb, sizeof(u8)) = 0x1;
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02002924
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002925 resp = pn533_send_cmd_sync(dev, 0x18, skb);
2926 if (IS_ERR(resp))
2927 return PTR_ERR(resp);
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02002928
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01002929 dev_kfree_skb(resp);
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02002930
Waldemar Rymarkiewicz94c5c152012-11-26 14:18:36 +01002931 return 0;
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02002932}
2933
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02002934struct pn533_acr122_poweron_rdr_arg {
2935 int rc;
2936 struct completion done;
2937};
2938
2939static void pn533_acr122_poweron_rdr_resp(struct urb *urb)
2940{
2941 struct pn533_acr122_poweron_rdr_arg *arg = urb->context;
2942
Joe Perchesb4834832013-04-05 12:27:37 -07002943 dev_dbg(&urb->dev->dev, "%s\n", __func__);
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02002944
Olivier Guiter86eca4e2013-06-03 12:02:29 +02002945 print_hex_dump_debug("ACR122 RX: ", DUMP_PREFIX_NONE, 16, 1,
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02002946 urb->transfer_buffer, urb->transfer_buffer_length,
2947 false);
2948
2949 arg->rc = urb->status;
2950 complete(&arg->done);
2951}
2952
2953static int pn533_acr122_poweron_rdr(struct pn533 *dev)
2954{
2955 /* Power on th reader (CCID cmd) */
2956 u8 cmd[10] = {PN533_ACR122_PC_TO_RDR_ICCPOWERON,
2957 0, 0, 0, 0, 0, 0, 3, 0, 0};
2958 u8 buf[255];
2959 int rc;
2960 void *cntx;
2961 struct pn533_acr122_poweron_rdr_arg arg;
2962
Joe Perchesb4834832013-04-05 12:27:37 -07002963 dev_dbg(&dev->interface->dev, "%s\n", __func__);
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02002964
2965 init_completion(&arg.done);
2966 cntx = dev->in_urb->context; /* backup context */
2967
2968 dev->in_urb->transfer_buffer = buf;
2969 dev->in_urb->transfer_buffer_length = 255;
2970 dev->in_urb->complete = pn533_acr122_poweron_rdr_resp;
2971 dev->in_urb->context = &arg;
2972
2973 dev->out_urb->transfer_buffer = cmd;
2974 dev->out_urb->transfer_buffer_length = sizeof(cmd);
2975
Olivier Guiter86eca4e2013-06-03 12:02:29 +02002976 print_hex_dump_debug("ACR122 TX: ", DUMP_PREFIX_NONE, 16, 1,
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02002977 cmd, sizeof(cmd), false);
2978
2979 rc = usb_submit_urb(dev->out_urb, GFP_KERNEL);
2980 if (rc) {
Joe Perches073a6252013-04-05 12:27:38 -07002981 nfc_err(&dev->interface->dev,
2982 "Reader power on cmd error %d\n", rc);
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02002983 return rc;
2984 }
2985
2986 rc = usb_submit_urb(dev->in_urb, GFP_KERNEL);
2987 if (rc) {
Joe Perches073a6252013-04-05 12:27:38 -07002988 nfc_err(&dev->interface->dev,
2989 "Can't submit reader poweron cmd response %d\n", rc);
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02002990 return rc;
2991 }
2992
2993 wait_for_completion(&arg.done);
2994 dev->in_urb->context = cntx; /* restore context */
2995
2996 return arg.rc;
2997}
2998
Samuel Ortiz60d9edd52013-04-11 11:45:41 +02002999static int pn533_rf_field(struct nfc_dev *nfc_dev, u8 rf)
3000{
3001 struct pn533 *dev = nfc_get_drvdata(nfc_dev);
3002 u8 rf_field = !!rf;
3003 int rc;
3004
Samuel Ortiz3a8eab32013-07-01 17:26:58 +02003005 rf_field |= PN533_CFGITEM_RF_FIELD_AUTO_RFCA;
3006
Samuel Ortiz60d9edd52013-04-11 11:45:41 +02003007 rc = pn533_set_configuration(dev, PN533_CFGITEM_RF_FIELD,
3008 (u8 *)&rf_field, 1);
3009 if (rc) {
Joe Perches073a6252013-04-05 12:27:38 -07003010 nfc_err(&dev->interface->dev, "Error on setting RF field\n");
Samuel Ortiz60d9edd52013-04-11 11:45:41 +02003011 return rc;
3012 }
3013
3014 return rc;
3015}
3016
Sachin Kamate44666b2013-09-20 14:30:41 +05303017static int pn533_dev_up(struct nfc_dev *nfc_dev)
Samuel Ortiz60d9edd52013-04-11 11:45:41 +02003018{
3019 return pn533_rf_field(nfc_dev, 1);
3020}
3021
Sachin Kamate44666b2013-09-20 14:30:41 +05303022static int pn533_dev_down(struct nfc_dev *nfc_dev)
Samuel Ortiz60d9edd52013-04-11 11:45:41 +02003023{
3024 return pn533_rf_field(nfc_dev, 0);
3025}
3026
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003027static struct nfc_ops pn533_nfc_ops = {
Samuel Ortiz60d9edd52013-04-11 11:45:41 +02003028 .dev_up = pn533_dev_up,
3029 .dev_down = pn533_dev_down,
Samuel Ortiz361f3cb2011-12-14 16:43:11 +01003030 .dep_link_up = pn533_dep_link_up,
3031 .dep_link_down = pn533_dep_link_down,
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003032 .start_poll = pn533_start_poll,
3033 .stop_poll = pn533_stop_poll,
3034 .activate_target = pn533_activate_target,
3035 .deactivate_target = pn533_deactivate_target,
Samuel Ortizbe9ae4c2012-05-16 15:55:48 +02003036 .im_transceive = pn533_transceive,
Samuel Ortizdadb06f2012-05-31 00:09:11 +02003037 .tm_send = pn533_tm_send,
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003038};
3039
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003040static int pn533_setup(struct pn533 *dev)
3041{
3042 struct pn533_config_max_retries max_retries;
3043 struct pn533_config_timing timing;
3044 u8 pasori_cfg[3] = {0x08, 0x01, 0x08};
3045 int rc;
3046
3047 switch (dev->device_type) {
3048 case PN533_DEVICE_STD:
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003049 case PN533_DEVICE_PASORI:
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02003050 case PN533_DEVICE_ACR122U:
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003051 max_retries.mx_rty_atr = 0x2;
3052 max_retries.mx_rty_psl = 0x1;
3053 max_retries.mx_rty_passive_act =
3054 PN533_CONFIG_MAX_RETRIES_NO_RETRY;
3055
3056 timing.rfu = PN533_CONFIG_TIMING_102;
3057 timing.atr_res_timeout = PN533_CONFIG_TIMING_102;
3058 timing.dep_timeout = PN533_CONFIG_TIMING_204;
3059
3060 break;
3061
3062 default:
Joe Perches073a6252013-04-05 12:27:38 -07003063 nfc_err(&dev->interface->dev, "Unknown device type %d\n",
3064 dev->device_type);
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003065 return -EINVAL;
3066 }
3067
3068 rc = pn533_set_configuration(dev, PN533_CFGITEM_MAX_RETRIES,
3069 (u8 *)&max_retries, sizeof(max_retries));
3070 if (rc) {
Joe Perches073a6252013-04-05 12:27:38 -07003071 nfc_err(&dev->interface->dev,
3072 "Error on setting MAX_RETRIES config\n");
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003073 return rc;
3074 }
3075
3076
3077 rc = pn533_set_configuration(dev, PN533_CFGITEM_TIMING,
3078 (u8 *)&timing, sizeof(timing));
3079 if (rc) {
Joe Perches073a6252013-04-05 12:27:38 -07003080 nfc_err(&dev->interface->dev, "Error on setting RF timings\n");
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003081 return rc;
3082 }
3083
3084 switch (dev->device_type) {
3085 case PN533_DEVICE_STD:
3086 break;
3087
3088 case PN533_DEVICE_PASORI:
Waldemar Rymarkiewiczf75c2912013-04-03 08:02:02 +02003089 pn533_pasori_fw_reset(dev);
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003090
3091 rc = pn533_set_configuration(dev, PN533_CFGITEM_PASORI,
3092 pasori_cfg, 3);
3093 if (rc) {
Joe Perches073a6252013-04-05 12:27:38 -07003094 nfc_err(&dev->interface->dev,
3095 "Error while settings PASORI config\n");
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003096 return rc;
3097 }
3098
Waldemar Rymarkiewiczf75c2912013-04-03 08:02:02 +02003099 pn533_pasori_fw_reset(dev);
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003100
3101 break;
3102 }
3103
3104 return 0;
3105}
3106
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003107static int pn533_probe(struct usb_interface *interface,
3108 const struct usb_device_id *id)
3109{
Waldemar Rymarkiewiczcb950d92012-11-26 14:18:38 +01003110 struct pn533_fw_version fw_ver;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003111 struct pn533 *dev;
3112 struct usb_host_interface *iface_desc;
3113 struct usb_endpoint_descriptor *endpoint;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003114 int in_endpoint = 0;
3115 int out_endpoint = 0;
3116 int rc = -ENOMEM;
3117 int i;
3118 u32 protocols;
3119
3120 dev = kzalloc(sizeof(*dev), GFP_KERNEL);
3121 if (!dev)
3122 return -ENOMEM;
3123
3124 dev->udev = usb_get_dev(interface_to_usbdev(interface));
3125 dev->interface = interface;
Samuel Ortiz0201ed02012-05-31 17:56:46 +02003126 mutex_init(&dev->cmd_lock);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003127
3128 iface_desc = interface->cur_altsetting;
3129 for (i = 0; i < iface_desc->desc.bNumEndpoints; ++i) {
3130 endpoint = &iface_desc->endpoint[i].desc;
3131
Waldemar Rymarkiewicz8d25ca72012-11-26 14:18:30 +01003132 if (!in_endpoint && usb_endpoint_is_bulk_in(endpoint))
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003133 in_endpoint = endpoint->bEndpointAddress;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003134
Waldemar Rymarkiewicz8d25ca72012-11-26 14:18:30 +01003135 if (!out_endpoint && usb_endpoint_is_bulk_out(endpoint))
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003136 out_endpoint = endpoint->bEndpointAddress;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003137 }
3138
3139 if (!in_endpoint || !out_endpoint) {
Joe Perches073a6252013-04-05 12:27:38 -07003140 nfc_err(&interface->dev,
3141 "Could not find bulk-in or bulk-out endpoint\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003142 rc = -ENODEV;
3143 goto error;
3144 }
3145
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003146 dev->in_urb = usb_alloc_urb(0, GFP_KERNEL);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003147 dev->out_urb = usb_alloc_urb(0, GFP_KERNEL);
3148
Waldemar Rymarkiewicza5798092012-12-10 14:42:58 +01003149 if (!dev->in_urb || !dev->out_urb)
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003150 goto error;
3151
3152 usb_fill_bulk_urb(dev->in_urb, dev->udev,
Waldemar Rymarkiewicz5d467742012-12-10 14:42:51 +01003153 usb_rcvbulkpipe(dev->udev, in_endpoint),
3154 NULL, 0, NULL, dev);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003155 usb_fill_bulk_urb(dev->out_urb, dev->udev,
Waldemar Rymarkiewicz5d467742012-12-10 14:42:51 +01003156 usb_sndbulkpipe(dev->udev, out_endpoint),
3157 NULL, 0, pn533_send_complete, dev);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003158
Samuel Ortiz5d50b362012-08-17 23:47:54 +02003159 INIT_WORK(&dev->cmd_work, pn533_wq_cmd);
3160 INIT_WORK(&dev->cmd_complete_work, pn533_wq_cmd_complete);
Olivier Guiter963a82e2013-06-13 13:43:28 +00003161 INIT_WORK(&dev->mi_rx_work, pn533_wq_mi_recv);
3162 INIT_WORK(&dev->mi_tx_work, pn533_wq_mi_send);
Samuel Ortiz103b34c2012-05-31 00:07:51 +02003163 INIT_WORK(&dev->tg_work, pn533_wq_tg_get_data);
Olivier Guiter3c13b242013-09-23 12:24:38 +02003164 INIT_WORK(&dev->mi_tm_rx_work, pn533_wq_tm_mi_recv);
Olivier Guiter93ad4202013-09-23 12:24:39 +02003165 INIT_WORK(&dev->mi_tm_tx_work, pn533_wq_tm_mi_send);
Samuel Ortiz46f793b2013-07-03 14:50:36 +02003166 INIT_DELAYED_WORK(&dev->poll_work, pn533_wq_poll);
Samuel Ortiz17e9d9d2013-06-26 18:16:21 +02003167 INIT_WORK(&dev->rf_work, pn533_wq_rf);
Tejun Heo58637c92012-08-22 16:28:46 -07003168 dev->wq = alloc_ordered_workqueue("pn533", 0);
Samuel Ortiz4849f852012-04-10 19:43:17 +02003169 if (dev->wq == NULL)
3170 goto error;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003171
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02003172 init_timer(&dev->listen_timer);
3173 dev->listen_timer.data = (unsigned long) dev;
3174 dev->listen_timer.function = pn533_listen_mode_timer;
3175
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02003176 skb_queue_head_init(&dev->resp_q);
Olivier Guiter963a82e2013-06-13 13:43:28 +00003177 skb_queue_head_init(&dev->fragment_skb);
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02003178
Samuel Ortiz5d50b362012-08-17 23:47:54 +02003179 INIT_LIST_HEAD(&dev->cmd_queue);
3180
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003181 usb_set_intfdata(interface, dev);
3182
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01003183 dev->ops = &pn533_std_frame_ops;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003184
Waldemar Rymarkiewicz58520372013-04-03 08:02:12 +02003185 dev->protocol_type = PN533_PROTO_REQ_ACK_RESP;
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003186 dev->device_type = id->driver_info;
3187 switch (dev->device_type) {
3188 case PN533_DEVICE_STD:
3189 protocols = PN533_ALL_PROTOCOLS;
3190 break;
3191
3192 case PN533_DEVICE_PASORI:
3193 protocols = PN533_NO_TYPE_B_PROTOCOLS;
3194 break;
3195
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02003196 case PN533_DEVICE_ACR122U:
3197 protocols = PN533_NO_TYPE_B_PROTOCOLS;
3198 dev->ops = &pn533_acr122_frame_ops;
3199 dev->protocol_type = PN533_PROTO_REQ_RESP,
3200
3201 rc = pn533_acr122_poweron_rdr(dev);
3202 if (rc < 0) {
Joe Perches073a6252013-04-05 12:27:38 -07003203 nfc_err(&dev->interface->dev,
3204 "Couldn't poweron the reader (error %d)\n", rc);
Waldemar Rymarkiewicz53cf4832013-04-03 08:02:13 +02003205 goto destroy_wq;
3206 }
3207 break;
3208
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003209 default:
Joe Perches073a6252013-04-05 12:27:38 -07003210 nfc_err(&dev->interface->dev, "Unknown device type %d\n",
3211 dev->device_type);
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003212 rc = -EINVAL;
3213 goto destroy_wq;
3214 }
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003215
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01003216 memset(&fw_ver, 0, sizeof(fw_ver));
3217 rc = pn533_get_firmware_version(dev, &fw_ver);
3218 if (rc < 0)
3219 goto destroy_wq;
3220
Joe Perches073a6252013-04-05 12:27:38 -07003221 nfc_info(&dev->interface->dev,
3222 "NXP PN5%02X firmware ver %d.%d now attached\n",
3223 fw_ver.ic, fw_ver.ver, fw_ver.rev);
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01003224
3225
Samuel Ortize8753042011-08-19 15:47:11 +02003226 dev->nfc_dev = nfc_allocate_device(&pn533_nfc_ops, protocols,
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01003227 dev->ops->tx_header_len +
Samuel Ortize8753042011-08-19 15:47:11 +02003228 PN533_CMD_DATAEXCH_HEAD_LEN,
Waldemar Rymarkiewicz9e2d4932012-12-10 14:43:01 +01003229 dev->ops->tx_tail_len);
Wei Yongjun4674d0f2013-05-07 20:07:52 +08003230 if (!dev->nfc_dev) {
3231 rc = -ENOMEM;
Samuel Ortiz4849f852012-04-10 19:43:17 +02003232 goto destroy_wq;
Wei Yongjun4674d0f2013-05-07 20:07:52 +08003233 }
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003234
3235 nfc_set_parent_dev(dev->nfc_dev, &interface->dev);
3236 nfc_set_drvdata(dev->nfc_dev, dev);
3237
3238 rc = nfc_register_device(dev->nfc_dev);
3239 if (rc)
3240 goto free_nfc_dev;
3241
Samuel Ortiz5c7b0532012-07-02 20:04:01 +02003242 rc = pn533_setup(dev);
3243 if (rc)
Samuel Ortiz9f2f8ba2012-05-29 21:28:58 +02003244 goto unregister_nfc_dev;
Samuel Ortiz34a85bf2012-05-29 21:34:08 +02003245
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003246 return 0;
3247
Samuel Ortiz9f2f8ba2012-05-29 21:28:58 +02003248unregister_nfc_dev:
3249 nfc_unregister_device(dev->nfc_dev);
3250
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003251free_nfc_dev:
3252 nfc_free_device(dev->nfc_dev);
Samuel Ortiz9f2f8ba2012-05-29 21:28:58 +02003253
Samuel Ortiz4849f852012-04-10 19:43:17 +02003254destroy_wq:
3255 destroy_workqueue(dev->wq);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003256error:
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003257 usb_free_urb(dev->in_urb);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003258 usb_free_urb(dev->out_urb);
Marina Makienko7c5a54f2013-02-26 11:41:18 +04003259 usb_put_dev(dev->udev);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003260 kfree(dev);
3261 return rc;
3262}
3263
3264static void pn533_disconnect(struct usb_interface *interface)
3265{
3266 struct pn533 *dev;
Samuel Ortiz5d50b362012-08-17 23:47:54 +02003267 struct pn533_cmd *cmd, *n;
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003268
3269 dev = usb_get_intfdata(interface);
3270 usb_set_intfdata(interface, NULL);
3271
3272 nfc_unregister_device(dev->nfc_dev);
3273 nfc_free_device(dev->nfc_dev);
3274
3275 usb_kill_urb(dev->in_urb);
3276 usb_kill_urb(dev->out_urb);
3277
Samuel Ortiz46f793b2013-07-03 14:50:36 +02003278 flush_delayed_work(&dev->poll_work);
Samuel Ortiz4849f852012-04-10 19:43:17 +02003279 destroy_workqueue(dev->wq);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003280
Samuel Ortiz6ff73fd2012-04-10 19:43:18 +02003281 skb_queue_purge(&dev->resp_q);
3282
Samuel Ortiz6fbbdc12012-05-30 17:20:25 +02003283 del_timer(&dev->listen_timer);
3284
Samuel Ortiz5d50b362012-08-17 23:47:54 +02003285 list_for_each_entry_safe(cmd, n, &dev->cmd_queue, queue) {
3286 list_del(&cmd->queue);
3287 kfree(cmd);
3288 }
3289
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003290 usb_free_urb(dev->in_urb);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003291 usb_free_urb(dev->out_urb);
3292 kfree(dev);
3293
Joe Perches073a6252013-04-05 12:27:38 -07003294 nfc_info(&interface->dev, "NXP PN533 NFC device disconnected\n");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003295}
3296
3297static struct usb_driver pn533_driver = {
3298 .name = "pn533",
3299 .probe = pn533_probe,
3300 .disconnect = pn533_disconnect,
3301 .id_table = pn533_table,
3302};
3303
Greg Kroah-Hartmanfe748482011-11-18 09:52:10 -08003304module_usb_driver(pn533_driver);
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003305
Waldemar Rymarkiewicze70b96e2013-04-03 08:02:01 +02003306MODULE_AUTHOR("Lauro Ramos Venancio <lauro.venancio@openbossa.org>");
3307MODULE_AUTHOR("Aloisio Almeida Jr <aloisio.almeida@openbossa.org>");
3308MODULE_AUTHOR("Waldemar Rymarkiewicz <waldemar.rymarkiewicz@tieto.com>");
Aloisio Almeida Jrc46ee382011-07-01 19:31:37 -03003309MODULE_DESCRIPTION("PN533 usb driver ver " VERSION);
3310MODULE_VERSION(VERSION);
3311MODULE_LICENSE("GPL");