spi.c 7.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (C) 2013 Intel Corporation. All rights reserved.
  4. */
  5. #define pr_fmt(fmt) "nci_spi: %s: " fmt, __func__
  6. #include <linux/module.h>
  7. #include <linux/export.h>
  8. #include <linux/spi/spi.h>
  9. #include <linux/crc-ccitt.h>
  10. #include <net/nfc/nci_core.h>
  11. #define NCI_SPI_ACK_SHIFT 6
  12. #define NCI_SPI_MSB_PAYLOAD_MASK 0x3F
  13. #define NCI_SPI_SEND_TIMEOUT (NCI_CMD_TIMEOUT > NCI_DATA_TIMEOUT ? \
  14. NCI_CMD_TIMEOUT : NCI_DATA_TIMEOUT)
  15. #define NCI_SPI_DIRECT_WRITE 0x01
  16. #define NCI_SPI_DIRECT_READ 0x02
  17. #define ACKNOWLEDGE_NONE 0
  18. #define ACKNOWLEDGE_ACK 1
  19. #define ACKNOWLEDGE_NACK 2
  20. #define CRC_INIT 0xFFFF
  21. static int __nci_spi_send(struct nci_spi *nspi, struct sk_buff *skb,
  22. int cs_change)
  23. {
  24. struct spi_message m;
  25. struct spi_transfer t;
  26. memset(&t, 0, sizeof(struct spi_transfer));
  27. /* a NULL skb means we just want the SPI chip select line to raise */
  28. if (skb) {
  29. t.tx_buf = skb->data;
  30. t.len = skb->len;
  31. } else {
  32. /* still set tx_buf non NULL to make the driver happy */
  33. t.tx_buf = &t;
  34. t.len = 0;
  35. }
  36. t.cs_change = cs_change;
  37. t.delay.value = nspi->xfer_udelay;
  38. t.delay.unit = SPI_DELAY_UNIT_USECS;
  39. t.speed_hz = nspi->xfer_speed_hz;
  40. spi_message_init(&m);
  41. spi_message_add_tail(&t, &m);
  42. return spi_sync(nspi->spi, &m);
  43. }
  44. int nci_spi_send(struct nci_spi *nspi,
  45. struct completion *write_handshake_completion,
  46. struct sk_buff *skb)
  47. {
  48. unsigned int payload_len = skb->len;
  49. unsigned char *hdr;
  50. int ret;
  51. long completion_rc;
  52. /* add the NCI SPI header to the start of the buffer */
  53. hdr = skb_push(skb, NCI_SPI_HDR_LEN);
  54. hdr[0] = NCI_SPI_DIRECT_WRITE;
  55. hdr[1] = nspi->acknowledge_mode;
  56. hdr[2] = payload_len >> 8;
  57. hdr[3] = payload_len & 0xFF;
  58. if (nspi->acknowledge_mode == NCI_SPI_CRC_ENABLED) {
  59. u16 crc;
  60. crc = crc_ccitt(CRC_INIT, skb->data, skb->len);
  61. skb_put_u8(skb, crc >> 8);
  62. skb_put_u8(skb, crc & 0xFF);
  63. }
  64. if (write_handshake_completion) {
  65. /* Trick SPI driver to raise chip select */
  66. ret = __nci_spi_send(nspi, NULL, 1);
  67. if (ret)
  68. goto done;
  69. /* wait for NFC chip hardware handshake to complete */
  70. if (wait_for_completion_timeout(write_handshake_completion,
  71. msecs_to_jiffies(1000)) == 0) {
  72. ret = -ETIME;
  73. goto done;
  74. }
  75. }
  76. ret = __nci_spi_send(nspi, skb, 0);
  77. if (ret != 0 || nspi->acknowledge_mode == NCI_SPI_CRC_DISABLED)
  78. goto done;
  79. reinit_completion(&nspi->req_completion);
  80. completion_rc = wait_for_completion_interruptible_timeout(
  81. &nspi->req_completion,
  82. NCI_SPI_SEND_TIMEOUT);
  83. if (completion_rc <= 0 || nspi->req_result == ACKNOWLEDGE_NACK)
  84. ret = -EIO;
  85. done:
  86. kfree_skb(skb);
  87. return ret;
  88. }
  89. EXPORT_SYMBOL_GPL(nci_spi_send);
  90. /* ---- Interface to NCI SPI drivers ---- */
  91. /**
  92. * nci_spi_allocate_spi - allocate a new nci spi
  93. *
  94. * @spi: SPI device
  95. * @acknowledge_mode: Acknowledge mode used by the NFC device
  96. * @delay: delay between transactions in us
  97. * @ndev: nci dev to send incoming nci frames to
  98. */
  99. struct nci_spi *nci_spi_allocate_spi(struct spi_device *spi,
  100. u8 acknowledge_mode, unsigned int delay,
  101. struct nci_dev *ndev)
  102. {
  103. struct nci_spi *nspi;
  104. nspi = devm_kzalloc(&spi->dev, sizeof(struct nci_spi), GFP_KERNEL);
  105. if (!nspi)
  106. return NULL;
  107. nspi->acknowledge_mode = acknowledge_mode;
  108. nspi->xfer_udelay = delay;
  109. /* Use controller max SPI speed by default */
  110. nspi->xfer_speed_hz = 0;
  111. nspi->spi = spi;
  112. nspi->ndev = ndev;
  113. init_completion(&nspi->req_completion);
  114. return nspi;
  115. }
  116. EXPORT_SYMBOL_GPL(nci_spi_allocate_spi);
  117. static int send_acknowledge(struct nci_spi *nspi, u8 acknowledge)
  118. {
  119. struct sk_buff *skb;
  120. unsigned char *hdr;
  121. u16 crc;
  122. int ret;
  123. skb = nci_skb_alloc(nspi->ndev, 0, GFP_KERNEL);
  124. /* add the NCI SPI header to the start of the buffer */
  125. hdr = skb_push(skb, NCI_SPI_HDR_LEN);
  126. hdr[0] = NCI_SPI_DIRECT_WRITE;
  127. hdr[1] = NCI_SPI_CRC_ENABLED;
  128. hdr[2] = acknowledge << NCI_SPI_ACK_SHIFT;
  129. hdr[3] = 0;
  130. crc = crc_ccitt(CRC_INIT, skb->data, skb->len);
  131. skb_put_u8(skb, crc >> 8);
  132. skb_put_u8(skb, crc & 0xFF);
  133. ret = __nci_spi_send(nspi, skb, 0);
  134. kfree_skb(skb);
  135. return ret;
  136. }
  137. static struct sk_buff *__nci_spi_read(struct nci_spi *nspi)
  138. {
  139. struct sk_buff *skb;
  140. struct spi_message m;
  141. unsigned char req[2], resp_hdr[2];
  142. struct spi_transfer tx, rx;
  143. unsigned short rx_len = 0;
  144. int ret;
  145. spi_message_init(&m);
  146. memset(&tx, 0, sizeof(struct spi_transfer));
  147. req[0] = NCI_SPI_DIRECT_READ;
  148. req[1] = nspi->acknowledge_mode;
  149. tx.tx_buf = req;
  150. tx.len = 2;
  151. tx.cs_change = 0;
  152. tx.speed_hz = nspi->xfer_speed_hz;
  153. spi_message_add_tail(&tx, &m);
  154. memset(&rx, 0, sizeof(struct spi_transfer));
  155. rx.rx_buf = resp_hdr;
  156. rx.len = 2;
  157. rx.cs_change = 1;
  158. rx.speed_hz = nspi->xfer_speed_hz;
  159. spi_message_add_tail(&rx, &m);
  160. ret = spi_sync(nspi->spi, &m);
  161. if (ret)
  162. return NULL;
  163. if (nspi->acknowledge_mode == NCI_SPI_CRC_ENABLED)
  164. rx_len = ((resp_hdr[0] & NCI_SPI_MSB_PAYLOAD_MASK) << 8) +
  165. resp_hdr[1] + NCI_SPI_CRC_LEN;
  166. else
  167. rx_len = (resp_hdr[0] << 8) | resp_hdr[1];
  168. skb = nci_skb_alloc(nspi->ndev, rx_len, GFP_KERNEL);
  169. if (!skb)
  170. return NULL;
  171. spi_message_init(&m);
  172. memset(&rx, 0, sizeof(struct spi_transfer));
  173. rx.rx_buf = skb_put(skb, rx_len);
  174. rx.len = rx_len;
  175. rx.cs_change = 0;
  176. rx.delay.value = nspi->xfer_udelay;
  177. rx.delay.unit = SPI_DELAY_UNIT_USECS;
  178. rx.speed_hz = nspi->xfer_speed_hz;
  179. spi_message_add_tail(&rx, &m);
  180. ret = spi_sync(nspi->spi, &m);
  181. if (ret)
  182. goto receive_error;
  183. if (nspi->acknowledge_mode == NCI_SPI_CRC_ENABLED) {
  184. *(u8 *)skb_push(skb, 1) = resp_hdr[1];
  185. *(u8 *)skb_push(skb, 1) = resp_hdr[0];
  186. }
  187. return skb;
  188. receive_error:
  189. kfree_skb(skb);
  190. return NULL;
  191. }
  192. static int nci_spi_check_crc(struct sk_buff *skb)
  193. {
  194. u16 crc_data = (skb->data[skb->len - 2] << 8) |
  195. skb->data[skb->len - 1];
  196. int ret;
  197. ret = (crc_ccitt(CRC_INIT, skb->data, skb->len - NCI_SPI_CRC_LEN)
  198. == crc_data);
  199. skb_trim(skb, skb->len - NCI_SPI_CRC_LEN);
  200. return ret;
  201. }
  202. static u8 nci_spi_get_ack(struct sk_buff *skb)
  203. {
  204. u8 ret;
  205. ret = skb->data[0] >> NCI_SPI_ACK_SHIFT;
  206. /* Remove NFCC part of the header: ACK, NACK and MSB payload len */
  207. skb_pull(skb, 2);
  208. return ret;
  209. }
  210. /**
  211. * nci_spi_read - read frame from NCI SPI drivers
  212. *
  213. * @nspi: The nci spi
  214. * Context: can sleep
  215. *
  216. * This call may only be used from a context that may sleep. The sleep
  217. * is non-interruptible, and has no timeout.
  218. *
  219. * It returns an allocated skb containing the frame on success, or NULL.
  220. */
  221. struct sk_buff *nci_spi_read(struct nci_spi *nspi)
  222. {
  223. struct sk_buff *skb;
  224. /* Retrieve frame from SPI */
  225. skb = __nci_spi_read(nspi);
  226. if (!skb)
  227. goto done;
  228. if (nspi->acknowledge_mode == NCI_SPI_CRC_ENABLED) {
  229. if (!nci_spi_check_crc(skb)) {
  230. send_acknowledge(nspi, ACKNOWLEDGE_NACK);
  231. goto done;
  232. }
  233. /* In case of acknowledged mode: if ACK or NACK received,
  234. * unblock completion of latest frame sent.
  235. */
  236. nspi->req_result = nci_spi_get_ack(skb);
  237. if (nspi->req_result)
  238. complete(&nspi->req_completion);
  239. }
  240. /* If there is no payload (ACK/NACK only frame),
  241. * free the socket buffer
  242. */
  243. if (!skb->len) {
  244. kfree_skb(skb);
  245. skb = NULL;
  246. goto done;
  247. }
  248. if (nspi->acknowledge_mode == NCI_SPI_CRC_ENABLED)
  249. send_acknowledge(nspi, ACKNOWLEDGE_ACK);
  250. done:
  251. return skb;
  252. }
  253. EXPORT_SYMBOL_GPL(nci_spi_read);
  254. MODULE_LICENSE("GPL");