vendor_cmds.c 8.0 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Proprietary commands extension for STMicroelectronics NFC Chip
  4. *
  5. * Copyright (C) 2014-2015 STMicroelectronics SAS. All rights reserved.
  6. */
  7. #include <net/genetlink.h>
  8. #include <linux/module.h>
  9. #include <linux/nfc.h>
  10. #include <net/nfc/hci.h>
  11. #include <net/nfc/llc.h>
  12. #include "st21nfca.h"
  13. #define ST21NFCA_HCI_DM_GETDATA 0x10
  14. #define ST21NFCA_HCI_DM_PUTDATA 0x11
  15. #define ST21NFCA_HCI_DM_LOAD 0x12
  16. #define ST21NFCA_HCI_DM_GETINFO 0x13
  17. #define ST21NFCA_HCI_DM_UPDATE_AID 0x20
  18. #define ST21NFCA_HCI_DM_RESET 0x3e
  19. #define ST21NFCA_HCI_DM_FIELD_GENERATOR 0x32
  20. #define ST21NFCA_FACTORY_MODE_ON 1
  21. #define ST21NFCA_FACTORY_MODE_OFF 0
  22. #define ST21NFCA_EVT_POST_DATA 0x02
  23. struct get_param_data {
  24. u8 gate;
  25. u8 data;
  26. } __packed;
  27. static int st21nfca_factory_mode(struct nfc_dev *dev, void *data,
  28. size_t data_len)
  29. {
  30. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  31. if (data_len != 1)
  32. return -EINVAL;
  33. pr_debug("factory mode: %x\n", ((u8 *)data)[0]);
  34. switch (((u8 *)data)[0]) {
  35. case ST21NFCA_FACTORY_MODE_ON:
  36. test_and_set_bit(ST21NFCA_FACTORY_MODE, &hdev->quirks);
  37. break;
  38. case ST21NFCA_FACTORY_MODE_OFF:
  39. clear_bit(ST21NFCA_FACTORY_MODE, &hdev->quirks);
  40. break;
  41. default:
  42. return -EINVAL;
  43. }
  44. return 0;
  45. }
  46. static int st21nfca_hci_clear_all_pipes(struct nfc_dev *dev, void *data,
  47. size_t data_len)
  48. {
  49. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  50. return nfc_hci_disconnect_all_gates(hdev);
  51. }
  52. static int st21nfca_hci_dm_put_data(struct nfc_dev *dev, void *data,
  53. size_t data_len)
  54. {
  55. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  56. return nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE,
  57. ST21NFCA_HCI_DM_PUTDATA, data,
  58. data_len, NULL);
  59. }
  60. static int st21nfca_hci_dm_update_aid(struct nfc_dev *dev, void *data,
  61. size_t data_len)
  62. {
  63. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  64. return nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE,
  65. ST21NFCA_HCI_DM_UPDATE_AID, data, data_len, NULL);
  66. }
  67. static int st21nfca_hci_dm_get_info(struct nfc_dev *dev, void *data,
  68. size_t data_len)
  69. {
  70. int r;
  71. struct sk_buff *msg, *skb;
  72. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  73. r = nfc_hci_send_cmd(hdev,
  74. ST21NFCA_DEVICE_MGNT_GATE,
  75. ST21NFCA_HCI_DM_GETINFO,
  76. data, data_len, &skb);
  77. if (r)
  78. goto exit;
  79. msg = nfc_vendor_cmd_alloc_reply_skb(dev, ST21NFCA_VENDOR_OUI,
  80. HCI_DM_GET_INFO, skb->len);
  81. if (!msg) {
  82. r = -ENOMEM;
  83. goto free_skb;
  84. }
  85. if (nla_put(msg, NFC_ATTR_VENDOR_DATA, skb->len, skb->data)) {
  86. kfree_skb(msg);
  87. r = -ENOBUFS;
  88. goto free_skb;
  89. }
  90. r = nfc_vendor_cmd_reply(msg);
  91. free_skb:
  92. kfree_skb(skb);
  93. exit:
  94. return r;
  95. }
  96. static int st21nfca_hci_dm_get_data(struct nfc_dev *dev, void *data,
  97. size_t data_len)
  98. {
  99. int r;
  100. struct sk_buff *msg, *skb;
  101. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  102. r = nfc_hci_send_cmd(hdev,
  103. ST21NFCA_DEVICE_MGNT_GATE,
  104. ST21NFCA_HCI_DM_GETDATA,
  105. data, data_len, &skb);
  106. if (r)
  107. goto exit;
  108. msg = nfc_vendor_cmd_alloc_reply_skb(dev, ST21NFCA_VENDOR_OUI,
  109. HCI_DM_GET_DATA, skb->len);
  110. if (!msg) {
  111. r = -ENOMEM;
  112. goto free_skb;
  113. }
  114. if (nla_put(msg, NFC_ATTR_VENDOR_DATA, skb->len, skb->data)) {
  115. kfree_skb(msg);
  116. r = -ENOBUFS;
  117. goto free_skb;
  118. }
  119. r = nfc_vendor_cmd_reply(msg);
  120. free_skb:
  121. kfree_skb(skb);
  122. exit:
  123. return r;
  124. }
  125. static int st21nfca_hci_dm_load(struct nfc_dev *dev, void *data,
  126. size_t data_len)
  127. {
  128. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  129. return nfc_hci_send_cmd(hdev, ST21NFCA_DEVICE_MGNT_GATE,
  130. ST21NFCA_HCI_DM_LOAD, data, data_len, NULL);
  131. }
  132. static int st21nfca_hci_dm_reset(struct nfc_dev *dev, void *data,
  133. size_t data_len)
  134. {
  135. int r;
  136. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  137. r = nfc_hci_send_cmd_async(hdev, ST21NFCA_DEVICE_MGNT_GATE,
  138. ST21NFCA_HCI_DM_RESET, data, data_len, NULL, NULL);
  139. if (r < 0)
  140. return r;
  141. r = nfc_llc_stop(hdev->llc);
  142. if (r < 0)
  143. return r;
  144. return nfc_llc_start(hdev->llc);
  145. }
  146. static int st21nfca_hci_get_param(struct nfc_dev *dev, void *data,
  147. size_t data_len)
  148. {
  149. int r;
  150. struct sk_buff *msg, *skb;
  151. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  152. struct get_param_data *param = (struct get_param_data *)data;
  153. if (data_len < sizeof(struct get_param_data))
  154. return -EPROTO;
  155. r = nfc_hci_get_param(hdev, param->gate, param->data, &skb);
  156. if (r)
  157. goto exit;
  158. msg = nfc_vendor_cmd_alloc_reply_skb(dev, ST21NFCA_VENDOR_OUI,
  159. HCI_GET_PARAM, skb->len);
  160. if (!msg) {
  161. r = -ENOMEM;
  162. goto free_skb;
  163. }
  164. if (nla_put(msg, NFC_ATTR_VENDOR_DATA, skb->len, skb->data)) {
  165. kfree_skb(msg);
  166. r = -ENOBUFS;
  167. goto free_skb;
  168. }
  169. r = nfc_vendor_cmd_reply(msg);
  170. free_skb:
  171. kfree_skb(skb);
  172. exit:
  173. return r;
  174. }
  175. static int st21nfca_hci_dm_field_generator(struct nfc_dev *dev, void *data,
  176. size_t data_len)
  177. {
  178. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  179. return nfc_hci_send_cmd(hdev,
  180. ST21NFCA_DEVICE_MGNT_GATE,
  181. ST21NFCA_HCI_DM_FIELD_GENERATOR,
  182. data, data_len, NULL);
  183. }
  184. int st21nfca_hci_loopback_event_received(struct nfc_hci_dev *hdev, u8 event,
  185. struct sk_buff *skb)
  186. {
  187. struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);
  188. switch (event) {
  189. case ST21NFCA_EVT_POST_DATA:
  190. info->vendor_info.rx_skb = skb;
  191. break;
  192. default:
  193. nfc_err(&hdev->ndev->dev, "Unexpected event on loopback gate\n");
  194. }
  195. complete(&info->vendor_info.req_completion);
  196. return 0;
  197. }
  198. EXPORT_SYMBOL(st21nfca_hci_loopback_event_received);
  199. static int st21nfca_hci_loopback(struct nfc_dev *dev, void *data,
  200. size_t data_len)
  201. {
  202. int r;
  203. struct sk_buff *msg;
  204. struct nfc_hci_dev *hdev = nfc_get_drvdata(dev);
  205. struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);
  206. if (data_len <= 0)
  207. return -EPROTO;
  208. reinit_completion(&info->vendor_info.req_completion);
  209. info->vendor_info.rx_skb = NULL;
  210. r = nfc_hci_send_event(hdev, NFC_HCI_LOOPBACK_GATE,
  211. ST21NFCA_EVT_POST_DATA, data, data_len);
  212. if (r < 0) {
  213. r = -EPROTO;
  214. goto exit;
  215. }
  216. wait_for_completion_interruptible(&info->vendor_info.req_completion);
  217. if (!info->vendor_info.rx_skb ||
  218. info->vendor_info.rx_skb->len != data_len) {
  219. r = -EPROTO;
  220. goto exit;
  221. }
  222. msg = nfc_vendor_cmd_alloc_reply_skb(hdev->ndev,
  223. ST21NFCA_VENDOR_OUI,
  224. HCI_LOOPBACK,
  225. info->vendor_info.rx_skb->len);
  226. if (!msg) {
  227. r = -ENOMEM;
  228. goto free_skb;
  229. }
  230. if (nla_put(msg, NFC_ATTR_VENDOR_DATA, info->vendor_info.rx_skb->len,
  231. info->vendor_info.rx_skb->data)) {
  232. kfree_skb(msg);
  233. r = -ENOBUFS;
  234. goto free_skb;
  235. }
  236. r = nfc_vendor_cmd_reply(msg);
  237. free_skb:
  238. kfree_skb(info->vendor_info.rx_skb);
  239. exit:
  240. return r;
  241. }
  242. static struct nfc_vendor_cmd st21nfca_vendor_cmds[] = {
  243. {
  244. .vendor_id = ST21NFCA_VENDOR_OUI,
  245. .subcmd = FACTORY_MODE,
  246. .doit = st21nfca_factory_mode,
  247. },
  248. {
  249. .vendor_id = ST21NFCA_VENDOR_OUI,
  250. .subcmd = HCI_CLEAR_ALL_PIPES,
  251. .doit = st21nfca_hci_clear_all_pipes,
  252. },
  253. {
  254. .vendor_id = ST21NFCA_VENDOR_OUI,
  255. .subcmd = HCI_DM_PUT_DATA,
  256. .doit = st21nfca_hci_dm_put_data,
  257. },
  258. {
  259. .vendor_id = ST21NFCA_VENDOR_OUI,
  260. .subcmd = HCI_DM_UPDATE_AID,
  261. .doit = st21nfca_hci_dm_update_aid,
  262. },
  263. {
  264. .vendor_id = ST21NFCA_VENDOR_OUI,
  265. .subcmd = HCI_DM_GET_INFO,
  266. .doit = st21nfca_hci_dm_get_info,
  267. },
  268. {
  269. .vendor_id = ST21NFCA_VENDOR_OUI,
  270. .subcmd = HCI_DM_GET_DATA,
  271. .doit = st21nfca_hci_dm_get_data,
  272. },
  273. {
  274. .vendor_id = ST21NFCA_VENDOR_OUI,
  275. .subcmd = HCI_DM_LOAD,
  276. .doit = st21nfca_hci_dm_load,
  277. },
  278. {
  279. .vendor_id = ST21NFCA_VENDOR_OUI,
  280. .subcmd = HCI_DM_RESET,
  281. .doit = st21nfca_hci_dm_reset,
  282. },
  283. {
  284. .vendor_id = ST21NFCA_VENDOR_OUI,
  285. .subcmd = HCI_GET_PARAM,
  286. .doit = st21nfca_hci_get_param,
  287. },
  288. {
  289. .vendor_id = ST21NFCA_VENDOR_OUI,
  290. .subcmd = HCI_DM_FIELD_GENERATOR,
  291. .doit = st21nfca_hci_dm_field_generator,
  292. },
  293. {
  294. .vendor_id = ST21NFCA_VENDOR_OUI,
  295. .subcmd = HCI_LOOPBACK,
  296. .doit = st21nfca_hci_loopback,
  297. },
  298. };
  299. int st21nfca_vendor_cmds_init(struct nfc_hci_dev *hdev)
  300. {
  301. struct st21nfca_hci_info *info = nfc_hci_get_clientdata(hdev);
  302. init_completion(&info->vendor_info.req_completion);
  303. return nfc_set_vendor_cmds(hdev->ndev, st21nfca_vendor_cmds,
  304. sizeof(st21nfca_vendor_cmds));
  305. }
  306. EXPORT_SYMBOL(st21nfca_vendor_cmds_init);