uart.c 4.5 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196
  1. // SPDX-License-Identifier: GPL-2.0+
  2. /*
  3. * UART Link Layer for S3FWRN82 NCI based Driver
  4. *
  5. * Copyright (C) 2015 Samsung Electronics
  6. * Robert Baldyga <[email protected]>
  7. * Copyright (C) 2020 Samsung Electronics
  8. * Bongsu Jeon <[email protected]>
  9. */
  10. #include <linux/device.h>
  11. #include <linux/kernel.h>
  12. #include <linux/module.h>
  13. #include <linux/nfc.h>
  14. #include <linux/netdevice.h>
  15. #include <linux/of.h>
  16. #include <linux/serdev.h>
  17. #include <linux/gpio.h>
  18. #include <linux/of_gpio.h>
  19. #include "phy_common.h"
  20. #define S3FWRN82_NCI_HEADER 3
  21. #define S3FWRN82_NCI_IDX 2
  22. #define NCI_SKB_BUFF_LEN 258
  23. struct s3fwrn82_uart_phy {
  24. struct phy_common common;
  25. struct serdev_device *ser_dev;
  26. struct sk_buff *recv_skb;
  27. };
  28. static int s3fwrn82_uart_write(void *phy_id, struct sk_buff *out)
  29. {
  30. struct s3fwrn82_uart_phy *phy = phy_id;
  31. int err;
  32. err = serdev_device_write(phy->ser_dev,
  33. out->data, out->len,
  34. MAX_SCHEDULE_TIMEOUT);
  35. if (err < 0)
  36. return err;
  37. return 0;
  38. }
  39. static const struct s3fwrn5_phy_ops uart_phy_ops = {
  40. .set_wake = s3fwrn5_phy_set_wake,
  41. .set_mode = s3fwrn5_phy_set_mode,
  42. .get_mode = s3fwrn5_phy_get_mode,
  43. .write = s3fwrn82_uart_write,
  44. };
  45. static int s3fwrn82_uart_read(struct serdev_device *serdev,
  46. const unsigned char *data,
  47. size_t count)
  48. {
  49. struct s3fwrn82_uart_phy *phy = serdev_device_get_drvdata(serdev);
  50. size_t i;
  51. for (i = 0; i < count; i++) {
  52. skb_put_u8(phy->recv_skb, *data++);
  53. if (phy->recv_skb->len < S3FWRN82_NCI_HEADER)
  54. continue;
  55. if ((phy->recv_skb->len - S3FWRN82_NCI_HEADER)
  56. < phy->recv_skb->data[S3FWRN82_NCI_IDX])
  57. continue;
  58. s3fwrn5_recv_frame(phy->common.ndev, phy->recv_skb,
  59. phy->common.mode);
  60. phy->recv_skb = alloc_skb(NCI_SKB_BUFF_LEN, GFP_KERNEL);
  61. if (!phy->recv_skb)
  62. return 0;
  63. }
  64. return i;
  65. }
  66. static const struct serdev_device_ops s3fwrn82_serdev_ops = {
  67. .receive_buf = s3fwrn82_uart_read,
  68. .write_wakeup = serdev_device_write_wakeup,
  69. };
  70. static const struct of_device_id s3fwrn82_uart_of_match[] = {
  71. { .compatible = "samsung,s3fwrn82", },
  72. {},
  73. };
  74. MODULE_DEVICE_TABLE(of, s3fwrn82_uart_of_match);
  75. static int s3fwrn82_uart_parse_dt(struct serdev_device *serdev)
  76. {
  77. struct s3fwrn82_uart_phy *phy = serdev_device_get_drvdata(serdev);
  78. struct device_node *np = serdev->dev.of_node;
  79. if (!np)
  80. return -ENODEV;
  81. phy->common.gpio_en = of_get_named_gpio(np, "en-gpios", 0);
  82. if (!gpio_is_valid(phy->common.gpio_en))
  83. return -ENODEV;
  84. phy->common.gpio_fw_wake = of_get_named_gpio(np, "wake-gpios", 0);
  85. if (!gpio_is_valid(phy->common.gpio_fw_wake))
  86. return -ENODEV;
  87. return 0;
  88. }
  89. static int s3fwrn82_uart_probe(struct serdev_device *serdev)
  90. {
  91. struct s3fwrn82_uart_phy *phy;
  92. int ret = -ENOMEM;
  93. phy = devm_kzalloc(&serdev->dev, sizeof(*phy), GFP_KERNEL);
  94. if (!phy)
  95. goto err_exit;
  96. phy->recv_skb = alloc_skb(NCI_SKB_BUFF_LEN, GFP_KERNEL);
  97. if (!phy->recv_skb)
  98. goto err_exit;
  99. mutex_init(&phy->common.mutex);
  100. phy->common.mode = S3FWRN5_MODE_COLD;
  101. phy->ser_dev = serdev;
  102. serdev_device_set_drvdata(serdev, phy);
  103. serdev_device_set_client_ops(serdev, &s3fwrn82_serdev_ops);
  104. ret = serdev_device_open(serdev);
  105. if (ret) {
  106. dev_err(&serdev->dev, "Unable to open device\n");
  107. goto err_skb;
  108. }
  109. ret = serdev_device_set_baudrate(serdev, 115200);
  110. if (ret != 115200) {
  111. ret = -EINVAL;
  112. goto err_serdev;
  113. }
  114. serdev_device_set_flow_control(serdev, false);
  115. ret = s3fwrn82_uart_parse_dt(serdev);
  116. if (ret < 0)
  117. goto err_serdev;
  118. ret = devm_gpio_request_one(&phy->ser_dev->dev, phy->common.gpio_en,
  119. GPIOF_OUT_INIT_HIGH, "s3fwrn82_en");
  120. if (ret < 0)
  121. goto err_serdev;
  122. ret = devm_gpio_request_one(&phy->ser_dev->dev,
  123. phy->common.gpio_fw_wake,
  124. GPIOF_OUT_INIT_LOW, "s3fwrn82_fw_wake");
  125. if (ret < 0)
  126. goto err_serdev;
  127. ret = s3fwrn5_probe(&phy->common.ndev, phy, &phy->ser_dev->dev,
  128. &uart_phy_ops);
  129. if (ret < 0)
  130. goto err_serdev;
  131. return ret;
  132. err_serdev:
  133. serdev_device_close(serdev);
  134. err_skb:
  135. kfree_skb(phy->recv_skb);
  136. err_exit:
  137. return ret;
  138. }
  139. static void s3fwrn82_uart_remove(struct serdev_device *serdev)
  140. {
  141. struct s3fwrn82_uart_phy *phy = serdev_device_get_drvdata(serdev);
  142. s3fwrn5_remove(phy->common.ndev);
  143. serdev_device_close(serdev);
  144. kfree_skb(phy->recv_skb);
  145. }
  146. static struct serdev_device_driver s3fwrn82_uart_driver = {
  147. .probe = s3fwrn82_uart_probe,
  148. .remove = s3fwrn82_uart_remove,
  149. .driver = {
  150. .name = "s3fwrn82_uart",
  151. .of_match_table = s3fwrn82_uart_of_match,
  152. },
  153. };
  154. module_serdev_device_driver(s3fwrn82_uart_driver);
  155. MODULE_LICENSE("GPL");
  156. MODULE_DESCRIPTION("UART driver for Samsung NFC");
  157. MODULE_AUTHOR("Bongsu Jeon <[email protected]>");