cros_ec_spi.c 3.7 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146
  1. /*
  2. * Chromium OS cros_ec driver - SPI interface
  3. *
  4. * Copyright (c) 2012 The Chromium OS Authors.
  5. *
  6. * SPDX-License-Identifier: GPL-2.0+
  7. */
  8. /*
  9. * The Matrix Keyboard Protocol driver handles talking to the keyboard
  10. * controller chip. Mostly this is for keyboard functions, but some other
  11. * things have slipped in, so we provide generic services to talk to the
  12. * KBC.
  13. */
  14. #include <common.h>
  15. #include <cros_ec.h>
  16. #include <spi.h>
  17. /**
  18. * Send a command to a LPC CROS_EC device and return the reply.
  19. *
  20. * The device's internal input/output buffers are used.
  21. *
  22. * @param dev CROS_EC device
  23. * @param cmd Command to send (EC_CMD_...)
  24. * @param cmd_version Version of command to send (EC_VER_...)
  25. * @param dout Output data (may be NULL If dout_len=0)
  26. * @param dout_len Size of output data in bytes
  27. * @param dinp Returns pointer to response data. This will be
  28. * untouched unless we return a value > 0.
  29. * @param din_len Maximum size of response in bytes
  30. * @return number of bytes in response, or -1 on error
  31. */
  32. int cros_ec_spi_command(struct cros_ec_dev *dev, uint8_t cmd, int cmd_version,
  33. const uint8_t *dout, int dout_len,
  34. uint8_t **dinp, int din_len)
  35. {
  36. int in_bytes = din_len + 4; /* status, length, checksum, trailer */
  37. uint8_t *out;
  38. uint8_t *p;
  39. int csum, len;
  40. int rv;
  41. /*
  42. * Sanity-check input size to make sure it plus transaction overhead
  43. * fits in the internal device buffer.
  44. */
  45. if (in_bytes > sizeof(dev->din)) {
  46. debug("%s: Cannot receive %d bytes\n", __func__, din_len);
  47. return -1;
  48. }
  49. /* We represent message length as a byte */
  50. if (dout_len > 0xff) {
  51. debug("%s: Cannot send %d bytes\n", __func__, dout_len);
  52. return -1;
  53. }
  54. /*
  55. * Clear input buffer so we don't get false hits for MSG_HEADER
  56. */
  57. memset(dev->din, '\0', in_bytes);
  58. if (spi_claim_bus(dev->spi)) {
  59. debug("%s: Cannot claim SPI bus\n", __func__);
  60. return -1;
  61. }
  62. out = dev->dout;
  63. out[0] = cmd_version;
  64. out[1] = cmd;
  65. out[2] = (uint8_t)dout_len;
  66. memcpy(out + 3, dout, dout_len);
  67. csum = cros_ec_calc_checksum(out, 3)
  68. + cros_ec_calc_checksum(dout, dout_len);
  69. out[3 + dout_len] = (uint8_t)csum;
  70. /*
  71. * Send output data and receive input data starting such that the
  72. * message body will be dword aligned.
  73. */
  74. p = dev->din + sizeof(int64_t) - 2;
  75. len = dout_len + 4;
  76. cros_ec_dump_data("out", cmd, out, len);
  77. rv = spi_xfer(dev->spi, max(len, in_bytes) * 8, out, p,
  78. SPI_XFER_BEGIN | SPI_XFER_END);
  79. spi_release_bus(dev->spi);
  80. if (rv) {
  81. debug("%s: Cannot complete SPI transfer\n", __func__);
  82. return -1;
  83. }
  84. len = min(p[1], din_len);
  85. cros_ec_dump_data("in", -1, p, len + 3);
  86. /* Response code is first byte of message */
  87. if (p[0] != EC_RES_SUCCESS) {
  88. printf("%s: Returned status %d\n", __func__, p[0]);
  89. return -(int)(p[0]);
  90. }
  91. /* Check checksum */
  92. csum = cros_ec_calc_checksum(p, len + 2);
  93. if (csum != p[len + 2]) {
  94. debug("%s: Invalid checksum rx %#02x, calced %#02x\n", __func__,
  95. p[2 + len], csum);
  96. return -1;
  97. }
  98. /* Anything else is the response data */
  99. *dinp = p + 2;
  100. return len;
  101. }
  102. int cros_ec_spi_decode_fdt(struct cros_ec_dev *dev, const void *blob)
  103. {
  104. /* Decode interface-specific FDT params */
  105. dev->max_frequency = fdtdec_get_int(blob, dev->node,
  106. "spi-max-frequency", 500000);
  107. dev->cs = fdtdec_get_int(blob, dev->node, "reg", 0);
  108. return 0;
  109. }
  110. /**
  111. * Initialize SPI protocol.
  112. *
  113. * @param dev CROS_EC device
  114. * @param blob Device tree blob
  115. * @return 0 if ok, -1 on error
  116. */
  117. int cros_ec_spi_init(struct cros_ec_dev *dev, const void *blob)
  118. {
  119. dev->spi = spi_setup_slave_fdt(blob, dev->parent_node,
  120. dev->cs, dev->max_frequency, 0);
  121. if (!dev->spi) {
  122. debug("%s: Could not setup SPI slave\n", __func__);
  123. return -1;
  124. }
  125. return 0;
  126. }