rsp.c 9.4 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * The NFC Controller Interface is the communication protocol between an
  4. * NFC Controller (NFCC) and a Device Host (DH).
  5. *
  6. * Copyright (C) 2011 Texas Instruments, Inc.
  7. *
  8. * Written by Ilan Elias <ilane@ti.com>
  9. *
  10. * Acknowledgements:
  11. * This file is based on hci_event.c, which was written
  12. * by Maxim Krasnyansky.
  13. */
  14. #define pr_fmt(fmt) KBUILD_MODNAME ": %s: " fmt, __func__
  15. #include <linux/types.h>
  16. #include <linux/interrupt.h>
  17. #include <linux/bitops.h>
  18. #include <linux/skbuff.h>
  19. #include "../nfc.h"
  20. #include <net/nfc/nci.h>
  21. #include <net/nfc/nci_core.h>
  22. /* Handle NCI Response packets */
  23. static void nci_core_reset_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
  24. {
  25. struct nci_core_reset_rsp *rsp = (void *) skb->data;
  26. pr_debug("status 0x%x\n", rsp->status);
  27. if (rsp->status == NCI_STATUS_OK) {
  28. ndev->nci_ver = rsp->nci_ver;
  29. pr_debug("nci_ver 0x%x, config_status 0x%x\n",
  30. rsp->nci_ver, rsp->config_status);
  31. }
  32. nci_req_complete(ndev, rsp->status);
  33. }
  34. static void nci_core_init_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
  35. {
  36. struct nci_core_init_rsp_1 *rsp_1 = (void *) skb->data;
  37. struct nci_core_init_rsp_2 *rsp_2;
  38. pr_debug("status 0x%x\n", rsp_1->status);
  39. if (rsp_1->status != NCI_STATUS_OK)
  40. goto exit;
  41. ndev->nfcc_features = __le32_to_cpu(rsp_1->nfcc_features);
  42. ndev->num_supported_rf_interfaces = rsp_1->num_supported_rf_interfaces;
  43. if (ndev->num_supported_rf_interfaces >
  44. NCI_MAX_SUPPORTED_RF_INTERFACES) {
  45. ndev->num_supported_rf_interfaces =
  46. NCI_MAX_SUPPORTED_RF_INTERFACES;
  47. }
  48. memcpy(ndev->supported_rf_interfaces,
  49. rsp_1->supported_rf_interfaces,
  50. ndev->num_supported_rf_interfaces);
  51. rsp_2 = (void *) (skb->data + 6 + rsp_1->num_supported_rf_interfaces);
  52. ndev->max_logical_connections = rsp_2->max_logical_connections;
  53. ndev->max_routing_table_size =
  54. __le16_to_cpu(rsp_2->max_routing_table_size);
  55. ndev->max_ctrl_pkt_payload_len =
  56. rsp_2->max_ctrl_pkt_payload_len;
  57. ndev->max_size_for_large_params =
  58. __le16_to_cpu(rsp_2->max_size_for_large_params);
  59. ndev->manufact_id =
  60. rsp_2->manufact_id;
  61. ndev->manufact_specific_info =
  62. __le32_to_cpu(rsp_2->manufact_specific_info);
  63. pr_debug("nfcc_features 0x%x\n",
  64. ndev->nfcc_features);
  65. pr_debug("num_supported_rf_interfaces %d\n",
  66. ndev->num_supported_rf_interfaces);
  67. pr_debug("supported_rf_interfaces[0] 0x%x\n",
  68. ndev->supported_rf_interfaces[0]);
  69. pr_debug("supported_rf_interfaces[1] 0x%x\n",
  70. ndev->supported_rf_interfaces[1]);
  71. pr_debug("supported_rf_interfaces[2] 0x%x\n",
  72. ndev->supported_rf_interfaces[2]);
  73. pr_debug("supported_rf_interfaces[3] 0x%x\n",
  74. ndev->supported_rf_interfaces[3]);
  75. pr_debug("max_logical_connections %d\n",
  76. ndev->max_logical_connections);
  77. pr_debug("max_routing_table_size %d\n",
  78. ndev->max_routing_table_size);
  79. pr_debug("max_ctrl_pkt_payload_len %d\n",
  80. ndev->max_ctrl_pkt_payload_len);
  81. pr_debug("max_size_for_large_params %d\n",
  82. ndev->max_size_for_large_params);
  83. pr_debug("manufact_id 0x%x\n",
  84. ndev->manufact_id);
  85. pr_debug("manufact_specific_info 0x%x\n",
  86. ndev->manufact_specific_info);
  87. exit:
  88. nci_req_complete(ndev, rsp_1->status);
  89. }
  90. static void nci_core_set_config_rsp_packet(struct nci_dev *ndev,
  91. struct sk_buff *skb)
  92. {
  93. struct nci_core_set_config_rsp *rsp = (void *) skb->data;
  94. pr_debug("status 0x%x\n", rsp->status);
  95. nci_req_complete(ndev, rsp->status);
  96. }
  97. static void nci_rf_disc_map_rsp_packet(struct nci_dev *ndev,
  98. struct sk_buff *skb)
  99. {
  100. __u8 status = skb->data[0];
  101. pr_debug("status 0x%x\n", status);
  102. nci_req_complete(ndev, status);
  103. }
  104. static void nci_rf_disc_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
  105. {
  106. struct nci_conn_info *conn_info;
  107. __u8 status = skb->data[0];
  108. pr_debug("status 0x%x\n", status);
  109. if (status == NCI_STATUS_OK) {
  110. atomic_set(&ndev->state, NCI_DISCOVERY);
  111. conn_info = ndev->rf_conn_info;
  112. if (!conn_info) {
  113. conn_info = devm_kzalloc(&ndev->nfc_dev->dev,
  114. sizeof(struct nci_conn_info),
  115. GFP_KERNEL);
  116. if (!conn_info) {
  117. status = NCI_STATUS_REJECTED;
  118. goto exit;
  119. }
  120. conn_info->conn_id = NCI_STATIC_RF_CONN_ID;
  121. INIT_LIST_HEAD(&conn_info->list);
  122. list_add(&conn_info->list, &ndev->conn_info_list);
  123. ndev->rf_conn_info = conn_info;
  124. }
  125. }
  126. exit:
  127. nci_req_complete(ndev, status);
  128. }
  129. static void nci_rf_disc_select_rsp_packet(struct nci_dev *ndev,
  130. struct sk_buff *skb)
  131. {
  132. __u8 status = skb->data[0];
  133. pr_debug("status 0x%x\n", status);
  134. /* Complete the request on intf_activated_ntf or generic_error_ntf */
  135. if (status != NCI_STATUS_OK)
  136. nci_req_complete(ndev, status);
  137. }
  138. static void nci_rf_deactivate_rsp_packet(struct nci_dev *ndev,
  139. struct sk_buff *skb)
  140. {
  141. __u8 status = skb->data[0];
  142. pr_debug("status 0x%x\n", status);
  143. /* If target was active, complete the request only in deactivate_ntf */
  144. if ((status != NCI_STATUS_OK) ||
  145. (atomic_read(&ndev->state) != NCI_POLL_ACTIVE)) {
  146. nci_clear_target_list(ndev);
  147. atomic_set(&ndev->state, NCI_IDLE);
  148. nci_req_complete(ndev, status);
  149. }
  150. }
  151. static void nci_nfcee_discover_rsp_packet(struct nci_dev *ndev,
  152. struct sk_buff *skb)
  153. {
  154. struct nci_nfcee_discover_rsp *discover_rsp;
  155. if (skb->len != 2) {
  156. nci_req_complete(ndev, NCI_STATUS_NFCEE_PROTOCOL_ERROR);
  157. return;
  158. }
  159. discover_rsp = (struct nci_nfcee_discover_rsp *)skb->data;
  160. if (discover_rsp->status != NCI_STATUS_OK ||
  161. discover_rsp->num_nfcee == 0)
  162. nci_req_complete(ndev, discover_rsp->status);
  163. }
  164. static void nci_nfcee_mode_set_rsp_packet(struct nci_dev *ndev,
  165. struct sk_buff *skb)
  166. {
  167. __u8 status = skb->data[0];
  168. pr_debug("status 0x%x\n", status);
  169. nci_req_complete(ndev, status);
  170. }
  171. static void nci_core_conn_create_rsp_packet(struct nci_dev *ndev,
  172. struct sk_buff *skb)
  173. {
  174. __u8 status = skb->data[0];
  175. struct nci_conn_info *conn_info = NULL;
  176. struct nci_core_conn_create_rsp *rsp;
  177. pr_debug("status 0x%x\n", status);
  178. if (status == NCI_STATUS_OK) {
  179. rsp = (struct nci_core_conn_create_rsp *)skb->data;
  180. conn_info = devm_kzalloc(&ndev->nfc_dev->dev,
  181. sizeof(*conn_info), GFP_KERNEL);
  182. if (!conn_info) {
  183. status = NCI_STATUS_REJECTED;
  184. goto exit;
  185. }
  186. conn_info->dest_params = devm_kzalloc(&ndev->nfc_dev->dev,
  187. sizeof(struct dest_spec_params),
  188. GFP_KERNEL);
  189. if (!conn_info->dest_params) {
  190. status = NCI_STATUS_REJECTED;
  191. goto free_conn_info;
  192. }
  193. conn_info->dest_type = ndev->cur_dest_type;
  194. conn_info->dest_params->id = ndev->cur_params.id;
  195. conn_info->dest_params->protocol = ndev->cur_params.protocol;
  196. conn_info->conn_id = rsp->conn_id;
  197. /* Note: data_exchange_cb and data_exchange_cb_context need to
  198. * be specify out of nci_core_conn_create_rsp_packet
  199. */
  200. INIT_LIST_HEAD(&conn_info->list);
  201. list_add(&conn_info->list, &ndev->conn_info_list);
  202. if (ndev->cur_params.id == ndev->hci_dev->nfcee_id)
  203. ndev->hci_dev->conn_info = conn_info;
  204. conn_info->conn_id = rsp->conn_id;
  205. conn_info->max_pkt_payload_len = rsp->max_ctrl_pkt_payload_len;
  206. atomic_set(&conn_info->credits_cnt, rsp->credits_cnt);
  207. }
  208. free_conn_info:
  209. if (status == NCI_STATUS_REJECTED)
  210. devm_kfree(&ndev->nfc_dev->dev, conn_info);
  211. exit:
  212. nci_req_complete(ndev, status);
  213. }
  214. static void nci_core_conn_close_rsp_packet(struct nci_dev *ndev,
  215. struct sk_buff *skb)
  216. {
  217. struct nci_conn_info *conn_info;
  218. __u8 status = skb->data[0];
  219. pr_debug("status 0x%x\n", status);
  220. if (status == NCI_STATUS_OK) {
  221. conn_info = nci_get_conn_info_by_conn_id(ndev,
  222. ndev->cur_conn_id);
  223. if (conn_info) {
  224. list_del(&conn_info->list);
  225. if (conn_info == ndev->rf_conn_info)
  226. ndev->rf_conn_info = NULL;
  227. devm_kfree(&ndev->nfc_dev->dev, conn_info);
  228. }
  229. }
  230. nci_req_complete(ndev, status);
  231. }
  232. void nci_rsp_packet(struct nci_dev *ndev, struct sk_buff *skb)
  233. {
  234. __u16 rsp_opcode = nci_opcode(skb->data);
  235. /* we got a rsp, stop the cmd timer */
  236. del_timer(&ndev->cmd_timer);
  237. pr_debug("NCI RX: MT=rsp, PBF=%d, GID=0x%x, OID=0x%x, plen=%d\n",
  238. nci_pbf(skb->data),
  239. nci_opcode_gid(rsp_opcode),
  240. nci_opcode_oid(rsp_opcode),
  241. nci_plen(skb->data));
  242. /* strip the nci control header */
  243. skb_pull(skb, NCI_CTRL_HDR_SIZE);
  244. if (nci_opcode_gid(rsp_opcode) == NCI_GID_PROPRIETARY) {
  245. if (nci_prop_rsp_packet(ndev, rsp_opcode, skb) == -ENOTSUPP) {
  246. pr_err("unsupported rsp opcode 0x%x\n",
  247. rsp_opcode);
  248. }
  249. goto end;
  250. }
  251. switch (rsp_opcode) {
  252. case NCI_OP_CORE_RESET_RSP:
  253. nci_core_reset_rsp_packet(ndev, skb);
  254. break;
  255. case NCI_OP_CORE_INIT_RSP:
  256. nci_core_init_rsp_packet(ndev, skb);
  257. break;
  258. case NCI_OP_CORE_SET_CONFIG_RSP:
  259. nci_core_set_config_rsp_packet(ndev, skb);
  260. break;
  261. case NCI_OP_CORE_CONN_CREATE_RSP:
  262. nci_core_conn_create_rsp_packet(ndev, skb);
  263. break;
  264. case NCI_OP_CORE_CONN_CLOSE_RSP:
  265. nci_core_conn_close_rsp_packet(ndev, skb);
  266. break;
  267. case NCI_OP_RF_DISCOVER_MAP_RSP:
  268. nci_rf_disc_map_rsp_packet(ndev, skb);
  269. break;
  270. case NCI_OP_RF_DISCOVER_RSP:
  271. nci_rf_disc_rsp_packet(ndev, skb);
  272. break;
  273. case NCI_OP_RF_DISCOVER_SELECT_RSP:
  274. nci_rf_disc_select_rsp_packet(ndev, skb);
  275. break;
  276. case NCI_OP_RF_DEACTIVATE_RSP:
  277. nci_rf_deactivate_rsp_packet(ndev, skb);
  278. break;
  279. case NCI_OP_NFCEE_DISCOVER_RSP:
  280. nci_nfcee_discover_rsp_packet(ndev, skb);
  281. break;
  282. case NCI_OP_NFCEE_MODE_SET_RSP:
  283. nci_nfcee_mode_set_rsp_packet(ndev, skb);
  284. break;
  285. default:
  286. pr_err("unknown rsp opcode 0x%x\n", rsp_opcode);
  287. break;
  288. }
  289. nci_core_rsp_packet(ndev, rsp_opcode, skb);
  290. end:
  291. kfree_skb(skb);
  292. /* trigger the next cmd */
  293. atomic_set(&ndev->cmd_cnt, 1);
  294. if (!skb_queue_empty(&ndev->cmd_q))
  295. queue_work(ndev->cmd_wq, &ndev->cmd_work);
  296. }