spidevc.c 6.3 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200
  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,j;
  60. int a = 1234, len = 2;
  61. INP_GPIO(10); OUT_GPIO(10);
  62. INP_GPIO(11); OUT_GPIO(11);
  63. GPIO_SET = 1 << 11; // Set SCK
  64. for (i = 0; i < 16; i++) { // On standard settings this unoptimized code produces 1 Mhz freq.
  65. GPIO_SET = 1 << 10;
  66. for (j = 0; j < len; j++) {
  67. a *= a;
  68. }
  69. GPIO_CLR = 1 << 10;
  70. for (j = 0; j < len; j++) {
  71. a *= a;
  72. }
  73. }
  74. GPIO_CLR = 1 << 10;
  75. GPIO_CLR = 1 << 11;
  76. INP_GPIO(10);
  77. SET_GPIO_ALT(10,0);
  78. INP_GPIO(11);
  79. SET_GPIO_ALT(11,0);
  80. INP_GPIO(9);
  81. SET_GPIO_ALT(9,0);
  82. }
  83. int spi_txrx(const char *wrbuf, char *rdbuf, int bufsz)
  84. {
  85. int fd;
  86. int mode, bits, speed, rv, i, j;
  87. struct timespec tv;
  88. struct spi_ioc_transfer tr[16];
  89. memset(&tr,0,sizeof(tr));
  90. mode = 0; bits = 8; speed = 2000000;
  91. spi_reset();
  92. fd = open("/dev/spidev0.0", O_RDWR);
  93. if (fd < 0) { perror("Unable to open SPI device"); exit(1); }
  94. if (ioctl(fd, SPI_IOC_WR_MODE, &mode) < 0) { perror("Unable to set WR MODE"); close(fd); return -1; }
  95. if (ioctl(fd, SPI_IOC_RD_MODE, &mode) < 0) { perror("Unable to set RD MODE"); close(fd); return -1; }
  96. if (ioctl(fd, SPI_IOC_WR_BITS_PER_WORD, &bits) < 0) { perror("Unable to set WR_BITS_PER_WORD"); close(fd); return -1; }
  97. if (ioctl(fd, SPI_IOC_RD_BITS_PER_WORD, &bits) < 0) { perror("Unable to set RD_BITS_PER_WORD"); close(fd); return -1; }
  98. if (ioctl(fd, SPI_IOC_WR_MAX_SPEED_HZ, &speed) < 0) { perror("Unable to set WR_MAX_SPEED_HZ"); close(fd); return -1; }
  99. if (ioctl(fd, SPI_IOC_RD_MAX_SPEED_HZ, &speed) < 0) { perror("Unable to set RD_MAX_SPEED_HZ"); close(fd); return -1; }
  100. rv = 0;
  101. while (bufsz >= 4096) {
  102. tr[rv].tx_buf = (uintptr_t) wrbuf;
  103. tr[rv].rx_buf = (uintptr_t) rdbuf;
  104. tr[rv].len = 4096;
  105. tr[rv].delay_usecs = 1;
  106. tr[rv].speed_hz = speed;
  107. tr[rv].bits_per_word = bits;
  108. bufsz -= 4096;
  109. wrbuf += 4096; rdbuf += 4096; rv ++;
  110. }
  111. if (bufsz > 0) {
  112. tr[rv].tx_buf = (uintptr_t) wrbuf;
  113. tr[rv].rx_buf = (uintptr_t) rdbuf;
  114. tr[rv].len = (unsigned)bufsz;
  115. tr[rv].delay_usecs = 1;
  116. tr[rv].speed_hz = speed;
  117. tr[rv].bits_per_word = bits;
  118. rv ++;
  119. }
  120. i = rv;
  121. for (j = 0; j < i; j++) {
  122. rv = (int)ioctl(fd, SPI_IOC_MESSAGE(1), (intptr_t)&tr[j]);
  123. if (rv < 0) { perror("WTF!"); close(fd); return -1; }
  124. }
  125. close(fd);
  126. spi_reset();
  127. return 0;
  128. }
  129. #define SPIMAXSZ 256*1024
  130. static unsigned char spibuf[SPIMAXSZ], spibuf_rx[SPIMAXSZ];
  131. static unsigned spibufsz;
  132. void spi_clear_buf(void) { spibufsz = 0; }
  133. unsigned char *spi_getrxbuf(void) { return spibuf_rx; }
  134. unsigned char *spi_gettxbuf(void) { return spibuf; }
  135. unsigned spi_getbufsz(void) { return spibufsz; }
  136. void spi_emit_buf_reverse(const char *str, unsigned sz)
  137. {
  138. unsigned i;
  139. if (spibufsz + sz >= SPIMAXSZ) return;
  140. for (i = 0; i < sz; i++) { // Reverse bit order in each byte!
  141. unsigned char p = str[i];
  142. p = ((p & 0xaa)>>1) | ((p & 0x55) << 1);
  143. p = ((p & 0xcc)>>2) | ((p & 0x33) << 2);
  144. p = ((p & 0xf0)>>4) | ((p & 0x0f) << 4);
  145. spibuf[spibufsz+i] = p;
  146. }
  147. spibufsz += sz;
  148. }
  149. void spi_emit_buf(const char *str, unsigned sz)
  150. {
  151. unsigned i;
  152. if (spibufsz + sz >= SPIMAXSZ) return;
  153. memcpy(&spibuf[spibufsz], str, sz); spibufsz += sz;
  154. }
  155. /* TODO: in production, emit just bit-sequences! Eliminate padding to byte! */
  156. void spi_emit_break(void) { spi_emit_buf("\x4", 1); }
  157. void spi_emit_fsync(void) { spi_emit_buf("\x6", 1); }
  158. void spi_emit_fasync(int n) {
  159. int i;
  160. for (i = 0; i < n; i++) {
  161. spi_emit_buf("\x5", 1);
  162. }
  163. }
  164. void spi_emit_nop(int n) {
  165. int i;
  166. for (i = 0; i < n; n++) {
  167. spi_emit_buf("\x0", 1);
  168. }
  169. }
  170. void spi_emit_data(unsigned addr, const char *buf, unsigned len)
  171. {
  172. unsigned char otmp[3];
  173. if (len < 4 || len > 128) return; /* This cannot be programmed in single frame! */
  174. len /= 4; /* Strip */
  175. otmp[0] = (len - 1) | 0xE0;
  176. otmp[1] = (addr >> 8)&0xFF; otmp[2] = addr & 0xFF;
  177. spi_emit_buf(otmp, 3);
  178. spi_emit_buf_reverse(buf, len*4);
  179. }