1 /* 2 * HCI based Driver for Inside Secure microread NFC Chip 3 * 4 * Copyright (C) 2013 Intel Corporation. All rights reserved. 5 * 6 * This program is free software; you can redistribute it and/or modify it 7 * under the terms and conditions of the GNU General Public License, 8 * version 2, as published by the Free Software Foundation. 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 16 * along with this program; if not, see <http://www.gnu.org/licenses/>. 17 */ 18 19 #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt 20 21 #include <linux/module.h> 22 #include <linux/delay.h> 23 #include <linux/slab.h> 24 #include <linux/crc-ccitt.h> 25 26 #include <linux/nfc.h> 27 #include <net/nfc/nfc.h> 28 #include <net/nfc/hci.h> 29 #include <net/nfc/llc.h> 30 31 #include "microread.h" 32 33 /* Proprietary gates, events, commands and registers */ 34 /* Admin */ 35 #define MICROREAD_GATE_ID_ADM NFC_HCI_ADMIN_GATE 36 #define MICROREAD_GATE_ID_MGT 0x01 37 #define MICROREAD_GATE_ID_OS 0x02 38 #define MICROREAD_GATE_ID_TESTRF 0x03 39 #define MICROREAD_GATE_ID_LOOPBACK NFC_HCI_LOOPBACK_GATE 40 #define MICROREAD_GATE_ID_IDT NFC_HCI_ID_MGMT_GATE 41 #define MICROREAD_GATE_ID_LMS NFC_HCI_LINK_MGMT_GATE 42 43 /* Reader */ 44 #define MICROREAD_GATE_ID_MREAD_GEN 0x10 45 #define MICROREAD_GATE_ID_MREAD_ISO_B NFC_HCI_RF_READER_B_GATE 46 #define MICROREAD_GATE_ID_MREAD_NFC_T1 0x12 47 #define MICROREAD_GATE_ID_MREAD_ISO_A NFC_HCI_RF_READER_A_GATE 48 #define MICROREAD_GATE_ID_MREAD_NFC_T3 0x14 49 #define MICROREAD_GATE_ID_MREAD_ISO_15_3 0x15 50 #define MICROREAD_GATE_ID_MREAD_ISO_15_2 0x16 51 #define MICROREAD_GATE_ID_MREAD_ISO_B_3 0x17 52 #define MICROREAD_GATE_ID_MREAD_BPRIME 0x18 53 #define MICROREAD_GATE_ID_MREAD_ISO_A_3 0x19 54 55 /* Card */ 56 #define MICROREAD_GATE_ID_MCARD_GEN 0x20 57 #define MICROREAD_GATE_ID_MCARD_ISO_B 0x21 58 #define MICROREAD_GATE_ID_MCARD_BPRIME 0x22 59 #define MICROREAD_GATE_ID_MCARD_ISO_A 0x23 60 #define MICROREAD_GATE_ID_MCARD_NFC_T3 0x24 61 #define MICROREAD_GATE_ID_MCARD_ISO_15_3 0x25 62 #define MICROREAD_GATE_ID_MCARD_ISO_15_2 0x26 63 #define MICROREAD_GATE_ID_MCARD_ISO_B_2 0x27 64 #define MICROREAD_GATE_ID_MCARD_ISO_CUSTOM 0x28 65 #define MICROREAD_GATE_ID_SECURE_ELEMENT 0x2F 66 67 /* P2P */ 68 #define MICROREAD_GATE_ID_P2P_GEN 0x30 69 #define MICROREAD_GATE_ID_P2P_TARGET 0x31 70 #define MICROREAD_PAR_P2P_TARGET_MODE 0x01 71 #define MICROREAD_PAR_P2P_TARGET_GT 0x04 72 #define MICROREAD_GATE_ID_P2P_INITIATOR 0x32 73 #define MICROREAD_PAR_P2P_INITIATOR_GI 0x01 74 #define MICROREAD_PAR_P2P_INITIATOR_GT 0x03 75 76 /* Those pipes are created/opened by default in the chip */ 77 #define MICROREAD_PIPE_ID_LMS 0x00 78 #define MICROREAD_PIPE_ID_ADMIN 0x01 79 #define MICROREAD_PIPE_ID_MGT 0x02 80 #define MICROREAD_PIPE_ID_OS 0x03 81 #define MICROREAD_PIPE_ID_HDS_LOOPBACK 0x04 82 #define MICROREAD_PIPE_ID_HDS_IDT 0x05 83 #define MICROREAD_PIPE_ID_HDS_MCARD_ISO_B 0x08 84 #define MICROREAD_PIPE_ID_HDS_MCARD_ISO_BPRIME 0x09 85 #define MICROREAD_PIPE_ID_HDS_MCARD_ISO_A 0x0A 86 #define MICROREAD_PIPE_ID_HDS_MCARD_ISO_15_3 0x0B 87 #define MICROREAD_PIPE_ID_HDS_MCARD_ISO_15_2 0x0C 88 #define MICROREAD_PIPE_ID_HDS_MCARD_NFC_T3 0x0D 89 #define MICROREAD_PIPE_ID_HDS_MCARD_ISO_B_2 0x0E 90 #define MICROREAD_PIPE_ID_HDS_MCARD_CUSTOM 0x0F 91 #define MICROREAD_PIPE_ID_HDS_MREAD_ISO_B 0x10 92 #define MICROREAD_PIPE_ID_HDS_MREAD_NFC_T1 0x11 93 #define MICROREAD_PIPE_ID_HDS_MREAD_ISO_A 0x12 94 #define MICROREAD_PIPE_ID_HDS_MREAD_ISO_15_3 0x13 95 #define MICROREAD_PIPE_ID_HDS_MREAD_ISO_15_2 0x14 96 #define MICROREAD_PIPE_ID_HDS_MREAD_NFC_T3 0x15 97 #define MICROREAD_PIPE_ID_HDS_MREAD_ISO_B_3 0x16 98 #define MICROREAD_PIPE_ID_HDS_MREAD_BPRIME 0x17 99 #define MICROREAD_PIPE_ID_HDS_MREAD_ISO_A_3 0x18 100 #define MICROREAD_PIPE_ID_HDS_MREAD_GEN 0x1B 101 #define MICROREAD_PIPE_ID_HDS_STACKED_ELEMENT 0x1C 102 #define MICROREAD_PIPE_ID_HDS_INSTANCES 0x1D 103 #define MICROREAD_PIPE_ID_HDS_TESTRF 0x1E 104 #define MICROREAD_PIPE_ID_HDS_P2P_TARGET 0x1F 105 #define MICROREAD_PIPE_ID_HDS_P2P_INITIATOR 0x20 106 107 /* Events */ 108 #define MICROREAD_EVT_MREAD_DISCOVERY_OCCURED NFC_HCI_EVT_TARGET_DISCOVERED 109 #define MICROREAD_EVT_MREAD_CARD_FOUND 0x3D 110 #define MICROREAD_EMCF_A_ATQA 0 111 #define MICROREAD_EMCF_A_SAK 2 112 #define MICROREAD_EMCF_A_LEN 3 113 #define MICROREAD_EMCF_A_UID 4 114 #define MICROREAD_EMCF_A3_ATQA 0 115 #define MICROREAD_EMCF_A3_SAK 2 116 #define MICROREAD_EMCF_A3_LEN 3 117 #define MICROREAD_EMCF_A3_UID 4 118 #define MICROREAD_EMCF_B_UID 0 119 #define MICROREAD_EMCF_T1_ATQA 0 120 #define MICROREAD_EMCF_T1_UID 4 121 #define MICROREAD_EMCF_T3_UID 0 122 #define MICROREAD_EVT_MREAD_DISCOVERY_START NFC_HCI_EVT_READER_REQUESTED 123 #define MICROREAD_EVT_MREAD_DISCOVERY_START_SOME 0x3E 124 #define MICROREAD_EVT_MREAD_DISCOVERY_STOP NFC_HCI_EVT_END_OPERATION 125 #define MICROREAD_EVT_MREAD_SIM_REQUESTS 0x3F 126 #define MICROREAD_EVT_MCARD_EXCHANGE NFC_HCI_EVT_TARGET_DISCOVERED 127 #define MICROREAD_EVT_P2P_INITIATOR_EXCHANGE_TO_RF 0x20 128 #define MICROREAD_EVT_P2P_INITIATOR_EXCHANGE_FROM_RF 0x21 129 #define MICROREAD_EVT_MCARD_FIELD_ON 0x11 130 #define MICROREAD_EVT_P2P_TARGET_ACTIVATED 0x13 131 #define MICROREAD_EVT_P2P_TARGET_DEACTIVATED 0x12 132 #define MICROREAD_EVT_MCARD_FIELD_OFF 0x14 133 134 /* Commands */ 135 #define MICROREAD_CMD_MREAD_EXCHANGE 0x10 136 #define MICROREAD_CMD_MREAD_SUBSCRIBE 0x3F 137 138 /* Hosts IDs */ 139 #define MICROREAD_ELT_ID_HDS NFC_HCI_TERMINAL_HOST_ID 140 #define MICROREAD_ELT_ID_SIM NFC_HCI_UICC_HOST_ID 141 #define MICROREAD_ELT_ID_SE1 0x03 142 #define MICROREAD_ELT_ID_SE2 0x04 143 #define MICROREAD_ELT_ID_SE3 0x05 144 145 static struct nfc_hci_gate microread_gates[] = { 146 {MICROREAD_GATE_ID_ADM, MICROREAD_PIPE_ID_ADMIN}, 147 {MICROREAD_GATE_ID_LOOPBACK, MICROREAD_PIPE_ID_HDS_LOOPBACK}, 148 {MICROREAD_GATE_ID_IDT, MICROREAD_PIPE_ID_HDS_IDT}, 149 {MICROREAD_GATE_ID_LMS, MICROREAD_PIPE_ID_LMS}, 150 {MICROREAD_GATE_ID_MREAD_ISO_B, MICROREAD_PIPE_ID_HDS_MREAD_ISO_B}, 151 {MICROREAD_GATE_ID_MREAD_ISO_A, MICROREAD_PIPE_ID_HDS_MREAD_ISO_A}, 152 {MICROREAD_GATE_ID_MREAD_ISO_A_3, MICROREAD_PIPE_ID_HDS_MREAD_ISO_A_3}, 153 {MICROREAD_GATE_ID_MGT, MICROREAD_PIPE_ID_MGT}, 154 {MICROREAD_GATE_ID_OS, MICROREAD_PIPE_ID_OS}, 155 {MICROREAD_GATE_ID_MREAD_NFC_T1, MICROREAD_PIPE_ID_HDS_MREAD_NFC_T1}, 156 {MICROREAD_GATE_ID_MREAD_NFC_T3, MICROREAD_PIPE_ID_HDS_MREAD_NFC_T3}, 157 {MICROREAD_GATE_ID_P2P_TARGET, MICROREAD_PIPE_ID_HDS_P2P_TARGET}, 158 {MICROREAD_GATE_ID_P2P_INITIATOR, MICROREAD_PIPE_ID_HDS_P2P_INITIATOR} 159 }; 160 161 /* Largest headroom needed for outgoing custom commands */ 162 #define MICROREAD_CMDS_HEADROOM 2 163 #define MICROREAD_CMD_TAILROOM 2 164 165 struct microread_info { 166 struct nfc_phy_ops *phy_ops; 167 void *phy_id; 168 169 struct nfc_hci_dev *hdev; 170 171 int async_cb_type; 172 data_exchange_cb_t async_cb; 173 void *async_cb_context; 174 }; 175 176 static int microread_open(struct nfc_hci_dev *hdev) 177 { 178 struct microread_info *info = nfc_hci_get_clientdata(hdev); 179 180 return info->phy_ops->enable(info->phy_id); 181 } 182 183 static void microread_close(struct nfc_hci_dev *hdev) 184 { 185 struct microread_info *info = nfc_hci_get_clientdata(hdev); 186 187 info->phy_ops->disable(info->phy_id); 188 } 189 190 static int microread_hci_ready(struct nfc_hci_dev *hdev) 191 { 192 int r; 193 u8 param[4]; 194 195 param[0] = 0x03; 196 r = nfc_hci_send_cmd(hdev, MICROREAD_GATE_ID_MREAD_ISO_A, 197 MICROREAD_CMD_MREAD_SUBSCRIBE, param, 1, NULL); 198 if (r) 199 return r; 200 201 r = nfc_hci_send_cmd(hdev, MICROREAD_GATE_ID_MREAD_ISO_A_3, 202 MICROREAD_CMD_MREAD_SUBSCRIBE, NULL, 0, NULL); 203 if (r) 204 return r; 205 206 param[0] = 0x00; 207 param[1] = 0x03; 208 param[2] = 0x00; 209 r = nfc_hci_send_cmd(hdev, MICROREAD_GATE_ID_MREAD_ISO_B, 210 MICROREAD_CMD_MREAD_SUBSCRIBE, param, 3, NULL); 211 if (r) 212 return r; 213 214 r = nfc_hci_send_cmd(hdev, MICROREAD_GATE_ID_MREAD_NFC_T1, 215 MICROREAD_CMD_MREAD_SUBSCRIBE, NULL, 0, NULL); 216 if (r) 217 return r; 218 219 param[0] = 0xFF; 220 param[1] = 0xFF; 221 param[2] = 0x00; 222 param[3] = 0x00; 223 r = nfc_hci_send_cmd(hdev, MICROREAD_GATE_ID_MREAD_NFC_T3, 224 MICROREAD_CMD_MREAD_SUBSCRIBE, param, 4, NULL); 225 226 return r; 227 } 228 229 static int microread_xmit(struct nfc_hci_dev *hdev, struct sk_buff *skb) 230 { 231 struct microread_info *info = nfc_hci_get_clientdata(hdev); 232 233 return info->phy_ops->write(info->phy_id, skb); 234 } 235 236 static int microread_start_poll(struct nfc_hci_dev *hdev, 237 u32 im_protocols, u32 tm_protocols) 238 { 239 int r; 240 241 u8 param[2]; 242 u8 mode; 243 244 param[0] = 0x00; 245 param[1] = 0x00; 246 247 if (im_protocols & NFC_PROTO_ISO14443_MASK) 248 param[0] |= (1 << 2); 249 250 if (im_protocols & NFC_PROTO_ISO14443_B_MASK) 251 param[0] |= 1; 252 253 if (im_protocols & NFC_PROTO_MIFARE_MASK) 254 param[1] |= 1; 255 256 if (im_protocols & NFC_PROTO_JEWEL_MASK) 257 param[0] |= (1 << 1); 258 259 if (im_protocols & NFC_PROTO_FELICA_MASK) 260 param[0] |= (1 << 5); 261 262 if (im_protocols & NFC_PROTO_NFC_DEP_MASK) 263 param[1] |= (1 << 1); 264 265 if ((im_protocols | tm_protocols) & NFC_PROTO_NFC_DEP_MASK) { 266 hdev->gb = nfc_get_local_general_bytes(hdev->ndev, 267 &hdev->gb_len); 268 if (hdev->gb == NULL || hdev->gb_len == 0) { 269 im_protocols &= ~NFC_PROTO_NFC_DEP_MASK; 270 tm_protocols &= ~NFC_PROTO_NFC_DEP_MASK; 271 } 272 } 273 274 r = nfc_hci_send_event(hdev, MICROREAD_GATE_ID_MREAD_ISO_A, 275 MICROREAD_EVT_MREAD_DISCOVERY_STOP, NULL, 0); 276 if (r) 277 return r; 278 279 mode = 0xff; 280 r = nfc_hci_set_param(hdev, MICROREAD_GATE_ID_P2P_TARGET, 281 MICROREAD_PAR_P2P_TARGET_MODE, &mode, 1); 282 if (r) 283 return r; 284 285 if (im_protocols & NFC_PROTO_NFC_DEP_MASK) { 286 r = nfc_hci_set_param(hdev, MICROREAD_GATE_ID_P2P_INITIATOR, 287 MICROREAD_PAR_P2P_INITIATOR_GI, 288 hdev->gb, hdev->gb_len); 289 if (r) 290 return r; 291 } 292 293 if (tm_protocols & NFC_PROTO_NFC_DEP_MASK) { 294 r = nfc_hci_set_param(hdev, MICROREAD_GATE_ID_P2P_TARGET, 295 MICROREAD_PAR_P2P_TARGET_GT, 296 hdev->gb, hdev->gb_len); 297 if (r) 298 return r; 299 300 mode = 0x02; 301 r = nfc_hci_set_param(hdev, MICROREAD_GATE_ID_P2P_TARGET, 302 MICROREAD_PAR_P2P_TARGET_MODE, &mode, 1); 303 if (r) 304 return r; 305 } 306 307 return nfc_hci_send_event(hdev, MICROREAD_GATE_ID_MREAD_ISO_A, 308 MICROREAD_EVT_MREAD_DISCOVERY_START_SOME, 309 param, 2); 310 } 311 312 static int microread_dep_link_up(struct nfc_hci_dev *hdev, 313 struct nfc_target *target, u8 comm_mode, 314 u8 *gb, size_t gb_len) 315 { 316 struct sk_buff *rgb_skb = NULL; 317 int r; 318 319 r = nfc_hci_get_param(hdev, target->hci_reader_gate, 320 MICROREAD_PAR_P2P_INITIATOR_GT, &rgb_skb); 321 if (r < 0) 322 return r; 323 324 if (rgb_skb->len == 0 || rgb_skb->len > NFC_GB_MAXSIZE) { 325 r = -EPROTO; 326 goto exit; 327 } 328 329 r = nfc_set_remote_general_bytes(hdev->ndev, rgb_skb->data, 330 rgb_skb->len); 331 if (r == 0) 332 r = nfc_dep_link_is_up(hdev->ndev, target->idx, comm_mode, 333 NFC_RF_INITIATOR); 334 exit: 335 kfree_skb(rgb_skb); 336 337 return r; 338 } 339 340 static int microread_dep_link_down(struct nfc_hci_dev *hdev) 341 { 342 return nfc_hci_send_event(hdev, MICROREAD_GATE_ID_P2P_INITIATOR, 343 MICROREAD_EVT_MREAD_DISCOVERY_STOP, NULL, 0); 344 } 345 346 static int microread_target_from_gate(struct nfc_hci_dev *hdev, u8 gate, 347 struct nfc_target *target) 348 { 349 switch (gate) { 350 case MICROREAD_GATE_ID_P2P_INITIATOR: 351 target->supported_protocols = NFC_PROTO_NFC_DEP_MASK; 352 break; 353 default: 354 return -EPROTO; 355 } 356 357 return 0; 358 } 359 360 static int microread_complete_target_discovered(struct nfc_hci_dev *hdev, 361 u8 gate, 362 struct nfc_target *target) 363 { 364 return 0; 365 } 366 367 #define MICROREAD_CB_TYPE_READER_ALL 1 368 369 static void microread_im_transceive_cb(void *context, struct sk_buff *skb, 370 int err) 371 { 372 struct microread_info *info = context; 373 374 switch (info->async_cb_type) { 375 case MICROREAD_CB_TYPE_READER_ALL: 376 if (err == 0) { 377 if (skb->len == 0) { 378 err = -EPROTO; 379 kfree_skb(skb); 380 info->async_cb(info->async_cb_context, NULL, 381 -EPROTO); 382 return; 383 } 384 385 if (skb->data[skb->len - 1] != 0) { 386 err = nfc_hci_result_to_errno( 387 skb->data[skb->len - 1]); 388 kfree_skb(skb); 389 info->async_cb(info->async_cb_context, NULL, 390 err); 391 return; 392 } 393 394 skb_trim(skb, skb->len - 1); /* RF Error ind. */ 395 } 396 info->async_cb(info->async_cb_context, skb, err); 397 break; 398 default: 399 if (err == 0) 400 kfree_skb(skb); 401 break; 402 } 403 } 404 405 /* 406 * Returns: 407 * <= 0: driver handled the data exchange 408 * 1: driver doesn't especially handle, please do standard processing 409 */ 410 static int microread_im_transceive(struct nfc_hci_dev *hdev, 411 struct nfc_target *target, 412 struct sk_buff *skb, data_exchange_cb_t cb, 413 void *cb_context) 414 { 415 struct microread_info *info = nfc_hci_get_clientdata(hdev); 416 u8 control_bits; 417 u16 crc; 418 419 pr_info("data exchange to gate 0x%x\n", target->hci_reader_gate); 420 421 if (target->hci_reader_gate == MICROREAD_GATE_ID_P2P_INITIATOR) { 422 *(u8 *)skb_push(skb, 1) = 0; 423 424 return nfc_hci_send_event(hdev, target->hci_reader_gate, 425 MICROREAD_EVT_P2P_INITIATOR_EXCHANGE_TO_RF, 426 skb->data, skb->len); 427 } 428 429 switch (target->hci_reader_gate) { 430 case MICROREAD_GATE_ID_MREAD_ISO_A: 431 control_bits = 0xCB; 432 break; 433 case MICROREAD_GATE_ID_MREAD_ISO_A_3: 434 control_bits = 0xCB; 435 break; 436 case MICROREAD_GATE_ID_MREAD_ISO_B: 437 control_bits = 0xCB; 438 break; 439 case MICROREAD_GATE_ID_MREAD_NFC_T1: 440 control_bits = 0x1B; 441 442 crc = crc_ccitt(0xffff, skb->data, skb->len); 443 crc = ~crc; 444 skb_put_u8(skb, crc & 0xff); 445 skb_put_u8(skb, crc >> 8); 446 break; 447 case MICROREAD_GATE_ID_MREAD_NFC_T3: 448 control_bits = 0xDB; 449 break; 450 default: 451 pr_info("Abort im_transceive to invalid gate 0x%x\n", 452 target->hci_reader_gate); 453 return 1; 454 } 455 456 *(u8 *)skb_push(skb, 1) = control_bits; 457 458 info->async_cb_type = MICROREAD_CB_TYPE_READER_ALL; 459 info->async_cb = cb; 460 info->async_cb_context = cb_context; 461 462 return nfc_hci_send_cmd_async(hdev, target->hci_reader_gate, 463 MICROREAD_CMD_MREAD_EXCHANGE, 464 skb->data, skb->len, 465 microread_im_transceive_cb, info); 466 } 467 468 static int microread_tm_send(struct nfc_hci_dev *hdev, struct sk_buff *skb) 469 { 470 int r; 471 472 r = nfc_hci_send_event(hdev, MICROREAD_GATE_ID_P2P_TARGET, 473 MICROREAD_EVT_MCARD_EXCHANGE, 474 skb->data, skb->len); 475 476 kfree_skb(skb); 477 478 return r; 479 } 480 481 static void microread_target_discovered(struct nfc_hci_dev *hdev, u8 gate, 482 struct sk_buff *skb) 483 { 484 struct nfc_target *targets; 485 int r = 0; 486 487 pr_info("target discovered to gate 0x%x\n", gate); 488 489 targets = kzalloc(sizeof(struct nfc_target), GFP_KERNEL); 490 if (targets == NULL) { 491 r = -ENOMEM; 492 goto exit; 493 } 494 495 targets->hci_reader_gate = gate; 496 497 switch (gate) { 498 case MICROREAD_GATE_ID_MREAD_ISO_A: 499 targets->supported_protocols = 500 nfc_hci_sak_to_protocol(skb->data[MICROREAD_EMCF_A_SAK]); 501 targets->sens_res = 502 be16_to_cpu(*(u16 *)&skb->data[MICROREAD_EMCF_A_ATQA]); 503 targets->sel_res = skb->data[MICROREAD_EMCF_A_SAK]; 504 targets->nfcid1_len = skb->data[MICROREAD_EMCF_A_LEN]; 505 if (targets->nfcid1_len > sizeof(targets->nfcid1)) { 506 r = -EINVAL; 507 goto exit_free; 508 } 509 memcpy(targets->nfcid1, &skb->data[MICROREAD_EMCF_A_UID], 510 targets->nfcid1_len); 511 break; 512 case MICROREAD_GATE_ID_MREAD_ISO_A_3: 513 targets->supported_protocols = 514 nfc_hci_sak_to_protocol(skb->data[MICROREAD_EMCF_A3_SAK]); 515 targets->sens_res = 516 be16_to_cpu(*(u16 *)&skb->data[MICROREAD_EMCF_A3_ATQA]); 517 targets->sel_res = skb->data[MICROREAD_EMCF_A3_SAK]; 518 targets->nfcid1_len = skb->data[MICROREAD_EMCF_A3_LEN]; 519 if (targets->nfcid1_len > sizeof(targets->nfcid1)) { 520 r = -EINVAL; 521 goto exit_free; 522 } 523 memcpy(targets->nfcid1, &skb->data[MICROREAD_EMCF_A3_UID], 524 targets->nfcid1_len); 525 break; 526 case MICROREAD_GATE_ID_MREAD_ISO_B: 527 targets->supported_protocols = NFC_PROTO_ISO14443_B_MASK; 528 memcpy(targets->nfcid1, &skb->data[MICROREAD_EMCF_B_UID], 4); 529 targets->nfcid1_len = 4; 530 break; 531 case MICROREAD_GATE_ID_MREAD_NFC_T1: 532 targets->supported_protocols = NFC_PROTO_JEWEL_MASK; 533 targets->sens_res = 534 le16_to_cpu(*(u16 *)&skb->data[MICROREAD_EMCF_T1_ATQA]); 535 memcpy(targets->nfcid1, &skb->data[MICROREAD_EMCF_T1_UID], 4); 536 targets->nfcid1_len = 4; 537 break; 538 case MICROREAD_GATE_ID_MREAD_NFC_T3: 539 targets->supported_protocols = NFC_PROTO_FELICA_MASK; 540 memcpy(targets->nfcid1, &skb->data[MICROREAD_EMCF_T3_UID], 8); 541 targets->nfcid1_len = 8; 542 break; 543 default: 544 pr_info("discard target discovered to gate 0x%x\n", gate); 545 goto exit_free; 546 } 547 548 r = nfc_targets_found(hdev->ndev, targets, 1); 549 550 exit_free: 551 kfree(targets); 552 553 exit: 554 kfree_skb(skb); 555 556 if (r) 557 pr_err("Failed to handle discovered target err=%d\n", r); 558 } 559 560 static int microread_event_received(struct nfc_hci_dev *hdev, u8 pipe, 561 u8 event, struct sk_buff *skb) 562 { 563 int r; 564 u8 gate = hdev->pipes[pipe].gate; 565 u8 mode; 566 567 pr_info("Microread received event 0x%x to gate 0x%x\n", event, gate); 568 569 switch (event) { 570 case MICROREAD_EVT_MREAD_CARD_FOUND: 571 microread_target_discovered(hdev, gate, skb); 572 return 0; 573 574 case MICROREAD_EVT_P2P_INITIATOR_EXCHANGE_FROM_RF: 575 if (skb->len < 1) { 576 kfree_skb(skb); 577 return -EPROTO; 578 } 579 580 if (skb->data[skb->len - 1]) { 581 kfree_skb(skb); 582 return -EIO; 583 } 584 585 skb_trim(skb, skb->len - 1); 586 587 r = nfc_tm_data_received(hdev->ndev, skb); 588 break; 589 590 case MICROREAD_EVT_MCARD_FIELD_ON: 591 case MICROREAD_EVT_MCARD_FIELD_OFF: 592 kfree_skb(skb); 593 return 0; 594 595 case MICROREAD_EVT_P2P_TARGET_ACTIVATED: 596 r = nfc_tm_activated(hdev->ndev, NFC_PROTO_NFC_DEP_MASK, 597 NFC_COMM_PASSIVE, skb->data, 598 skb->len); 599 600 kfree_skb(skb); 601 break; 602 603 case MICROREAD_EVT_MCARD_EXCHANGE: 604 if (skb->len < 1) { 605 kfree_skb(skb); 606 return -EPROTO; 607 } 608 609 if (skb->data[skb->len-1]) { 610 kfree_skb(skb); 611 return -EIO; 612 } 613 614 skb_trim(skb, skb->len - 1); 615 616 r = nfc_tm_data_received(hdev->ndev, skb); 617 break; 618 619 case MICROREAD_EVT_P2P_TARGET_DEACTIVATED: 620 kfree_skb(skb); 621 622 mode = 0xff; 623 r = nfc_hci_set_param(hdev, MICROREAD_GATE_ID_P2P_TARGET, 624 MICROREAD_PAR_P2P_TARGET_MODE, &mode, 1); 625 if (r) 626 break; 627 628 r = nfc_hci_send_event(hdev, gate, 629 MICROREAD_EVT_MREAD_DISCOVERY_STOP, NULL, 630 0); 631 break; 632 633 default: 634 return 1; 635 } 636 637 return r; 638 } 639 640 static struct nfc_hci_ops microread_hci_ops = { 641 .open = microread_open, 642 .close = microread_close, 643 .hci_ready = microread_hci_ready, 644 .xmit = microread_xmit, 645 .start_poll = microread_start_poll, 646 .dep_link_up = microread_dep_link_up, 647 .dep_link_down = microread_dep_link_down, 648 .target_from_gate = microread_target_from_gate, 649 .complete_target_discovered = microread_complete_target_discovered, 650 .im_transceive = microread_im_transceive, 651 .tm_send = microread_tm_send, 652 .check_presence = NULL, 653 .event_received = microread_event_received, 654 }; 655 656 int microread_probe(void *phy_id, struct nfc_phy_ops *phy_ops, char *llc_name, 657 int phy_headroom, int phy_tailroom, int phy_payload, 658 struct nfc_hci_dev **hdev) 659 { 660 struct microread_info *info; 661 unsigned long quirks = 0; 662 u32 protocols; 663 struct nfc_hci_init_data init_data; 664 int r; 665 666 info = kzalloc(sizeof(struct microread_info), GFP_KERNEL); 667 if (!info) { 668 r = -ENOMEM; 669 goto err_info_alloc; 670 } 671 672 info->phy_ops = phy_ops; 673 info->phy_id = phy_id; 674 675 init_data.gate_count = ARRAY_SIZE(microread_gates); 676 memcpy(init_data.gates, microread_gates, sizeof(microread_gates)); 677 678 strcpy(init_data.session_id, "MICROREA"); 679 680 set_bit(NFC_HCI_QUIRK_SHORT_CLEAR, &quirks); 681 682 protocols = NFC_PROTO_JEWEL_MASK | 683 NFC_PROTO_MIFARE_MASK | 684 NFC_PROTO_FELICA_MASK | 685 NFC_PROTO_ISO14443_MASK | 686 NFC_PROTO_ISO14443_B_MASK | 687 NFC_PROTO_NFC_DEP_MASK; 688 689 info->hdev = nfc_hci_allocate_device(µread_hci_ops, &init_data, 690 quirks, protocols, llc_name, 691 phy_headroom + 692 MICROREAD_CMDS_HEADROOM, 693 phy_tailroom + 694 MICROREAD_CMD_TAILROOM, 695 phy_payload); 696 if (!info->hdev) { 697 pr_err("Cannot allocate nfc hdev\n"); 698 r = -ENOMEM; 699 goto err_alloc_hdev; 700 } 701 702 nfc_hci_set_clientdata(info->hdev, info); 703 704 r = nfc_hci_register_device(info->hdev); 705 if (r) 706 goto err_regdev; 707 708 *hdev = info->hdev; 709 710 return 0; 711 712 err_regdev: 713 nfc_hci_free_device(info->hdev); 714 715 err_alloc_hdev: 716 kfree(info); 717 718 err_info_alloc: 719 return r; 720 } 721 EXPORT_SYMBOL(microread_probe); 722 723 void microread_remove(struct nfc_hci_dev *hdev) 724 { 725 struct microread_info *info = nfc_hci_get_clientdata(hdev); 726 727 nfc_hci_unregister_device(hdev); 728 nfc_hci_free_device(hdev); 729 kfree(info); 730 } 731 EXPORT_SYMBOL(microread_remove); 732 733 MODULE_LICENSE("GPL"); 734 MODULE_DESCRIPTION(DRIVER_DESC); 735