Blame view
drivers/nfc/st21nfca/core.c
26.6 KB
46fe77716 treewide: Replace... |
1 |
// SPDX-License-Identifier: GPL-2.0-only |
68957303f NFC: ST21NFCA: Ad... |
2 3 4 5 |
/* * HCI based Driver for STMicroelectronics NFC Chip * * Copyright (C) 2014 STMicroelectronics SAS. All rights reserved. |
68957303f NFC: ST21NFCA: Ad... |
6 |
*/ |
68957303f NFC: ST21NFCA: Ad... |
7 |
#include <linux/module.h> |
68957303f NFC: ST21NFCA: Ad... |
8 9 10 |
#include <linux/nfc.h> #include <net/nfc/hci.h> #include <net/nfc/llc.h> |
68957303f NFC: ST21NFCA: Ad... |
11 |
#include "st21nfca.h" |
68957303f NFC: ST21NFCA: Ad... |
12 13 14 15 16 17 18 19 20 21 22 |
#define DRIVER_DESC "HCI NFC driver for ST21NFCA" #define FULL_VERSION_LEN 3 /* Proprietary gates, events, commands and registers */ /* Commands that apply to all RF readers */ #define ST21NFCA_RF_READER_CMD_PRESENCE_CHECK 0x30 #define ST21NFCA_RF_READER_ISO15693_GATE 0x12 |
efaf956ad NFC: st21nfca: Cl... |
23 |
#define ST21NFCA_RF_READER_ISO15693_INVENTORY 0x01 |
68957303f NFC: ST21NFCA: Ad... |
24 25 26 27 28 29 30 31 32 |
/* * Reader gate for communication with contact-less cards using Type A * protocol ISO14443-3 but not compliant with ISO14443-4 */ #define ST21NFCA_RF_READER_14443_3_A_GATE 0x15 #define ST21NFCA_RF_READER_14443_3_A_UID 0x02 #define ST21NFCA_RF_READER_14443_3_A_ATQA 0x03 #define ST21NFCA_RF_READER_14443_3_A_SAK 0x04 |
efaf956ad NFC: st21nfca: Cl... |
33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 |
#define ST21NFCA_RF_READER_F_DATARATE 0x01 #define ST21NFCA_RF_READER_F_DATARATE_106 0x01 #define ST21NFCA_RF_READER_F_DATARATE_212 0x02 #define ST21NFCA_RF_READER_F_DATARATE_424 0x04 #define ST21NFCA_RF_READER_F_POL_REQ 0x02 #define ST21NFCA_RF_READER_F_POL_REQ_DEFAULT 0xffff0000 #define ST21NFCA_RF_READER_F_NFCID2 0x03 #define ST21NFCA_RF_READER_F_NFCID1 0x04 #define ST21NFCA_RF_CARD_F_MODE 0x01 #define ST21NFCA_RF_CARD_F_NFCID2_LIST 0x04 #define ST21NFCA_RF_CARD_F_NFCID1 0x05 #define ST21NFCA_RF_CARD_F_SENS_RES 0x06 #define ST21NFCA_RF_CARD_F_SEL_RES 0x07 #define ST21NFCA_RF_CARD_F_DATARATE 0x08 #define ST21NFCA_RF_CARD_F_DATARATE_212_424 0x01 |
cebe22244 NFC: st21nfca: Cl... |
49 |
|
68957303f NFC: ST21NFCA: Ad... |
50 |
#define ST21NFCA_DEVICE_MGNT_PIPE 0x02 |
68957303f NFC: ST21NFCA: Ad... |
51 |
|
efaf956ad NFC: st21nfca: Cl... |
52 53 54 55 56 57 58 |
#define ST21NFCA_DM_GETINFO 0x13 #define ST21NFCA_DM_GETINFO_PIPE_LIST 0x02 #define ST21NFCA_DM_GETINFO_PIPE_INFO 0x01 #define ST21NFCA_DM_PIPE_CREATED 0x02 #define ST21NFCA_DM_PIPE_OPEN 0x04 #define ST21NFCA_DM_RF_ACTIVE 0x80 #define ST21NFCA_DM_DISCONNECT 0x30 |
58e1e0a92 NFC: st21nfca: Im... |
59 60 61 |
#define ST21NFCA_DM_IS_PIPE_OPEN(p) \ ((p & 0x0f) == (ST21NFCA_DM_PIPE_CREATED | ST21NFCA_DM_PIPE_OPEN)) |
efaf956ad NFC: st21nfca: Cl... |
62 |
#define ST21NFCA_NFC_MODE 0x03 /* NFC_MODE parameter*/ |
68957303f NFC: ST21NFCA: Ad... |
63 |
|
2130fb97f NFC: st21nfca: Ad... |
64 65 66 67 |
#define ST21NFCA_EVT_HOT_PLUG 0x03 #define ST21NFCA_EVT_HOT_PLUG_IS_INHIBITED(x) (x->data[0] & 0x80) #define ST21NFCA_SE_TO_PIPES 2000 |
68957303f NFC: ST21NFCA: Ad... |
68 69 70 |
static DECLARE_BITMAP(dev_mask, ST21NFCA_NUM_DEVICES); static struct nfc_hci_gate st21nfca_gates[] = { |
a779b8878 NFC: st21nfca: Im... |
71 |
{NFC_HCI_ADMIN_GATE, NFC_HCI_ADMIN_PIPE}, |
ba723199d NFC: st21nfca: Fi... |
72 73 |
{NFC_HCI_LINK_MGMT_GATE, NFC_HCI_LINK_MGMT_PIPE}, {ST21NFCA_DEVICE_MGNT_GATE, ST21NFCA_DEVICE_MGNT_PIPE}, |
68957303f NFC: ST21NFCA: Ad... |
74 75 |
{NFC_HCI_LOOPBACK_GATE, NFC_HCI_INVALID_PIPE}, {NFC_HCI_ID_MGMT_GATE, NFC_HCI_INVALID_PIPE}, |
68957303f NFC: ST21NFCA: Ad... |
76 77 |
{NFC_HCI_RF_READER_B_GATE, NFC_HCI_INVALID_PIPE}, {NFC_HCI_RF_READER_A_GATE, NFC_HCI_INVALID_PIPE}, |
68957303f NFC: ST21NFCA: Ad... |
78 79 |
{ST21NFCA_RF_READER_F_GATE, NFC_HCI_INVALID_PIPE}, {ST21NFCA_RF_READER_14443_3_A_GATE, NFC_HCI_INVALID_PIPE}, |
797472809 NFC: st21nfca: Ad... |
80 |
{ST21NFCA_RF_READER_ISO15693_GATE, NFC_HCI_INVALID_PIPE}, |
1892bf844 NFC: st21nfca: Ad... |
81 |
{ST21NFCA_RF_CARD_F_GATE, NFC_HCI_INVALID_PIPE}, |
2130fb97f NFC: st21nfca: Ad... |
82 83 84 85 |
/* Secure element pipes are created by secure element host */ {ST21NFCA_CONNECTIVITY_GATE, NFC_HCI_DO_NOT_CREATE_PIPE}, {ST21NFCA_APDU_READER_GATE, NFC_HCI_DO_NOT_CREATE_PIPE}, |
68957303f NFC: ST21NFCA: Ad... |
86 |
}; |
58e1e0a92 NFC: st21nfca: Im... |
87 88 89 90 91 92 93 |
struct st21nfca_pipe_info { u8 pipe_state; u8 src_host_id; u8 src_gate_id; u8 dst_host_id; u8 dst_gate_id; |
761a2c4f9 NFC: st21nfca: Ad... |
94 |
} __packed; |
58e1e0a92 NFC: st21nfca: Im... |
95 |
|
68957303f NFC: ST21NFCA: Ad... |
96 97 |
/* Largest headroom needed for outgoing custom commands */ #define ST21NFCA_CMDS_HEADROOM 7 |
58e1e0a92 NFC: st21nfca: Im... |
98 99 100 101 102 103 104 105 106 107 108 109 |
static int st21nfca_hci_load_session(struct nfc_hci_dev *hdev) { int i, j, r; struct sk_buff *skb_pipe_list, *skb_pipe_info; struct st21nfca_pipe_info *info; u8 pipe_list[] = { ST21NFCA_DM_GETINFO_PIPE_LIST, NFC_HCI_TERMINAL_HOST_ID }; u8 pipe_info[] = { ST21NFCA_DM_GETINFO_PIPE_INFO, NFC_HCI_TERMINAL_HOST_ID, 0 }; |
58e1e0a92 NFC: st21nfca: Im... |
110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 |
/* On ST21NFCA device pipes number are dynamics * A maximum of 16 pipes can be created at the same time * If pipes are already created, hci_dev_up will fail. * Doing a clear all pipe is a bad idea because: * - It does useless EEPROM cycling * - It might cause issue for secure elements support * (such as removing connectivity or APDU reader pipe) * A better approach on ST21NFCA is to: * - get a pipe list for each host. * (eg: NFC_HCI_HOST_CONTROLLER_ID for now). * (TODO Later on UICC HOST and eSE HOST) * - get pipe information * - match retrieved pipe list in st21nfca_gates * ST21NFCA_DEVICE_MGNT_GATE is a proprietary gate * with ST21NFCA_DEVICE_MGNT_PIPE. * Pipe can be closed and need to be open. */ r = nfc_hci_connect_gate(hdev, NFC_HCI_HOST_CONTROLLER_ID, |
2130fb97f NFC: st21nfca: Ad... |
128 129 |
ST21NFCA_DEVICE_MGNT_GATE, ST21NFCA_DEVICE_MGNT_PIPE); |
58e1e0a92 NFC: st21nfca: Im... |
130 |
if (r < 0) |
5a3570061 NFC: st21nfca: fi... |
131 |
return r; |
58e1e0a92 NFC: st21nfca: Im... |
132 133 134 135 136 137 |
/* Get pipe list */ r = nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE, ST21NFCA_DM_GETINFO, pipe_list, sizeof(pipe_list), &skb_pipe_list); if (r < 0) |
5a3570061 NFC: st21nfca: fi... |
138 |
return r; |
58e1e0a92 NFC: st21nfca: Im... |
139 140 141 142 143 144 145 |
/* Complete the existing gate_pipe table */ for (i = 0; i < skb_pipe_list->len; i++) { pipe_info[2] = skb_pipe_list->data[i]; r = nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE, ST21NFCA_DM_GETINFO, pipe_info, sizeof(pipe_info), &skb_pipe_info); |
58e1e0a92 NFC: st21nfca: Im... |
146 147 148 149 150 151 152 153 154 155 156 157 |
if (r) continue; /* * Match pipe ID and gate ID * Output format from ST21NFC_DM_GETINFO is: * - pipe state (1byte) * - source hid (1byte) * - source gid (1byte) * - destination hid (1byte) * - destination gid (1byte) */ |
e8efab6e6 NFC: st21nfca: Fi... |
158 |
info = (struct st21nfca_pipe_info *) skb_pipe_info->data; |
2130fb97f NFC: st21nfca: Ad... |
159 |
if (info->dst_gate_id == ST21NFCA_APDU_READER_GATE && |
7cb6ab590 nfc: st21nfca: A ... |
160 |
info->src_host_id == NFC_HCI_UICC_HOST_ID) { |
2130fb97f NFC: st21nfca: Ad... |
161 162 163 |
pr_err("Unexpected apdu_reader pipe on host %x ", info->src_host_id); |
5a3570061 NFC: st21nfca: fi... |
164 |
kfree_skb(skb_pipe_info); |
2130fb97f NFC: st21nfca: Ad... |
165 166 |
continue; } |
ba723199d NFC: st21nfca: Fi... |
167 |
for (j = 3; (j < ARRAY_SIZE(st21nfca_gates)) && |
2130fb97f NFC: st21nfca: Ad... |
168 |
(st21nfca_gates[j].gate != info->dst_gate_id) ; j++) |
58e1e0a92 NFC: st21nfca: Im... |
169 |
; |
e8efab6e6 NFC: st21nfca: Fi... |
170 171 |
if (j < ARRAY_SIZE(st21nfca_gates) && st21nfca_gates[j].gate == info->dst_gate_id && |
58e1e0a92 NFC: st21nfca: Im... |
172 |
ST21NFCA_DM_IS_PIPE_OPEN(info->pipe_state)) { |
92d108b6f NFC: st21nfca: Ke... |
173 |
hdev->init_data.gates[j].pipe = pipe_info[2]; |
2130fb97f NFC: st21nfca: Ad... |
174 |
|
58e1e0a92 NFC: st21nfca: Im... |
175 |
hdev->gate2pipe[st21nfca_gates[j].gate] = |
92d108b6f NFC: st21nfca: Ke... |
176 177 178 179 180 |
pipe_info[2]; hdev->pipes[pipe_info[2]].gate = st21nfca_gates[j].gate; hdev->pipes[pipe_info[2]].dest_host = info->src_host_id; |
58e1e0a92 NFC: st21nfca: Im... |
181 |
} |
5a3570061 NFC: st21nfca: fi... |
182 |
kfree_skb(skb_pipe_info); |
58e1e0a92 NFC: st21nfca: Im... |
183 |
} |
a779b8878 NFC: st21nfca: Im... |
184 185 |
/* |
6443ce97d NFC: st21nfca: Op... |
186 187 |
* 3 gates have a well known pipe ID. Only NFC_HCI_LINK_MGMT_GATE * is not yet open at this stage. |
a779b8878 NFC: st21nfca: Im... |
188 |
*/ |
6443ce97d NFC: st21nfca: Op... |
189 190 191 |
r = nfc_hci_connect_gate(hdev, NFC_HCI_HOST_CONTROLLER_ID, NFC_HCI_LINK_MGMT_GATE, NFC_HCI_LINK_MGMT_PIPE); |
a779b8878 NFC: st21nfca: Im... |
192 |
|
58e1e0a92 NFC: st21nfca: Im... |
193 194 195 |
kfree_skb(skb_pipe_list); return r; } |
68957303f NFC: ST21NFCA: Ad... |
196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212 213 214 215 216 217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 |
static int st21nfca_hci_open(struct nfc_hci_dev *hdev) { struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); int r; mutex_lock(&info->info_lock); if (info->state != ST21NFCA_ST_COLD) { r = -EBUSY; goto out; } r = info->phy_ops->enable(info->phy_id); if (r == 0) info->state = ST21NFCA_ST_READY; out: mutex_unlock(&info->info_lock); return r; } static void st21nfca_hci_close(struct nfc_hci_dev *hdev) { struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); mutex_lock(&info->info_lock); if (info->state == ST21NFCA_ST_COLD) goto out; info->phy_ops->disable(info->phy_id); info->state = ST21NFCA_ST_COLD; out: mutex_unlock(&info->info_lock); } static int st21nfca_hci_ready(struct nfc_hci_dev *hdev) { |
2130fb97f NFC: st21nfca: Ad... |
236 |
struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); |
68957303f NFC: ST21NFCA: Ad... |
237 238 239 |
struct sk_buff *skb; u8 param; |
2130fb97f NFC: st21nfca: Ad... |
240 241 |
u8 white_list[2]; int wl_size = 0; |
68957303f NFC: ST21NFCA: Ad... |
242 |
int r; |
d35cb20b4 nfc: st21nfca: Si... |
243 |
if (info->se_status->is_uicc_present) |
2130fb97f NFC: st21nfca: Ad... |
244 |
white_list[wl_size++] = NFC_HCI_UICC_HOST_ID; |
d35cb20b4 nfc: st21nfca: Si... |
245 |
if (info->se_status->is_ese_present) |
2130fb97f NFC: st21nfca: Ad... |
246 |
white_list[wl_size++] = ST21NFCA_ESE_HOST_ID; |
2130fb97f NFC: st21nfca: Ad... |
247 248 249 250 251 252 253 254 |
if (wl_size) { r = nfc_hci_set_param(hdev, NFC_HCI_ADMIN_GATE, NFC_HCI_ADMIN_WHITELIST, (u8 *) &white_list, wl_size); if (r < 0) return r; } |
68957303f NFC: ST21NFCA: Ad... |
255 256 257 258 259 260 |
/* Set NFC_MODE in device management gate to enable */ r = nfc_hci_get_param(hdev, ST21NFCA_DEVICE_MGNT_GATE, ST21NFCA_NFC_MODE, &skb); if (r < 0) return r; |
c490c557b NFC: st21nfca: Fi... |
261 262 263 |
param = skb->data[0]; kfree_skb(skb); if (param == 0) { |
68957303f NFC: ST21NFCA: Ad... |
264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 289 290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 |
param = 1; r = nfc_hci_set_param(hdev, ST21NFCA_DEVICE_MGNT_GATE, ST21NFCA_NFC_MODE, ¶m, 1); if (r < 0) return r; } r = nfc_hci_send_event(hdev, NFC_HCI_RF_READER_A_GATE, NFC_HCI_EVT_END_OPERATION, NULL, 0); if (r < 0) return r; r = nfc_hci_get_param(hdev, NFC_HCI_ID_MGMT_GATE, NFC_HCI_ID_MGMT_VERSION_SW, &skb); if (r < 0) return r; if (skb->len != FULL_VERSION_LEN) { kfree_skb(skb); return -EINVAL; } print_hex_dump(KERN_DEBUG, "FULL VERSION SOFTWARE INFO: ", DUMP_PREFIX_NONE, 16, 1, skb->data, FULL_VERSION_LEN, false); kfree_skb(skb); return 0; } static int st21nfca_hci_xmit(struct nfc_hci_dev *hdev, struct sk_buff *skb) { struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); return info->phy_ops->write(info->phy_id, skb); } static int st21nfca_hci_start_poll(struct nfc_hci_dev *hdev, u32 im_protocols, u32 tm_protocols) { int r; |
1892bf844 NFC: st21nfca: Ad... |
307 308 309 |
u32 pol_req; u8 param[19]; struct sk_buff *datarate_skb; |
68957303f NFC: ST21NFCA: Ad... |
310 311 312 313 314 315 316 317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 |
pr_info(DRIVER_DESC ": %s protocols 0x%x 0x%x ", __func__, im_protocols, tm_protocols); r = nfc_hci_send_event(hdev, NFC_HCI_RF_READER_A_GATE, NFC_HCI_EVT_END_OPERATION, NULL, 0); if (r < 0) return r; if (im_protocols) { /* * enable polling according to im_protocols & tm_protocols * - CLOSE pipe according to im_protocols & tm_protocols */ if ((NFC_HCI_RF_READER_B_GATE & im_protocols) == 0) { r = nfc_hci_disconnect_gate(hdev, NFC_HCI_RF_READER_B_GATE); if (r < 0) return r; } if ((NFC_HCI_RF_READER_A_GATE & im_protocols) == 0) { r = nfc_hci_disconnect_gate(hdev, NFC_HCI_RF_READER_A_GATE); if (r < 0) return r; } if ((ST21NFCA_RF_READER_F_GATE & im_protocols) == 0) { r = nfc_hci_disconnect_gate(hdev, ST21NFCA_RF_READER_F_GATE); if (r < 0) return r; |
1892bf844 NFC: st21nfca: Ad... |
343 344 345 346 347 348 349 350 351 352 353 354 355 356 357 358 359 |
} else { hdev->gb = nfc_get_local_general_bytes(hdev->ndev, &hdev->gb_len); if (hdev->gb == NULL || hdev->gb_len == 0) { im_protocols &= ~NFC_PROTO_NFC_DEP_MASK; tm_protocols &= ~NFC_PROTO_NFC_DEP_MASK; } param[0] = ST21NFCA_RF_READER_F_DATARATE_106 | ST21NFCA_RF_READER_F_DATARATE_212 | ST21NFCA_RF_READER_F_DATARATE_424; r = nfc_hci_set_param(hdev, ST21NFCA_RF_READER_F_GATE, ST21NFCA_RF_READER_F_DATARATE, param, 1); if (r < 0) return r; |
6ae3ed1c5 NFC: st21nfca: Fi... |
360 361 |
pol_req = be32_to_cpu((__force __be32) ST21NFCA_RF_READER_F_POL_REQ_DEFAULT); |
1892bf844 NFC: st21nfca: Ad... |
362 363 364 365 366 |
r = nfc_hci_set_param(hdev, ST21NFCA_RF_READER_F_GATE, ST21NFCA_RF_READER_F_POL_REQ, (u8 *) &pol_req, 4); if (r < 0) return r; |
68957303f NFC: ST21NFCA: Ad... |
367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 |
} if ((ST21NFCA_RF_READER_14443_3_A_GATE & im_protocols) == 0) { r = nfc_hci_disconnect_gate(hdev, ST21NFCA_RF_READER_14443_3_A_GATE); if (r < 0) return r; } if ((ST21NFCA_RF_READER_ISO15693_GATE & im_protocols) == 0) { r = nfc_hci_disconnect_gate(hdev, ST21NFCA_RF_READER_ISO15693_GATE); if (r < 0) return r; } r = nfc_hci_send_event(hdev, NFC_HCI_RF_READER_A_GATE, NFC_HCI_EVT_READER_REQUESTED, NULL, 0); if (r < 0) nfc_hci_send_event(hdev, NFC_HCI_RF_READER_A_GATE, NFC_HCI_EVT_END_OPERATION, NULL, 0); } |
1892bf844 NFC: st21nfca: Ad... |
389 390 391 392 393 394 395 396 397 398 399 400 401 402 403 404 |
if (tm_protocols & NFC_PROTO_NFC_DEP_MASK) { r = nfc_hci_get_param(hdev, ST21NFCA_RF_CARD_F_GATE, ST21NFCA_RF_CARD_F_DATARATE, &datarate_skb); if (r < 0) return r; /* Configure the maximum supported datarate to 424Kbps */ if (datarate_skb->len > 0 && datarate_skb->data[0] != ST21NFCA_RF_CARD_F_DATARATE_212_424) { param[0] = ST21NFCA_RF_CARD_F_DATARATE_212_424; r = nfc_hci_set_param(hdev, ST21NFCA_RF_CARD_F_GATE, ST21NFCA_RF_CARD_F_DATARATE, param, 1); |
c490c557b NFC: st21nfca: Fi... |
405 406 |
if (r < 0) { kfree_skb(datarate_skb); |
1892bf844 NFC: st21nfca: Ad... |
407 |
return r; |
c490c557b NFC: st21nfca: Fi... |
408 |
} |
1892bf844 NFC: st21nfca: Ad... |
409 |
} |
c490c557b NFC: st21nfca: Fi... |
410 |
kfree_skb(datarate_skb); |
1892bf844 NFC: st21nfca: Ad... |
411 412 413 414 415 416 417 418 419 420 421 422 423 424 425 426 427 428 429 430 431 432 433 434 435 436 437 438 439 440 441 442 443 444 445 446 447 448 449 450 451 452 453 454 455 456 457 458 459 460 461 462 463 464 465 466 467 468 469 470 471 472 473 474 475 476 477 478 479 |
/* * Configure sens_res * * NFC Forum Digital Spec Table 7: * NFCID1 size: triple (10 bytes) */ param[0] = 0x00; param[1] = 0x08; r = nfc_hci_set_param(hdev, ST21NFCA_RF_CARD_F_GATE, ST21NFCA_RF_CARD_F_SENS_RES, param, 2); if (r < 0) return r; /* * Configure sel_res * * NFC Forum Digistal Spec Table 17: * b3 set to 0b (value b7-b6): * - 10b: Configured for NFC-DEP Protocol */ param[0] = 0x40; r = nfc_hci_set_param(hdev, ST21NFCA_RF_CARD_F_GATE, ST21NFCA_RF_CARD_F_SEL_RES, param, 1); if (r < 0) return r; /* Configure NFCID1 Random uid */ r = nfc_hci_set_param(hdev, ST21NFCA_RF_CARD_F_GATE, ST21NFCA_RF_CARD_F_NFCID1, NULL, 0); if (r < 0) return r; /* Configure NFCID2_LIST */ /* System Code */ param[0] = 0x00; param[1] = 0x00; /* NFCID2 */ param[2] = 0x01; param[3] = 0xfe; param[4] = 'S'; param[5] = 'T'; param[6] = 'M'; param[7] = 'i'; param[8] = 'c'; param[9] = 'r'; /* 8 byte Pad bytes used for polling respone frame */ /* * Configuration byte: * - bit 0: define the default NFCID2 entry used when the * system code is equal to 'FFFF' * - bit 1: use a random value for lowest 6 bytes of * NFCID2 value * - bit 2: ignore polling request frame if request code * is equal to '01' * - Other bits are RFU */ param[18] = 0x01; r = nfc_hci_set_param(hdev, ST21NFCA_RF_CARD_F_GATE, ST21NFCA_RF_CARD_F_NFCID2_LIST, param, 19); if (r < 0) return r; param[0] = 0x02; r = nfc_hci_set_param(hdev, ST21NFCA_RF_CARD_F_GATE, ST21NFCA_RF_CARD_F_MODE, param, 1); } |
68957303f NFC: ST21NFCA: Ad... |
480 481 |
return r; } |
d57d74eb7 NFC: st21nfca: Im... |
482 483 484 485 486 |
static void st21nfca_hci_stop_poll(struct nfc_hci_dev *hdev) { nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE, ST21NFCA_DM_DISCONNECT, NULL, 0, NULL); } |
68957303f NFC: ST21NFCA: Ad... |
487 488 489 490 491 492 493 494 495 496 497 498 499 500 |
static int st21nfca_get_iso14443_3_atqa(struct nfc_hci_dev *hdev, u16 *atqa) { int r; struct sk_buff *atqa_skb = NULL; r = nfc_hci_get_param(hdev, ST21NFCA_RF_READER_14443_3_A_GATE, ST21NFCA_RF_READER_14443_3_A_ATQA, &atqa_skb); if (r < 0) goto exit; if (atqa_skb->len != 2) { r = -EPROTO; goto exit; } |
cc3a9f725 NFC: st21nfca: Fi... |
501 |
*atqa = be16_to_cpu(*(__be16 *) atqa_skb->data); |
68957303f NFC: ST21NFCA: Ad... |
502 503 504 505 506 507 508 509 510 511 512 513 514 515 516 517 518 519 520 521 522 523 524 525 526 527 528 |
exit: kfree_skb(atqa_skb); return r; } static int st21nfca_get_iso14443_3_sak(struct nfc_hci_dev *hdev, u8 *sak) { int r; struct sk_buff *sak_skb = NULL; r = nfc_hci_get_param(hdev, ST21NFCA_RF_READER_14443_3_A_GATE, ST21NFCA_RF_READER_14443_3_A_SAK, &sak_skb); if (r < 0) goto exit; if (sak_skb->len != 1) { r = -EPROTO; goto exit; } *sak = sak_skb->data[0]; exit: kfree_skb(sak_skb); return r; } |
a8f686ec1 NFC: st21nfca: Ch... |
529 |
static int st21nfca_get_iso14443_3_uid(struct nfc_hci_dev *hdev, u8 *uid, |
68957303f NFC: ST21NFCA: Ad... |
530 531 532 533 534 535 536 537 538 539 540 541 542 543 |
int *len) { int r; struct sk_buff *uid_skb = NULL; r = nfc_hci_get_param(hdev, ST21NFCA_RF_READER_14443_3_A_GATE, ST21NFCA_RF_READER_14443_3_A_UID, &uid_skb); if (r < 0) goto exit; if (uid_skb->len == 0 || uid_skb->len > NFC_NFCID1_MAXSIZE) { r = -EPROTO; goto exit; } |
a8f686ec1 NFC: st21nfca: Ch... |
544 |
memcpy(uid, uid_skb->data, uid_skb->len); |
68957303f NFC: ST21NFCA: Ad... |
545 546 547 548 549 |
*len = uid_skb->len; exit: kfree_skb(uid_skb); return r; } |
797472809 NFC: st21nfca: Ad... |
550 551 552 553 554 555 556 557 558 559 560 561 562 563 564 565 566 567 568 569 570 571 572 573 574 575 576 |
static int st21nfca_get_iso15693_inventory(struct nfc_hci_dev *hdev, struct nfc_target *target) { int r; struct sk_buff *inventory_skb = NULL; r = nfc_hci_get_param(hdev, ST21NFCA_RF_READER_ISO15693_GATE, ST21NFCA_RF_READER_ISO15693_INVENTORY, &inventory_skb); if (r < 0) goto exit; skb_pull(inventory_skb, 2); if (inventory_skb->len == 0 || inventory_skb->len > NFC_ISO15693_UID_MAXSIZE) { r = -EPROTO; goto exit; } memcpy(target->iso15693_uid, inventory_skb->data, inventory_skb->len); target->iso15693_dsfid = inventory_skb->data[1]; target->is_iso15693 = 1; exit: kfree_skb(inventory_skb); return r; } |
1892bf844 NFC: st21nfca: Ad... |
577 578 579 580 581 582 583 584 585 586 587 588 589 590 591 592 593 594 595 |
static int st21nfca_hci_dep_link_up(struct nfc_hci_dev *hdev, struct nfc_target *target, u8 comm_mode, u8 *gb, size_t gb_len) { struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); info->dep_info.idx = target->idx; return st21nfca_im_send_atr_req(hdev, gb, gb_len); } static int st21nfca_hci_dep_link_down(struct nfc_hci_dev *hdev) { struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); info->state = ST21NFCA_ST_READY; return nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE, ST21NFCA_DM_DISCONNECT, NULL, 0, NULL); } |
68957303f NFC: ST21NFCA: Ad... |
596 597 598 599 600 601 602 603 604 605 606 607 608 609 610 611 612 613 614 615 616 617 618 619 620 621 622 623 624 625 626 627 628 629 630 631 632 633 634 635 636 |
static int st21nfca_hci_target_from_gate(struct nfc_hci_dev *hdev, u8 gate, struct nfc_target *target) { int r, len; u16 atqa; u8 sak; u8 uid[NFC_NFCID1_MAXSIZE]; switch (gate) { case ST21NFCA_RF_READER_F_GATE: target->supported_protocols = NFC_PROTO_FELICA_MASK; break; case ST21NFCA_RF_READER_14443_3_A_GATE: /* ISO14443-3 type 1 or 2 tags */ r = st21nfca_get_iso14443_3_atqa(hdev, &atqa); if (r < 0) return r; if (atqa == 0x000c) { target->supported_protocols = NFC_PROTO_JEWEL_MASK; target->sens_res = 0x0c00; } else { r = st21nfca_get_iso14443_3_sak(hdev, &sak); if (r < 0) return r; r = st21nfca_get_iso14443_3_uid(hdev, uid, &len); if (r < 0) return r; target->supported_protocols = nfc_hci_sak_to_protocol(sak); if (target->supported_protocols == 0xffffffff) return -EPROTO; target->sens_res = atqa; target->sel_res = sak; memcpy(target->nfcid1, uid, len); target->nfcid1_len = len; } break; |
797472809 NFC: st21nfca: Ad... |
637 638 639 640 641 642 |
case ST21NFCA_RF_READER_ISO15693_GATE: target->supported_protocols = NFC_PROTO_ISO15693_MASK; r = st21nfca_get_iso15693_inventory(hdev, target); if (r < 0) return r; break; |
68957303f NFC: ST21NFCA: Ad... |
643 644 645 646 647 648 |
default: return -EPROTO; } return 0; } |
1892bf844 NFC: st21nfca: Ad... |
649 650 651 652 653 |
static int st21nfca_hci_complete_target_discovered(struct nfc_hci_dev *hdev, u8 gate, struct nfc_target *target) { int r; |
c490c557b NFC: st21nfca: Fi... |
654 |
struct sk_buff *nfcid_skb = NULL; |
1892bf844 NFC: st21nfca: Ad... |
655 656 657 |
if (gate == ST21NFCA_RF_READER_F_GATE) { r = nfc_hci_get_param(hdev, ST21NFCA_RF_READER_F_GATE, |
c490c557b NFC: st21nfca: Fi... |
658 |
ST21NFCA_RF_READER_F_NFCID2, &nfcid_skb); |
1892bf844 NFC: st21nfca: Ad... |
659 660 |
if (r < 0) goto exit; |
c490c557b NFC: st21nfca: Fi... |
661 |
if (nfcid_skb->len > NFC_SENSF_RES_MAXSIZE) { |
1892bf844 NFC: st21nfca: Ad... |
662 663 664 665 666 667 668 669 670 671 672 |
r = -EPROTO; goto exit; } /* * - After the recepton of polling response for type F frame * at 212 or 424 Kbit/s, NFCID2 registry parameters will be * updated. * - After the reception of SEL_RES with NFCIP-1 compliant bit * set for type A frame NFCID1 will be updated */ |
c490c557b NFC: st21nfca: Fi... |
673 |
if (nfcid_skb->len > 0) { |
1892bf844 NFC: st21nfca: Ad... |
674 |
/* P2P in type F */ |
c490c557b NFC: st21nfca: Fi... |
675 676 677 |
memcpy(target->sensf_res, nfcid_skb->data, nfcid_skb->len); target->sensf_res_len = nfcid_skb->len; |
1892bf844 NFC: st21nfca: Ad... |
678 679 680 681 682 683 684 685 686 |
/* NFC Forum Digital Protocol Table 44 */ if (target->sensf_res[0] == 0x01 && target->sensf_res[1] == 0xfe) target->supported_protocols = NFC_PROTO_NFC_DEP_MASK; else target->supported_protocols = NFC_PROTO_FELICA_MASK; } else { |
c490c557b NFC: st21nfca: Fi... |
687 |
kfree_skb(nfcid_skb); |
99a8efbb6 NFC: st21nfca: fi... |
688 |
nfcid_skb = NULL; |
1892bf844 NFC: st21nfca: Ad... |
689 690 691 |
/* P2P in type A */ r = nfc_hci_get_param(hdev, ST21NFCA_RF_READER_F_GATE, ST21NFCA_RF_READER_F_NFCID1, |
c490c557b NFC: st21nfca: Fi... |
692 |
&nfcid_skb); |
1892bf844 NFC: st21nfca: Ad... |
693 694 |
if (r < 0) goto exit; |
c490c557b NFC: st21nfca: Fi... |
695 |
if (nfcid_skb->len > NFC_NFCID1_MAXSIZE) { |
1892bf844 NFC: st21nfca: Ad... |
696 697 698 |
r = -EPROTO; goto exit; } |
c490c557b NFC: st21nfca: Fi... |
699 700 701 |
memcpy(target->sensf_res, nfcid_skb->data, nfcid_skb->len); target->sensf_res_len = nfcid_skb->len; |
1892bf844 NFC: st21nfca: Ad... |
702 703 704 705 706 707 |
target->supported_protocols = NFC_PROTO_NFC_DEP_MASK; } target->hci_reader_gate = ST21NFCA_RF_READER_F_GATE; } r = 1; exit: |
c490c557b NFC: st21nfca: Fi... |
708 |
kfree_skb(nfcid_skb); |
1892bf844 NFC: st21nfca: Ad... |
709 710 |
return r; } |
797472809 NFC: st21nfca: Ad... |
711 712 713 714 715 716 717 718 719 720 721 722 723 724 725 726 727 728 |
#define ST21NFCA_CB_TYPE_READER_ISO15693 1 static void st21nfca_hci_data_exchange_cb(void *context, struct sk_buff *skb, int err) { struct st21nfca_hci_info *info = context; switch (info->async_cb_type) { case ST21NFCA_CB_TYPE_READER_ISO15693: if (err == 0) skb_trim(skb, skb->len - 1); info->async_cb(info->async_cb_context, skb, err); break; default: if (err == 0) kfree_skb(skb); break; } } |
68957303f NFC: ST21NFCA: Ad... |
729 730 731 732 733 734 735 736 737 738 |
/* * Returns: * <= 0: driver handled the data exchange * 1: driver doesn't especially handle, please do standard processing */ static int st21nfca_hci_im_transceive(struct nfc_hci_dev *hdev, struct nfc_target *target, struct sk_buff *skb, data_exchange_cb_t cb, void *cb_context) { |
797472809 NFC: st21nfca: Ad... |
739 |
struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); |
68957303f NFC: ST21NFCA: Ad... |
740 741 742 743 744 745 |
pr_info(DRIVER_DESC ": %s for gate=%d len=%d ", __func__, target->hci_reader_gate, skb->len); switch (target->hci_reader_gate) { case ST21NFCA_RF_READER_F_GATE: |
1892bf844 NFC: st21nfca: Ad... |
746 747 |
if (target->supported_protocols == NFC_PROTO_NFC_DEP_MASK) return st21nfca_im_send_dep_req(hdev, skb); |
d58ff3512 networking: make ... |
748 |
*(u8 *)skb_push(skb, 1) = 0x1a; |
68957303f NFC: ST21NFCA: Ad... |
749 750 751 752 |
return nfc_hci_send_cmd_async(hdev, target->hci_reader_gate, ST21NFCA_WR_XCHG_DATA, skb->data, skb->len, cb, cb_context); case ST21NFCA_RF_READER_14443_3_A_GATE: |
d58ff3512 networking: make ... |
753 |
*(u8 *)skb_push(skb, 1) = 0x1a; /* CTR, see spec:10.2.2.1 */ |
68957303f NFC: ST21NFCA: Ad... |
754 755 756 757 |
return nfc_hci_send_cmd_async(hdev, target->hci_reader_gate, ST21NFCA_WR_XCHG_DATA, skb->data, skb->len, cb, cb_context); |
797472809 NFC: st21nfca: Ad... |
758 759 760 761 |
case ST21NFCA_RF_READER_ISO15693_GATE: info->async_cb_type = ST21NFCA_CB_TYPE_READER_ISO15693; info->async_cb = cb; info->async_cb_context = cb_context; |
d58ff3512 networking: make ... |
762 |
*(u8 *)skb_push(skb, 1) = 0x17; |
797472809 NFC: st21nfca: Ad... |
763 764 765 766 767 768 |
return nfc_hci_send_cmd_async(hdev, target->hci_reader_gate, ST21NFCA_WR_XCHG_DATA, skb->data, skb->len, st21nfca_hci_data_exchange_cb, info); |
68957303f NFC: ST21NFCA: Ad... |
769 770 771 772 |
default: return 1; } } |
1892bf844 NFC: st21nfca: Ad... |
773 774 775 776 |
static int st21nfca_hci_tm_send(struct nfc_hci_dev *hdev, struct sk_buff *skb) { return st21nfca_tm_send_dep_res(hdev, skb); } |
68957303f NFC: ST21NFCA: Ad... |
777 778 779 780 |
static int st21nfca_hci_check_presence(struct nfc_hci_dev *hdev, struct nfc_target *target) { u8 fwi = 0x11; |
3e6df9191 NFC: st21nfca: Fi... |
781 |
|
68957303f NFC: ST21NFCA: Ad... |
782 783 784 785 786 787 788 789 790 791 792 793 794 795 796 797 798 799 800 801 |
switch (target->hci_reader_gate) { case NFC_HCI_RF_READER_A_GATE: case NFC_HCI_RF_READER_B_GATE: /* * PRESENCE_CHECK on those gates is available * However, the answer to this command is taking 3 * fwi * if the card is no present. * Instead, we send an empty I-Frame with a very short * configurable fwi ~604µs. */ return nfc_hci_send_cmd(hdev, target->hci_reader_gate, ST21NFCA_WR_XCHG_DATA, &fwi, 1, NULL); case ST21NFCA_RF_READER_14443_3_A_GATE: return nfc_hci_send_cmd(hdev, target->hci_reader_gate, ST21NFCA_RF_READER_CMD_PRESENCE_CHECK, NULL, 0, NULL); default: return -EOPNOTSUPP; } } |
2130fb97f NFC: st21nfca: Ad... |
802 803 804 805 806 807 808 809 810 811 812 813 814 815 816 817 818 819 820 821 822 823 824 825 826 827 828 829 830 831 832 833 834 835 836 837 838 839 840 841 842 843 844 845 846 847 848 |
static void st21nfca_hci_cmd_received(struct nfc_hci_dev *hdev, u8 pipe, u8 cmd, struct sk_buff *skb) { struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); u8 gate = hdev->pipes[pipe].gate; pr_debug("cmd: %x ", cmd); switch (cmd) { case NFC_HCI_ANY_OPEN_PIPE: if (gate != ST21NFCA_APDU_READER_GATE && hdev->pipes[pipe].dest_host != NFC_HCI_UICC_HOST_ID) info->se_info.count_pipes++; if (info->se_info.count_pipes == info->se_info.expected_pipes) { del_timer_sync(&info->se_info.se_active_timer); info->se_info.se_active = false; info->se_info.count_pipes = 0; complete(&info->se_info.req_completion); } break; } } static int st21nfca_admin_event_received(struct nfc_hci_dev *hdev, u8 event, struct sk_buff *skb) { struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); pr_debug("admin event: %x ", event); switch (event) { case ST21NFCA_EVT_HOT_PLUG: if (info->se_info.se_active) { if (!ST21NFCA_EVT_HOT_PLUG_IS_INHIBITED(skb)) { del_timer_sync(&info->se_info.se_active_timer); info->se_info.se_active = false; complete(&info->se_info.req_completion); } else { mod_timer(&info->se_info.se_active_timer, jiffies + msecs_to_jiffies(ST21NFCA_SE_TO_PIPES)); } } break; |
a9e062d05 NFC: st21nfca: Ad... |
849 850 851 |
default: nfc_err(&hdev->ndev->dev, "Unexpected event on admin gate "); |
2130fb97f NFC: st21nfca: Ad... |
852 853 854 855 |
} kfree_skb(skb); return 0; } |
1892bf844 NFC: st21nfca: Ad... |
856 857 858 859 860 |
/* * Returns: * <= 0: driver handled the event, skb consumed * 1: driver does not handle the event, please do standard processing */ |
2130fb97f NFC: st21nfca: Ad... |
861 |
static int st21nfca_hci_event_received(struct nfc_hci_dev *hdev, u8 pipe, |
1892bf844 NFC: st21nfca: Ad... |
862 863 |
u8 event, struct sk_buff *skb) { |
2130fb97f NFC: st21nfca: Ad... |
864 865 |
u8 gate = hdev->pipes[pipe].gate; u8 host = hdev->pipes[pipe].dest_host; |
a4415e761 NFC: st21nfca: Re... |
866 867 |
pr_debug("hci event: %d gate: %x ", event, gate); |
1892bf844 NFC: st21nfca: Ad... |
868 |
|
a4415e761 NFC: st21nfca: Re... |
869 |
switch (gate) { |
2130fb97f NFC: st21nfca: Ad... |
870 871 |
case NFC_HCI_ADMIN_GATE: return st21nfca_admin_event_received(hdev, event, skb); |
a4415e761 NFC: st21nfca: Re... |
872 873 |
case ST21NFCA_RF_CARD_F_GATE: return st21nfca_dep_event_received(hdev, event, skb); |
2130fb97f NFC: st21nfca: Ad... |
874 875 876 877 878 |
case ST21NFCA_CONNECTIVITY_GATE: return st21nfca_connectivity_event_received(hdev, host, event, skb); case ST21NFCA_APDU_READER_GATE: return st21nfca_apdu_reader_event_received(hdev, event, skb); |
15d17170b NFC: st21nfca: Ad... |
879 880 |
case NFC_HCI_LOOPBACK_GATE: return st21nfca_hci_loopback_event_received(hdev, event, skb); |
1892bf844 NFC: st21nfca: Ad... |
881 882 883 |
default: return 1; } |
1892bf844 NFC: st21nfca: Ad... |
884 |
} |
68957303f NFC: ST21NFCA: Ad... |
885 886 887 |
static struct nfc_hci_ops st21nfca_hci_ops = { .open = st21nfca_hci_open, .close = st21nfca_hci_close, |
58e1e0a92 NFC: st21nfca: Im... |
888 |
.load_session = st21nfca_hci_load_session, |
68957303f NFC: ST21NFCA: Ad... |
889 890 891 |
.hci_ready = st21nfca_hci_ready, .xmit = st21nfca_hci_xmit, .start_poll = st21nfca_hci_start_poll, |
d57d74eb7 NFC: st21nfca: Im... |
892 |
.stop_poll = st21nfca_hci_stop_poll, |
1892bf844 NFC: st21nfca: Ad... |
893 894 |
.dep_link_up = st21nfca_hci_dep_link_up, .dep_link_down = st21nfca_hci_dep_link_down, |
68957303f NFC: ST21NFCA: Ad... |
895 |
.target_from_gate = st21nfca_hci_target_from_gate, |
1892bf844 NFC: st21nfca: Ad... |
896 |
.complete_target_discovered = st21nfca_hci_complete_target_discovered, |
68957303f NFC: ST21NFCA: Ad... |
897 |
.im_transceive = st21nfca_hci_im_transceive, |
1892bf844 NFC: st21nfca: Ad... |
898 |
.tm_send = st21nfca_hci_tm_send, |
68957303f NFC: ST21NFCA: Ad... |
899 |
.check_presence = st21nfca_hci_check_presence, |
1892bf844 NFC: st21nfca: Ad... |
900 |
.event_received = st21nfca_hci_event_received, |
2130fb97f NFC: st21nfca: Ad... |
901 902 903 904 905 |
.cmd_received = st21nfca_hci_cmd_received, .discover_se = st21nfca_hci_discover_se, .enable_se = st21nfca_hci_enable_se, .disable_se = st21nfca_hci_disable_se, .se_io = st21nfca_hci_se_io, |
68957303f NFC: ST21NFCA: Ad... |
906 907 908 909 |
}; int st21nfca_hci_probe(void *phy_id, struct nfc_phy_ops *phy_ops, char *llc_name, int phy_headroom, int phy_tailroom, |
2130fb97f NFC: st21nfca: Ad... |
910 911 |
int phy_payload, struct nfc_hci_dev **hdev, struct st21nfca_se_status *se_status) |
68957303f NFC: ST21NFCA: Ad... |
912 913 914 915 916 917 918 919 920 |
{ struct st21nfca_hci_info *info; int r = 0; int dev_num; u32 protocols; struct nfc_hci_init_data init_data; unsigned long quirks = 0; info = kzalloc(sizeof(struct st21nfca_hci_info), GFP_KERNEL); |
8f79ded95 NFC: st21nfca: Fi... |
921 922 |
if (!info) return -ENOMEM; |
68957303f NFC: ST21NFCA: Ad... |
923 924 925 926 927 928 929 930 931 932 933 934 935 936 937 |
info->phy_ops = phy_ops; info->phy_id = phy_id; info->state = ST21NFCA_ST_COLD; mutex_init(&info->info_lock); init_data.gate_count = ARRAY_SIZE(st21nfca_gates); memcpy(init_data.gates, st21nfca_gates, sizeof(st21nfca_gates)); /* * Session id must include the driver name + i2c bus addr * persistent info to discriminate 2 identical chips */ dev_num = find_first_zero_bit(dev_mask, ST21NFCA_NUM_DEVICES); |
8f79ded95 NFC: st21nfca: Fi... |
938 939 940 941 |
if (dev_num >= ST21NFCA_NUM_DEVICES) { r = -ENODEV; goto err_alloc_hdev; } |
9ec1f58b9 NFC: st21nfca: Fi... |
942 943 |
set_bit(dev_num, dev_mask); |
68957303f NFC: ST21NFCA: Ad... |
944 945 946 947 948 949 950 951 |
scnprintf(init_data.session_id, sizeof(init_data.session_id), "%s%2x", "ST21AH", dev_num); protocols = NFC_PROTO_JEWEL_MASK | NFC_PROTO_MIFARE_MASK | NFC_PROTO_FELICA_MASK | NFC_PROTO_ISO14443_MASK | |
797472809 NFC: st21nfca: Ad... |
952 |
NFC_PROTO_ISO14443_B_MASK | |
1892bf844 NFC: st21nfca: Ad... |
953 954 |
NFC_PROTO_ISO15693_MASK | NFC_PROTO_NFC_DEP_MASK; |
68957303f NFC: ST21NFCA: Ad... |
955 956 957 958 959 960 961 962 963 964 965 966 967 968 969 |
set_bit(NFC_HCI_QUIRK_SHORT_CLEAR, &quirks); info->hdev = nfc_hci_allocate_device(&st21nfca_hci_ops, &init_data, quirks, protocols, llc_name, phy_headroom + ST21NFCA_CMDS_HEADROOM, phy_tailroom, phy_payload); if (!info->hdev) { pr_err("Cannot allocate nfc hdev. "); r = -ENOMEM; goto err_alloc_hdev; } |
2130fb97f NFC: st21nfca: Ad... |
970 |
info->se_status = se_status; |
68957303f NFC: ST21NFCA: Ad... |
971 972 973 974 975 976 977 |
nfc_hci_set_clientdata(info->hdev, info); r = nfc_hci_register_device(info->hdev); if (r) goto err_regdev; *hdev = info->hdev; |
1892bf844 NFC: st21nfca: Ad... |
978 |
st21nfca_dep_init(info->hdev); |
2130fb97f NFC: st21nfca: Ad... |
979 |
st21nfca_se_init(info->hdev); |
15d17170b NFC: st21nfca: Ad... |
980 |
st21nfca_vendor_cmds_init(info->hdev); |
68957303f NFC: ST21NFCA: Ad... |
981 982 983 984 985 986 987 988 989 990 991 992 993 994 995 996 |
return 0; err_regdev: nfc_hci_free_device(info->hdev); err_alloc_hdev: kfree(info); return r; } EXPORT_SYMBOL(st21nfca_hci_probe); void st21nfca_hci_remove(struct nfc_hci_dev *hdev) { struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev); |
1892bf844 NFC: st21nfca: Ad... |
997 |
st21nfca_dep_deinit(hdev); |
2130fb97f NFC: st21nfca: Ad... |
998 |
st21nfca_se_deinit(hdev); |
68957303f NFC: ST21NFCA: Ad... |
999 1000 1001 1002 1003 1004 1005 1006 |
nfc_hci_unregister_device(hdev); nfc_hci_free_device(hdev); kfree(info); } EXPORT_SYMBOL(st21nfca_hci_remove); MODULE_LICENSE("GPL"); MODULE_DESCRIPTION(DRIVER_DESC); |