spidevc.c 6.6 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207
  1. /*
  2. * Copyright 2013 bitfury
  3. *
  4. * Permission is hereby granted, free of charge, to any person obtaining a copy
  5. * of this software and associated documentation files (the "Software"), to deal
  6. * in the Software without restriction, including without limitation the rights
  7. * to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
  8. * copies of the Software, and to permit persons to whom the Software is
  9. * furnished to do so, subject to the following conditions:
  10. *
  11. * The above copyright notice and this permission notice shall be included in
  12. * all copies or substantial portions of the Software.
  13. *
  14. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
  15. * IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
  16. * FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
  17. * AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
  18. * LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
  19. * OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
  20. * THE SOFTWARE.
  21. */
  22. #include "spidevc.h"
  23. #include <sys/mman.h>
  24. #include <stdint.h>
  25. #include <unistd.h>
  26. #include <stdio.h>
  27. #include <stdlib.h>
  28. #include <string.h>
  29. #include <getopt.h>
  30. #include <fcntl.h>
  31. #include <sys/ioctl.h>
  32. #include <linux/types.h>
  33. #include <signal.h>
  34. #include <sys/types.h>
  35. #include <linux/spi/spidev.h>
  36. #include <time.h>
  37. #include <unistd.h>
  38. #include <linux/i2c.h>
  39. #include <linux/i2c-dev.h>
  40. #include <sys/stat.h>
  41. static volatile unsigned *gpio;
  42. void spi_init(void)
  43. {
  44. int fd;
  45. fd = open("/dev/mem",O_RDWR|O_SYNC);
  46. if (fd < 0) { perror("/dev/mem trouble"); exit(1); }
  47. gpio = mmap(0,4096,PROT_READ|PROT_WRITE,MAP_SHARED,fd,0x20200000);
  48. if (gpio == MAP_FAILED) { perror("gpio mmap trouble"); exit(1); }
  49. close(fd);
  50. }
  51. #define INP_GPIO(g) *(gpio+((g)/10)) &= ~(7<<(((g)%10)*3))
  52. #define OUT_GPIO(g) *(gpio+((g)/10)) |= (1<<(((g)%10)*3))
  53. #define SET_GPIO_ALT(g,a) *(gpio+(((g)/10))) |= (((a)<=3?(a)+4:(a)==4?3:2)<<(((g)%10)*3))
  54. #define GPIO_SET *(gpio+7) // sets bits which are 1 ignores bits which are 0
  55. #define GPIO_CLR *(gpio+10) // clears bits which are 1 ignores bits which are 0
  56. // Bit-banging reset, to reset more chips in chain - toggle for longer period... Each 3 reset cycles reset first chip in chain
  57. void spi_reset(void)
  58. {
  59. int i;
  60. INP_GPIO(10); OUT_GPIO(10);
  61. INP_GPIO(11); OUT_GPIO(11);
  62. GPIO_SET = 1 << 11; // Set SCK
  63. for (i = 0; i < 16; i++) { // On standard settings this unoptimized code produces 1 Mhz freq.
  64. GPIO_SET = 1 << 10;
  65. GPIO_SET = 1 << 10;
  66. GPIO_SET = 1 << 10;
  67. GPIO_SET = 1 << 10;
  68. GPIO_SET = 1 << 10;
  69. GPIO_SET = 1 << 10;
  70. GPIO_SET = 1 << 10;
  71. GPIO_SET = 1 << 10;
  72. GPIO_SET = 1 << 10;
  73. GPIO_SET = 1 << 10;
  74. GPIO_SET = 1 << 10;
  75. GPIO_SET = 1 << 10;
  76. GPIO_CLR = 1 << 10;
  77. GPIO_CLR = 1 << 10;
  78. GPIO_CLR = 1 << 10;
  79. GPIO_CLR = 1 << 10;
  80. GPIO_CLR = 1 << 10;
  81. GPIO_CLR = 1 << 10;
  82. GPIO_CLR = 1 << 10;
  83. GPIO_CLR = 1 << 10;
  84. GPIO_CLR = 1 << 10;
  85. GPIO_CLR = 1 << 10;
  86. GPIO_CLR = 1 << 10;
  87. GPIO_CLR = 1 << 10;
  88. }
  89. GPIO_CLR = 1 << 10;
  90. GPIO_CLR = 1 << 11;
  91. INP_GPIO(10);
  92. SET_GPIO_ALT(10,0);
  93. INP_GPIO(11);
  94. SET_GPIO_ALT(11,0);
  95. INP_GPIO(9);
  96. SET_GPIO_ALT(9,0);
  97. }
  98. int spi_txrx(const char *wrbuf, char *rdbuf, int bufsz)
  99. {
  100. int fd;
  101. int mode, bits, speed, rv, i, j;
  102. struct timespec tv;
  103. struct spi_ioc_transfer tr[16];
  104. memset(&tr,0,sizeof(tr));
  105. mode = 0; bits = 8; speed = 200000;
  106. spi_reset();
  107. fd = open("/dev/spidev0.0", O_RDWR);
  108. if (fd < 0) { perror("Unable to open SPI device"); exit(1); }
  109. if (ioctl(fd, SPI_IOC_WR_MODE, &mode) < 0) { perror("Unable to set WR MODE"); close(fd); return -1; }
  110. if (ioctl(fd, SPI_IOC_RD_MODE, &mode) < 0) { perror("Unable to set RD MODE"); close(fd); return -1; }
  111. if (ioctl(fd, SPI_IOC_WR_BITS_PER_WORD, &bits) < 0) { perror("Unable to set WR_BITS_PER_WORD"); close(fd); return -1; }
  112. if (ioctl(fd, SPI_IOC_RD_BITS_PER_WORD, &bits) < 0) { perror("Unable to set RD_BITS_PER_WORD"); close(fd); return -1; }
  113. if (ioctl(fd, SPI_IOC_WR_MAX_SPEED_HZ, &speed) < 0) { perror("Unable to set WR_MAX_SPEED_HZ"); close(fd); return -1; }
  114. if (ioctl(fd, SPI_IOC_RD_MAX_SPEED_HZ, &speed) < 0) { perror("Unable to set RD_MAX_SPEED_HZ"); close(fd); return -1; }
  115. rv = 0;
  116. while (bufsz >= 4096) {
  117. tr[rv].tx_buf = (uintptr_t) wrbuf;
  118. tr[rv].rx_buf = (uintptr_t) rdbuf;
  119. tr[rv].len = 4096;
  120. tr[rv].delay_usecs = 1;
  121. tr[rv].speed_hz = speed;
  122. tr[rv].bits_per_word = bits;
  123. bufsz -= 4096;
  124. wrbuf += 4096; rdbuf += 4096; rv ++;
  125. }
  126. if (bufsz > 0) {
  127. tr[rv].tx_buf = (uintptr_t) wrbuf;
  128. tr[rv].rx_buf = (uintptr_t) rdbuf;
  129. tr[rv].len = (unsigned)bufsz;
  130. tr[rv].delay_usecs = 1;
  131. tr[rv].speed_hz = speed;
  132. tr[rv].bits_per_word = bits;
  133. rv ++;
  134. }
  135. i = rv;
  136. for (j = 0; j < i; j++) {
  137. rv = (int)ioctl(fd, SPI_IOC_MESSAGE(1), (intptr_t)&tr[j]);
  138. if (rv < 0) { perror("WTF!"); close(fd); return -1; }
  139. }
  140. close(fd);
  141. return 0;
  142. }
  143. #define SPIMAXSZ 256*1024
  144. static unsigned char spibuf[SPIMAXSZ], spibuf_rx[SPIMAXSZ];
  145. static unsigned spibufsz;
  146. void spi_clear_buf(void) { spibufsz = 0; }
  147. unsigned char *spi_getrxbuf(void) { return spibuf_rx; }
  148. unsigned char *spi_gettxbuf(void) { return spibuf; }
  149. unsigned spi_getbufsz(void) { return spibufsz; }
  150. void spi_emit_buf_reverse(const char *str, unsigned sz)
  151. {
  152. unsigned i;
  153. if (spibufsz + sz >= SPIMAXSZ) return;
  154. for (i = 0; i < sz; i++) { // Reverse bit order in each byte!
  155. unsigned char p = str[i];
  156. p = ((p & 0xaa)>>1) | ((p & 0x55) << 1);
  157. p = ((p & 0xcc)>>2) | ((p & 0x33) << 2);
  158. p = ((p & 0xf0)>>4) | ((p & 0x0f) << 4);
  159. spibuf[spibufsz+i] = p;
  160. }
  161. spibufsz += sz;
  162. }
  163. void spi_emit_buf(const char *str, unsigned sz)
  164. {
  165. unsigned i;
  166. if (spibufsz + sz >= SPIMAXSZ) return;
  167. memcpy(&spibuf[spibufsz], str, sz); spibufsz += sz;
  168. }
  169. /* TODO: in production, emit just bit-sequences! Eliminate padding to byte! */
  170. void spi_emit_break(void) { spi_emit_buf("\x4", 1); }
  171. void spi_emit_fsync(void) { spi_emit_buf("\x6", 1); }
  172. void spi_emit_fasync(int n) {
  173. int i;
  174. for (i = 0; i < n; i++) {
  175. spi_emit_buf("\x5", 1);
  176. }
  177. }
  178. void spi_emit_data(unsigned addr, const char *buf, unsigned len)
  179. {
  180. unsigned char otmp[3];
  181. if (len < 4 || len > 128) return; /* This cannot be programmed in single frame! */
  182. len /= 4; /* Strip */
  183. otmp[0] = (len - 1) | 0xE0;
  184. otmp[1] = (addr >> 8)&0xFF; otmp[2] = addr & 0xFF;
  185. spi_emit_buf(otmp, 3);
  186. spi_emit_buf_reverse(buf, len*4);
  187. }