visus
/
teensy-core-4.1
Watch 1
Star 0
Fork 0
Code Issues 0 Pull Requests 0 Releases 0 Wiki Activity
Teensy 4.1 core updated for C++20
You can not select more than 25 topics Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
76 Commits
2 Branches
Tree: 351efa83c4
Branches Tags
${ item.name }
Create branch ${ searchTerm }
from '351efa83c4'
${ noResults }
teensy-core-4.1/teensy3/SPIFIFO.h

215 lines
8.8KB
Raw Blame History 

  1. #ifndef _SPIFIFO_h_

  2. #define _SPIFIFO_h_

  3. 

  4. #include "avr_emulation.h"

  5. 

  6. #if F_BUS == 60000000

  7. #define HAS_SPIFIFO

  8. #define SPI_CLOCK_24MHz   (SPI_CTAR_PBR(1) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(60 / 3) * ((1+1)/2) = 20 MHz

  9. #define SPI_CLOCK_16MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0))                //(60 / 2) * ((1+0)/2) = 15 MHz

  10. #define SPI_CLOCK_12MHz   (SPI_CTAR_PBR(2) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(60 / 5) * ((1+1)/2)

  11. #define SPI_CLOCK_8MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(1))                //(60 / 2) * ((1+0)/4) = 7.5 MHz

  12. #define SPI_CLOCK_6MHz    (SPI_CTAR_PBR(2) | SPI_CTAR_BR(0))                //(60 / 5) * ((1+0)/2)

  13. #define SPI_CLOCK_4MHz    (SPI_CTAR_PBR(2) | SPI_CTAR_BR(2) | SPI_CTAR_DBR) //(60 / 5) * ((1+1)/6)

  14. 

  15. #elif F_BUS == 56000000

  16. #define HAS_SPIFIFO

  17. #define SPI_CLOCK_24MHz   (SPI_CTAR_PBR(1) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(56 / 3) * ((1+1)/2) = 18.67

  18. #define SPI_CLOCK_16MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0))                //(56 / 2) * ((1+0)/2) = 14

  19. #define SPI_CLOCK_12MHz   (SPI_CTAR_PBR(2) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(56 / 5) * ((1+1)/2) = 11.2

  20. #define SPI_CLOCK_8MHz    (SPI_CTAR_PBR(3) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(56 / 7) * ((1+1)/2)

  21. #define SPI_CLOCK_6MHz    (SPI_CTAR_PBR(2) | SPI_CTAR_BR(0))                //(56 / 5) * ((1+0)/2)

  22. #define SPI_CLOCK_4MHz    (SPI_CTAR_PBR(3) | SPI_CTAR_BR(0))                //(56 / 7) * ((1+0)/2)

  23. 

  24. #elif F_BUS == 48000000

  25. #define HAS_SPIFIFO

  26. #define SPI_CLOCK_24MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(48 / 2) * ((1+1)/2)

  27. #define SPI_CLOCK_16MHz   (SPI_CTAR_PBR(1) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(48 / 3) * ((1+1)/2)

  28. #define SPI_CLOCK_12MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0))                //(48 / 2) * ((1+0)/2)

  29. #define SPI_CLOCK_8MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(2) | SPI_CTAR_DBR) //(48 / 2) * ((1+1)/6)

  30. #define SPI_CLOCK_6MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(1))                //(48 / 2) * ((1+0)/4)

  31. #define SPI_CLOCK_4MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(2))                //(48 / 2) * ((1+0)/6)

  32. 

  33. #elif F_BUS == 40000000

  34. #define HAS_SPIFIFO

  35. #define SPI_CLOCK_24MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(40 / 2) * ((1+1)/2) = 20

  36. #define SPI_CLOCK_16MHz   (SPI_CTAR_PBR(1) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(40 / 3) * ((1+1)/2) = 13.33

  37. #define SPI_CLOCK_12MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0))                //(40 / 2) * ((1+0)/2) = 10

  38. #define SPI_CLOCK_8MHz    (SPI_CTAR_PBR(2) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(40 / 5) * ((1+1)/2)

  39. #define SPI_CLOCK_6MHz    (SPI_CTAR_PBR(3) | SPI_CTAR_BR(1) | SPI_CTAR_DBR) //(40 / 7) * ((1+1)/2) = 5.71

  40. #define SPI_CLOCK_4MHz    (SPI_CTAR_PBR(2) | SPI_CTAR_BR(1))                //(40 / 5) * ((1+0)/2)

  41. 

  42. #elif F_BUS == 36000000

  43. #define HAS_SPIFIFO

  44. #define SPI_CLOCK_24MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(36 / 2) * ((1+1)/2) = 18

  45. #define SPI_CLOCK_16MHz   (SPI_CTAR_PBR(1) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(36 / 3) * ((1+1)/2) = 12

  46. #define SPI_CLOCK_12MHz   (SPI_CTAR_PBR(1) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(36 / 3) * ((1+1)/2) = 12

  47. #define SPI_CLOCK_8MHz    (SPI_CTAR_PBR(2) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(36 / 5) * ((1+1)/2) = 7.2

  48. #define SPI_CLOCK_6MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(2) | SPI_CTAR_DBR) //(36 / 2) * ((1+1)/6)

  49. #define SPI_CLOCK_4MHz    (SPI_CTAR_PBR(1) | SPI_CTAR_BR(2) | SPI_CTAR_DBR) //(36 / 3) * ((1+1)/6)

  50. 

  51. #elif F_BUS == 24000000

  52. #define HAS_SPIFIFO

  53. #define SPI_CLOCK_24MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(24 / 2) * ((1+1)/2)  12 MHz

  54. #define SPI_CLOCK_16MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(24 / 2) * ((1+1)/2)  12 MHz

  55. #define SPI_CLOCK_12MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(24 / 2) * ((1+1)/2)

  56. #define SPI_CLOCK_8MHz    (SPI_CTAR_PBR(1) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(24 / 3) * ((1+1)/2)

  57. #define SPI_CLOCK_6MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0))                //(24 / 2) * ((1+0)/2)

  58. #define SPI_CLOCK_4MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(2) | SPI_CTAR_DBR) //(24 / 2) * ((1+1)/6)

  59. 

  60. #elif F_BUS == 4000000

  61. #define HAS_SPIFIFO

  62. #define SPI_CLOCK_24MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 2 MHz

  63. #define SPI_CLOCK_16MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 2 MHz

  64. #define SPI_CLOCK_12MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 2 MHz

  65. #define SPI_CLOCK_8MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 2 MHz

  66. #define SPI_CLOCK_6MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 2 MHz

  67. #define SPI_CLOCK_4MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 2 MHz

  68. 

  69. #elif F_BUS == 2000000

  70. #define HAS_SPIFIFO

  71. #define SPI_CLOCK_24MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 1 MHz

  72. #define SPI_CLOCK_16MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 1 MHz

  73. #define SPI_CLOCK_12MHz   (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 1 MHz

  74. #define SPI_CLOCK_8MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 1 MHz

  75. #define SPI_CLOCK_6MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 1 MHz

  76. #define SPI_CLOCK_4MHz    (SPI_CTAR_PBR(0) | SPI_CTAR_BR(0) | SPI_CTAR_DBR) //(4 / 2) * ((1+1)/2) = 1 MHz

  77. 

  78. #endif

  79. 

  80. /*

  81. #! /usr/bin/perl

  82. $clock = 60;

  83. for $i (2, 3, 5, 7) {

  84.         for $j (0, 1) {

  85.                 for $k (2, 4, 6, 8, 16, 32) {

  86.                         $out = $clock / $i * (1 + $j) / $k;

  87.                         printf "%0.2f :  ", $out;

  88.                         print "$clock / $i * (1 + $j) / $k = $out\n";

  89.                 }

  90.         }

  91. }

  92. */

  93. 

  94. // sck = F_BUS / PBR * ((1+DBR)/BR)

  95. //  PBR = 2, 3, 5, 7

  96. //  DBR = 0, 1         -- zero preferred

  97. //  BR = 2, 4, 6, 8, 16, 32, 64, 128, 256, 512

  98. 

  99. 

  100. #ifdef HAS_SPIFIFO

  101. 

  102. #ifndef SPI_MODE0

  103. #define SPI_MODE0 0x00  // CPOL = 0, CPHA = 0

  104. #define SPI_MODE1 0x04  // CPOL = 0, CPHA = 1

  105. #define SPI_MODE2 0x08  // CPOL = 1, CPHA = 0

  106. #define SPI_MODE3 0x0C  // CPOL = 1, CPHA = 1

  107. #endif

  108. 

  109. #define SPI_CONTINUE 1

  110. 

  111. class SPIFIFOclass

  112. {

  113. public:

  114. 	inline void begin(uint8_t pin, uint32_t speed, uint32_t mode=SPI_MODE0) __attribute__((always_inline)) {

  115. 		uint32_t p, ctar = speed;

  116. 		SIM_SCGC6 |= SIM_SCGC6_SPI0;

  117. 

  118. 		SPI0.MCR = SPI_MCR_MSTR | SPI_MCR_MDIS | SPI_MCR_HALT | SPI_MCR_PCSIS(0x1F);

  119. 		if (mode & 0x08) ctar |= SPI_CTAR_CPOL;

  120. 		if (mode & 0x04) {

  121. 			ctar |= SPI_CTAR_CPHA;

  122. 			ctar |= (ctar & 0x0F) << 8;

  123. 		} else {

  124. 			ctar |= (ctar & 0x0F) << 12;

  125. 		}

  126. 		SPI0.CTAR0 = ctar | SPI_CTAR_FMSZ(7);

  127. 		SPI0.CTAR1 = ctar | SPI_CTAR_FMSZ(15);

  128. 		if (pin == 10) {         // PTC4

  129. 			CORE_PIN10_CONFIG = PORT_PCR_MUX(2);

  130. 			p = 0x01;

  131. 		} else if (pin == 2) {   // PTD0

  132. 			CORE_PIN2_CONFIG = PORT_PCR_MUX(2);

  133. 			p = 0x01;

  134. 		} else if (pin == 9) {   // PTC3

  135. 			CORE_PIN9_CONFIG = PORT_PCR_MUX(2);

  136. 			p = 0x02;

  137. 		} else if (pin == 6) {   // PTD4

  138. 			CORE_PIN6_CONFIG = PORT_PCR_MUX(2);

  139. 			p = 0x02;

  140. 		} else if (pin == 20) {  // PTD5

  141. 			CORE_PIN20_CONFIG = PORT_PCR_MUX(2);

  142. 			p = 0x04;

  143. 		} else if (pin == 23) {  // PTC2

  144. 			CORE_PIN23_CONFIG = PORT_PCR_MUX(2);

  145. 			p = 0x04;

  146. 		} else if (pin == 21) {  // PTD6

  147. 			CORE_PIN21_CONFIG = PORT_PCR_MUX(2);

  148. 			p = 0x08;

  149. 		} else if (pin == 22) {  // PTC1

  150. 			CORE_PIN22_CONFIG = PORT_PCR_MUX(2);

  151. 			p = 0x08;

  152. 		} else if (pin == 15) {  // PTC0

  153. 			CORE_PIN15_CONFIG = PORT_PCR_MUX(2);

  154. 			p = 0x10;

  155. 		} else {

  156. 			reg = portOutputRegister(pin);

  157. 			*reg = 1;

  158. 			pinMode(pin, OUTPUT);

  159. 			p = 0;

  160. 		}

  161. 		pcs = p;

  162. 		clear();

  163. 		SPCR.enable_pins();

  164. 	}

  165. 	inline void write(uint32_t b, uint32_t cont=0) __attribute__((always_inline)) {

  166. 		uint32_t pcsbits = pcs << 16;

  167. 		if (pcsbits) {

  168. 			SPI0.PUSHR = (b & 0xFF) | pcsbits | (cont ? SPI_PUSHR_CONT : 0);

  169. 			while (((SPI0.SR) & (15 << 12)) > (3 << 12)) ; // wait if FIFO full

  170. 		} else {

  171. 			*reg = 0;

  172. 			SPI0.SR = SPI_SR_EOQF;

  173. 			SPI0.PUSHR = (b & 0xFF) | (cont ? 0 : SPI_PUSHR_EOQ);

  174. 			if (cont) {

  175. 				while (((SPI0.SR) & (15 << 12)) > (3 << 12)) ;

  176. 			} else {

  177. 				while (!(SPI0.SR & SPI_SR_EOQF)) ;

  178. 				*reg = 1;

  179. 			}

  180. 		}

  181. 	}

  182. 	inline void write16(uint32_t b, uint32_t cont=0) __attribute__((always_inline)) {

  183. 		uint32_t pcsbits = pcs << 16;

  184. 		if (pcsbits) {

  185. 			SPI0.PUSHR = (b & 0xFFFF) | (pcs << 16) |

  186. 				(cont ? SPI_PUSHR_CONT : 0) | SPI_PUSHR_CTAS(1);

  187. 			while (((SPI0.SR) & (15 << 12)) > (3 << 12)) ;

  188. 		} else {

  189. 			*reg = 0;

  190. 			SPI0.SR = SPI_SR_EOQF;

  191. 			SPI0.PUSHR = (b & 0xFFFF) | (cont ? 0 : SPI_PUSHR_EOQ) | SPI_PUSHR_CTAS(1);

  192. 			if (cont) {

  193. 				while (((SPI0.SR) & (15 << 12)) > (3 << 12)) ;

  194. 			} else {

  195. 				while (!(SPI0.SR & SPI_SR_EOQF)) ;

  196. 				*reg = 1;

  197. 			}

  198. 		}

  199. 	}

  200. 	inline uint32_t read(void) __attribute__((always_inline)) {

  201. 		while ((SPI0.SR & (15 << 4)) == 0) ;  // TODO, could wait forever

  202. 		return SPI0.POPR;

  203. 	}

  204. 	inline void clear(void) __attribute__((always_inline)) {

  205. 		SPI0.MCR = SPI_MCR_MSTR | SPI_MCR_PCSIS(0x1F) | SPI_MCR_CLR_TXF | SPI_MCR_CLR_RXF;

  206. 	}

  207. private:

  208. 	static uint8_t pcs;

  209. 	static volatile uint8_t *reg;

  210. };

  211. extern SPIFIFOclass SPIFIFO;

  212. 

  213. #endif

  214. #endif