i2c_writeread.c 4.1 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116
  1. /****************************************************************************
  2. * drivers/i2c/i2c_writeread.c
  3. *
  4. * Copyright (C) 2016 Gregory Nutt. All rights reserved.
  5. * Author: Gregory Nutt <gnutt@nuttx.org>
  6. *
  7. * Redistribution and use in source and binary forms, with or without
  8. * modification, are permitted provided that the following conditions
  9. * are met:
  10. *
  11. * 1. Redistributions of source code must retain the above copyright
  12. * notice, this list of conditions and the following disclaimer.
  13. * 2. Redistributions in binary form must reproduce the above copyright
  14. * notice, this list of conditions and the following disclaimer in
  15. * the documentation and/or other materials provided with the
  16. * distribution.
  17. * 3. Neither the name NuttX nor the names of its contributors may be
  18. * used to endorse or promote products derived from this software
  19. * without specific prior written permission.
  20. *
  21. * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
  22. * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
  23. * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
  24. * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
  25. * COPYRIGHT OWNER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT,
  26. * INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING,
  27. * BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS
  28. * OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED
  29. * AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
  30. * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN
  31. * ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
  32. * POSSIBILITY OF SUCH DAMAGE.
  33. *
  34. ****************************************************************************/
  35. /****************************************************************************
  36. * Included Files
  37. ****************************************************************************/
  38. #include <nuttx/config.h>
  39. #include <assert.h>
  40. #include <nuttx/i2c/i2c_master.h>
  41. /****************************************************************************
  42. * Public Functions
  43. ****************************************************************************/
  44. /****************************************************************************
  45. * Name: i2c_writeread
  46. *
  47. * Description:
  48. * Send a block of data on I2C followed by restarted read access. This
  49. * provides a convenient wrapper to the transfer function.
  50. *
  51. * Input Parameters:
  52. * dev - Device-specific state data
  53. * config - Described the I2C configuration
  54. * wbuffer - A pointer to the read-only buffer of data to be written to device
  55. * wbuflen - The number of bytes to send from the buffer
  56. * rbuffer - A pointer to a buffer of data to receive the data from the device
  57. * rbuflen - The requested number of bytes to be read
  58. *
  59. * Returned Value:
  60. * 0: success, <0: A negated errno
  61. *
  62. ****************************************************************************/
  63. int i2c_writeread(FAR struct i2c_master_s *dev,
  64. FAR const struct i2c_config_s *config,
  65. FAR const uint8_t *wbuffer, int wbuflen,
  66. FAR uint8_t *rbuffer, int rbuflen)
  67. {
  68. struct i2c_msg_s msg[2];
  69. unsigned int flags;
  70. int ret;
  71. /* 7- or 10-bit address? */
  72. DEBUGASSERT(config->addrlen == 10 || config->addrlen == 7);
  73. flags = (config->addrlen == 10) ? I2C_M_TEN : 0;
  74. /* Format two messages: The first is a write */
  75. msg[0].frequency = config->frequency,
  76. msg[0].addr = config->address;
  77. msg[0].flags = flags;
  78. msg[0].buffer = (FAR uint8_t *)wbuffer; /* Override const */
  79. msg[0].length = wbuflen;
  80. /* The second is either a read (rbuflen > 0) or a write (rbuflen < 0) with
  81. * no restart.
  82. */
  83. if (rbuflen > 0)
  84. {
  85. msg[1].flags = (flags | I2C_M_READ);
  86. }
  87. else
  88. {
  89. msg[1].flags = (flags | I2C_M_NORESTART);
  90. rbuflen = -rbuflen;
  91. }
  92. msg[1].frequency = config->frequency,
  93. msg[1].addr = config->address;
  94. msg[1].buffer = rbuffer;
  95. msg[1].length = rbuflen;
  96. /* Then perform the transfer. */
  97. ret = I2C_TRANSFER(dev, msg, 2);
  98. return (ret >= 0) ? OK : ret;
  99. }