在Android源码树中添加userspace I2C读写工具(i2c-util)

在Android源码树中添加userspace I2C读写工具(i2c-util)

http://blog.csdn.net/21cnbao/article/details/7919055

分类: Android系统架构2012-08-29 10:41 3659人阅读 评论(2) 收藏 举报

by @宋宝华Barry

通过/dev/i2c-n节点,用户可以在userspace直接访问板上的i2c外设寄存器,主要是透过I2C_RDWR这个IO控制命令将i2c_msg数组传递给kernel去执行。下面的代码可以完成这个功能:

  1. #include <stdio.h>
  2. #include <linux/types.h>
  3. #include <fcntl.h>
  4. #include <unistd.h>
  5. #include <stdlib.h>
  6. #include <sys/types.h>
  7. #include <sys/ioctl.h>
  8. #include <errno.h>
  9. #include <assert.h>
  10. #include <string.h>
  11. #include <linux/i2c.h>
  12. /* This is the structure as used in the I2C_RDWR ioctl call */
  13. struct i2c_rdwr_ioctl_data {
  14. struct i2c_msg __user *msgs;    /* pointers to i2c_msgs */
  15. __u32 nmsgs;                    /* number of i2c_msgs */
  16. };
  17. int i2c_read_reg(char *dev, unsigned char *buf, unsigned slave_address, unsigned reg_address, int len)
  18. {
  19. struct i2c_rdwr_ioctl_data work_queue;
  20. unsigned char w_val = reg_address;
  21. int ret;
  22. int fd = open(dev, O_RDWR);
  23. if (!fd) {
  24. printf("Error on opening the device file\n");
  25. return 0;
  26. }
  27. work_queue.nmsgs = 2;
  28. work_queue.msgs = (struct i2c_msg*)malloc(work_queue.nmsgs *sizeof(struct
  29. i2c_msg));
  30. if (!work_queue.msgs) {
  31. printf("Memory alloc error\n");
  32. close(fd);
  33. return 0;
  34. }
  35. ioctl(fd, I2C_TIMEOUT, 2);
  36. ioctl(fd, I2C_RETRIES, 1);
  37. (work_queue.msgs[0]).len = 1;
  38. (work_queue.msgs[0]).addr = slave_address;
  39. (work_queue.msgs[0]).buf = &w_val;
  40. (work_queue.msgs[1]).len = len;
  41. (work_queue.msgs[1]).flags = I2C_M_RD;
  42. (work_queue.msgs[1]).addr = slave_address;
  43. (work_queue.msgs[1]).buf = buf;
  44. ret = ioctl(fd, I2C_RDWR, (unsigned long) &work_queue);
  45. if (ret < 0) {
  46. printf("Error during I2C_RDWR ioctl with error code: %d\n", ret);
  47. close(fd);
  48. free(work_queue.msgs);
  49. return 0;
  50. } else {
  51. printf("read salve:%02x reg:%02x\n", slave_address, reg_address);
  52. close(fd);
  53. free(work_queue.msgs);
  54. return len;
  55. }
  56. }
  57. int i2c_write_reg(char *dev, unsigned char *buf, unsigned slave_address, unsigned reg_address, int len)
  58. {
  59. struct i2c_rdwr_ioctl_data work_queue;
  60. unsigned char w_val = reg_address;
  61. unsigned char w_buf[len+1];
  62. int ret;
  63. w_buf[0] = reg_address;
  64. int fd = open(dev, O_RDWR);
  65. if (!fd) {
  66. printf("Error on opening the device file\n");
  67. return 0;
  68. }
  69. work_queue.nmsgs = 1;
  70. work_queue.msgs = (struct i2c_msg*)malloc(work_queue.nmsgs *sizeof(struct
  71. i2c_msg));
  72. if (!work_queue.msgs) {
  73. printf("Memory alloc error\n");
  74. close(fd);
  75. return 0;
  76. }
  77. ioctl(fd, I2C_TIMEOUT, 2);
  78. ioctl(fd, I2C_RETRIES, 1);
  79. (work_queue.msgs[0]).len = 1 + len;
  80. (work_queue.msgs[0]).addr = slave_address;
  81. (work_queue.msgs[0]).buf = w_buf;
  82. memcpy(w_buf + 1, buf, len);
  83. ret = ioctl(fd, I2C_RDWR, (unsigned long) &work_queue);
  84. if (ret < 0) {
  85. printf("Error during I2C_RDWR ioctl with error code: %d\n", ret);
  86. close(fd);
  87. free(work_queue.msgs);
  88. return 0;
  89. } else {
  90. printf("write salve:%02x reg:%02x\n", slave_address, reg_address);
  91. close(fd);
  92. free(work_queue.msgs);
  93. return len;
  94. }
  95. }
  96. int main(int argc, char **argv)
  97. {
  98. unsigned int fd;
  99. unsigned int slave_address, reg_address;
  100. unsigned r_w;
  101. unsigned w_val;
  102. unsigned char rw_val;
  103. if (argc < 5) {
  104. printf("Usage:\n%s /dev/i2c-x start_addr reg_addr rw[0|1] [write_val]\n", argv[0]);
  105. return 0;
  106. }
  107. fd = open(argv[1], O_RDWR);
  108. if (!fd) {
  109. printf("Error on opening the device file %s\n", argv[1]);
  110. return 0;
  111. }
  112. sscanf(argv[2], "%x", &slave_address);
  113. sscanf(argv[3], "%x", ®_address);
  114. sscanf(argv[4], "%d", &r_w);
  115. if (r_w == 0) {
  116. i2c_read_reg(argv[1], &rw_val, slave_address, reg_address, 1);
  117. printf("Read %s-%x reg %x, read value:%x\n", argv[1], slave_address, reg_address, rw_val);
  118. } else {
  119. if (argc < 6) {
  120. printf("Usage:\n%s /dev/i2c-x start_addr reg_addr r|w[0|1] [write_val]\n", argv[0]);
  121. return 0;
  122. }
  123. sscanf(argv[5], "%d", &w_val);
  124. if ((w_val & ~0xff) != 0)
  125. printf("Error on written value %s\n", argv[5]);
  126. rw_val = (unsigned char)w_val;
  127. i2c_write_reg(argv[1], &rw_val, slave_address, reg_address, 1);
  128. }
  129. return 0;
  130. }

在android/external/新建i2c-util目录,上述源代码存入android/external/i2c-util/i2c-util.c,编写对应的Android.mk:

  1. LOCAL_PATH := $(call my-dir)
  2. include $(CLEAR_VARS)
  3. LOCAL_MODULE_TAGS := optional
  4. LOCAL_MODULE := i2c-util
  5. LOCAL_SRC_FILES += \
  6. i2c-util.c \
  7. include $(BUILD_EXECUTABLE)

编译Android后,上述工具会位于/system/bin目录。在电路板上使用它:

  1. / #  i2c-rw /dev/i2c-2 0x38 0x1 0
  2. read salve:38 reg:01 value:12
  3. / #
  4. / #  i2c-rw /dev/i2c-2 0x38 0x2 0
  5. read salve:38 reg:02 value:81
上一篇:Android源码中添加C可执行程序


下一篇:深入理解java虚拟机(二)-----垃圾回收