core.c 4.9 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220
  1. /*
  2. * NCI based driver for Samsung S3FWRN5 NFC chip
  3. *
  4. * Copyright (C) 2015 Samsung Electrnoics
  5. * Robert Baldyga <r.baldyga@samsung.com>
  6. *
  7. * This program is free software; you can redistribute it and/or modify it
  8. * under the terms and conditions of the GNU General Public License,
  9. * version 2 or later, as published by the Free Software Foundation.
  10. *
  11. * This program is distributed in the hope that it will be useful,
  12. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  13. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  14. * GNU General Public License for more details.
  15. *
  16. * You should have received a copy of the GNU General Public License
  17. * along with this program; if not, see <http://www.gnu.org/licenses/>.
  18. */
  19. #include <linux/module.h>
  20. #include <net/nfc/nci_core.h>
  21. #include "s3fwrn5.h"
  22. #include "firmware.h"
  23. #include "nci.h"
  24. #define S3FWRN5_NFC_PROTOCOLS (NFC_PROTO_JEWEL_MASK | \
  25. NFC_PROTO_MIFARE_MASK | \
  26. NFC_PROTO_FELICA_MASK | \
  27. NFC_PROTO_ISO14443_MASK | \
  28. NFC_PROTO_ISO14443_B_MASK | \
  29. NFC_PROTO_ISO15693_MASK)
  30. static int s3fwrn5_firmware_update(struct s3fwrn5_info *info)
  31. {
  32. bool need_update;
  33. int ret;
  34. s3fwrn5_fw_init(&info->fw_info, "sec_s3fwrn5_firmware.bin");
  35. /* Update firmware */
  36. s3fwrn5_set_wake(info, false);
  37. s3fwrn5_set_mode(info, S3FWRN5_MODE_FW);
  38. ret = s3fwrn5_fw_setup(&info->fw_info);
  39. if (ret < 0)
  40. return ret;
  41. need_update = s3fwrn5_fw_check_version(&info->fw_info,
  42. info->ndev->manufact_specific_info);
  43. if (!need_update)
  44. goto out;
  45. dev_info(&info->ndev->nfc_dev->dev, "Detected new firmware version\n");
  46. ret = s3fwrn5_fw_download(&info->fw_info);
  47. if (ret < 0)
  48. goto out;
  49. /* Update RF configuration */
  50. s3fwrn5_set_mode(info, S3FWRN5_MODE_NCI);
  51. s3fwrn5_set_wake(info, true);
  52. ret = s3fwrn5_nci_rf_configure(info, "sec_s3fwrn5_rfreg.bin");
  53. s3fwrn5_set_wake(info, false);
  54. out:
  55. s3fwrn5_set_mode(info, S3FWRN5_MODE_COLD);
  56. s3fwrn5_fw_cleanup(&info->fw_info);
  57. return ret;
  58. }
  59. static int s3fwrn5_nci_open(struct nci_dev *ndev)
  60. {
  61. struct s3fwrn5_info *info = nci_get_drvdata(ndev);
  62. if (s3fwrn5_get_mode(info) != S3FWRN5_MODE_COLD)
  63. return -EBUSY;
  64. s3fwrn5_set_mode(info, S3FWRN5_MODE_NCI);
  65. s3fwrn5_set_wake(info, true);
  66. return 0;
  67. }
  68. static int s3fwrn5_nci_close(struct nci_dev *ndev)
  69. {
  70. struct s3fwrn5_info *info = nci_get_drvdata(ndev);
  71. s3fwrn5_set_wake(info, false);
  72. s3fwrn5_set_mode(info, S3FWRN5_MODE_COLD);
  73. return 0;
  74. }
  75. static int s3fwrn5_nci_send(struct nci_dev *ndev, struct sk_buff *skb)
  76. {
  77. struct s3fwrn5_info *info = nci_get_drvdata(ndev);
  78. int ret;
  79. mutex_lock(&info->mutex);
  80. if (s3fwrn5_get_mode(info) != S3FWRN5_MODE_NCI) {
  81. mutex_unlock(&info->mutex);
  82. return -EINVAL;
  83. }
  84. ret = s3fwrn5_write(info, skb);
  85. if (ret < 0)
  86. kfree_skb(skb);
  87. mutex_unlock(&info->mutex);
  88. return ret;
  89. }
  90. static int s3fwrn5_nci_post_setup(struct nci_dev *ndev)
  91. {
  92. struct s3fwrn5_info *info = nci_get_drvdata(ndev);
  93. int ret;
  94. ret = s3fwrn5_firmware_update(info);
  95. if (ret < 0)
  96. goto out;
  97. /* NCI core reset */
  98. s3fwrn5_set_mode(info, S3FWRN5_MODE_NCI);
  99. s3fwrn5_set_wake(info, true);
  100. ret = nci_core_reset(info->ndev);
  101. if (ret < 0)
  102. goto out;
  103. ret = nci_core_init(info->ndev);
  104. out:
  105. return ret;
  106. }
  107. static struct nci_ops s3fwrn5_nci_ops = {
  108. .open = s3fwrn5_nci_open,
  109. .close = s3fwrn5_nci_close,
  110. .send = s3fwrn5_nci_send,
  111. .post_setup = s3fwrn5_nci_post_setup,
  112. };
  113. int s3fwrn5_probe(struct nci_dev **ndev, void *phy_id, struct device *pdev,
  114. const struct s3fwrn5_phy_ops *phy_ops, unsigned int max_payload)
  115. {
  116. struct s3fwrn5_info *info;
  117. int ret;
  118. info = devm_kzalloc(pdev, sizeof(*info), GFP_KERNEL);
  119. if (!info)
  120. return -ENOMEM;
  121. info->phy_id = phy_id;
  122. info->pdev = pdev;
  123. info->phy_ops = phy_ops;
  124. info->max_payload = max_payload;
  125. mutex_init(&info->mutex);
  126. s3fwrn5_set_mode(info, S3FWRN5_MODE_COLD);
  127. s3fwrn5_nci_get_prop_ops(&s3fwrn5_nci_ops.prop_ops,
  128. &s3fwrn5_nci_ops.n_prop_ops);
  129. info->ndev = nci_allocate_device(&s3fwrn5_nci_ops,
  130. S3FWRN5_NFC_PROTOCOLS, 0, 0);
  131. if (!info->ndev)
  132. return -ENOMEM;
  133. nci_set_parent_dev(info->ndev, pdev);
  134. nci_set_drvdata(info->ndev, info);
  135. ret = nci_register_device(info->ndev);
  136. if (ret < 0) {
  137. nci_free_device(info->ndev);
  138. return ret;
  139. }
  140. info->fw_info.ndev = info->ndev;
  141. *ndev = info->ndev;
  142. return ret;
  143. }
  144. EXPORT_SYMBOL(s3fwrn5_probe);
  145. void s3fwrn5_remove(struct nci_dev *ndev)
  146. {
  147. struct s3fwrn5_info *info = nci_get_drvdata(ndev);
  148. s3fwrn5_set_mode(info, S3FWRN5_MODE_COLD);
  149. nci_unregister_device(ndev);
  150. nci_free_device(ndev);
  151. }
  152. EXPORT_SYMBOL(s3fwrn5_remove);
  153. int s3fwrn5_recv_frame(struct nci_dev *ndev, struct sk_buff *skb,
  154. enum s3fwrn5_mode mode)
  155. {
  156. switch (mode) {
  157. case S3FWRN5_MODE_NCI:
  158. return nci_recv_frame(ndev, skb);
  159. case S3FWRN5_MODE_FW:
  160. return s3fwrn5_fw_recv_frame(ndev, skb);
  161. default:
  162. kfree_skb(skb);
  163. return -ENODEV;
  164. }
  165. }
  166. EXPORT_SYMBOL(s3fwrn5_recv_frame);
  167. MODULE_LICENSE("GPL");
  168. MODULE_DESCRIPTION("Samsung S3FWRN5 NFC driver");
  169. MODULE_AUTHOR("Robert Baldyga <r.baldyga@samsung.com>");