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.

пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 10 година
пре 11 година
пре 10 година
пре 11 година
пре 8 година
пре 8 година
пре 11 година
пре 11 година
пре 10 година
пре 11 година
пре 10 година
пре 10 година
пре 10 година
пре 11 година
пре 11 година
пре 11 година
пре 8 година
пре 8 година
пре 8 година
пре 8 година
пре 11 година
пре 11 година
пре 8 година
пре 8 година
пре 8 година
пре 8 година
пре 8 година
пре 8 година
пре 8 година
пре 8 година
пре 8 година
пре 11 година
пре 10 година
пре 11 година
пре 11 година
пре 10 година
пре 11 година
пре 10 година
пре 10 година
пре 10 година
пре 10 година
пре 11 година
пре 10 година
пре 11 година
пре 11 година
пре 11 година
пре 10 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 10 година
пре 11 година
пре 10 година
пре 10 година
пре 10 година
пре 11 година
пре 11 година
пре 11 година
пре 11 година
пре 10 година
пре 11 година
пре 11 година
123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599
  1. /* Teensyduino Core Library
  2. * http://www.pjrc.com/teensy/
  3. * Copyright (c) 2013 PJRC.COM, LLC.
  4. *
  5. * Permission is hereby granted, free of charge, to any person obtaining
  6. * a copy of this software and associated documentation files (the
  7. * "Software"), to deal in the Software without restriction, including
  8. * without limitation the rights to use, copy, modify, merge, publish,
  9. * distribute, sublicense, and/or sell copies of the Software, and to
  10. * permit persons to whom the Software is furnished to do so, subject to
  11. * the following conditions:
  12. *
  13. * 1. The above copyright notice and this permission notice shall be
  14. * included in all copies or substantial portions of the Software.
  15. *
  16. * 2. If the Software is incorporated into a build system that allows
  17. * selection among a list of target devices, then similar target
  18. * devices manufactured by PJRC.COM must be included in the list of
  19. * target devices and selectable in the same manner.
  20. *
  21. * THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND,
  22. * EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF
  23. * MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND
  24. * NONINFRINGEMENT. IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS
  25. * BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN
  26. * ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN
  27. * CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN THE
  28. * SOFTWARE.
  29. */
  30. #include "kinetis.h"
  31. #include "core_pins.h"
  32. #include "HardwareSerial.h"
  33. ////////////////////////////////////////////////////////////////
  34. // Tunable parameters (relatively safe to edit these numbers)
  35. ////////////////////////////////////////////////////////////////
  36. #define TX_BUFFER_SIZE 40 // number of outgoing bytes to buffer
  37. #define RX_BUFFER_SIZE 64 // number of incoming bytes to buffer
  38. #define RTS_HIGH_WATERMARK 40 // RTS requests sender to pause
  39. #define RTS_LOW_WATERMARK 26 // RTS allows sender to resume
  40. #define IRQ_PRIORITY 64 // 0 = highest priority, 255 = lowest
  41. ////////////////////////////////////////////////////////////////
  42. // changes not recommended below this point....
  43. ////////////////////////////////////////////////////////////////
  44. #ifdef SERIAL_9BIT_SUPPORT
  45. static uint8_t use9Bits = 0;
  46. #define BUFTYPE uint16_t
  47. #else
  48. #define BUFTYPE uint8_t
  49. #define use9Bits 0
  50. #endif
  51. static volatile BUFTYPE tx_buffer[TX_BUFFER_SIZE];
  52. static volatile BUFTYPE rx_buffer[RX_BUFFER_SIZE];
  53. static volatile uint8_t transmitting = 0;
  54. #if defined(KINETISK)
  55. static volatile uint8_t *transmit_pin=NULL;
  56. #define transmit_assert() *transmit_pin = 1
  57. #define transmit_deassert() *transmit_pin = 0
  58. static volatile uint8_t *rts_pin=NULL;
  59. #define rts_assert() *rts_pin = 0
  60. #define rts_deassert() *rts_pin = 1
  61. #elif defined(KINETISL)
  62. static volatile uint8_t *transmit_pin=NULL;
  63. static uint8_t transmit_mask=0;
  64. #define transmit_assert() *(transmit_pin+4) = transmit_mask;
  65. #define transmit_deassert() *(transmit_pin+8) = transmit_mask;
  66. static volatile uint8_t *rts_pin=NULL;
  67. static uint8_t rts_mask=0;
  68. #define rts_assert() *(rts_pin+8) = rts_mask;
  69. #define rts_deassert() *(rts_pin+4) = rts_mask;
  70. #endif
  71. #if TX_BUFFER_SIZE > 255
  72. static volatile uint16_t tx_buffer_head = 0;
  73. static volatile uint16_t tx_buffer_tail = 0;
  74. #else
  75. static volatile uint8_t tx_buffer_head = 0;
  76. static volatile uint8_t tx_buffer_tail = 0;
  77. #endif
  78. #if RX_BUFFER_SIZE > 255
  79. static volatile uint16_t rx_buffer_head = 0;
  80. static volatile uint16_t rx_buffer_tail = 0;
  81. #else
  82. static volatile uint8_t rx_buffer_head = 0;
  83. static volatile uint8_t rx_buffer_tail = 0;
  84. #endif
  85. #if defined(KINETISK)
  86. static uint8_t rx_pin_num = 9;
  87. static uint8_t tx_pin_num = 10;
  88. #endif
  89. // UART0 and UART1 are clocked by F_CPU, UART2 is clocked by F_BUS
  90. // UART0 has 8 byte fifo, UART1 and UART2 have 1 byte buffer
  91. #ifdef HAS_KINETISK_UART1_FIFO
  92. #define C2_ENABLE UART_C2_TE | UART_C2_RE | UART_C2_RIE | UART_C2_ILIE
  93. #else
  94. #define C2_ENABLE UART_C2_TE | UART_C2_RE | UART_C2_RIE
  95. #endif
  96. #define C2_TX_ACTIVE C2_ENABLE | UART_C2_TIE
  97. #define C2_TX_COMPLETING C2_ENABLE | UART_C2_TCIE
  98. #define C2_TX_INACTIVE C2_ENABLE
  99. void serial2_begin(uint32_t divisor)
  100. {
  101. SIM_SCGC4 |= SIM_SCGC4_UART1; // turn on clock, TODO: use bitband
  102. rx_buffer_head = 0;
  103. rx_buffer_tail = 0;
  104. tx_buffer_head = 0;
  105. tx_buffer_tail = 0;
  106. transmitting = 0;
  107. #if defined(KINETISK)
  108. switch (rx_pin_num) {
  109. case 9: CORE_PIN9_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
  110. case 26: CORE_PIN26_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
  111. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  112. case 59: CORE_PIN59_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
  113. #endif
  114. }
  115. switch (tx_pin_num) {
  116. case 10: CORE_PIN10_CONFIG = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(3); break;
  117. case 31: CORE_PIN31_CONFIG = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(3); break;
  118. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  119. case 58: CORE_PIN58_CONFIG = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(3); break;
  120. #endif
  121. }
  122. #elif defined(KINETISL)
  123. CORE_PIN9_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3);
  124. CORE_PIN10_CONFIG = PORT_PCR_DSE | PORT_PCR_SRE | PORT_PCR_MUX(3);
  125. #endif
  126. #if defined(HAS_KINETISK_UART1)
  127. UART1_BDH = (divisor >> 13) & 0x1F;
  128. UART1_BDL = (divisor >> 5) & 0xFF;
  129. UART1_C4 = divisor & 0x1F;
  130. #ifdef HAS_KINETISK_UART1_FIFO
  131. UART1_C1 = UART_C1_ILT;
  132. UART1_TWFIFO = 2; // tx watermark, causes S1_TDRE to set
  133. UART1_RWFIFO = 4; // rx watermark, causes S1_RDRF to set
  134. UART1_PFIFO = UART_PFIFO_TXFE | UART_PFIFO_RXFE;
  135. #else
  136. UART1_C1 = 0;
  137. UART1_PFIFO = 0;
  138. #endif
  139. #elif defined(HAS_KINETISL_UART1)
  140. UART1_BDH = (divisor >> 8) & 0x1F;
  141. UART1_BDL = divisor & 0xFF;
  142. UART1_C1 = 0;
  143. #endif
  144. UART1_C2 = C2_TX_INACTIVE;
  145. NVIC_SET_PRIORITY(IRQ_UART1_STATUS, IRQ_PRIORITY);
  146. NVIC_ENABLE_IRQ(IRQ_UART1_STATUS);
  147. }
  148. void serial2_format(uint32_t format)
  149. {
  150. uint8_t c;
  151. c = UART1_C1;
  152. c = (c & ~0x13) | (format & 0x03); // configure parity
  153. if (format & 0x04) c |= 0x10; // 9 bits (might include parity)
  154. UART1_C1 = c;
  155. if ((format & 0x0F) == 0x04) UART1_C3 |= 0x40; // 8N2 is 9 bit with 9th bit always 1
  156. c = UART1_S2 & ~0x10;
  157. if (format & 0x10) c |= 0x10; // rx invert
  158. UART1_S2 = c;
  159. c = UART1_C3 & ~0x10;
  160. if (format & 0x20) c |= 0x10; // tx invert
  161. UART1_C3 = c;
  162. #ifdef SERIAL_9BIT_SUPPORT
  163. c = UART1_C4 & 0x1F;
  164. if (format & 0x08) c |= 0x20; // 9 bit mode with parity (requires 10 bits)
  165. UART1_C4 = c;
  166. use9Bits = format & 0x80;
  167. #endif
  168. #if defined(__MK64FX512__) || defined(__MK66FX1M0__) || defined(KINETISL)
  169. // For T3.5/T3.6/TLC See about turning on 2 stop bit mode
  170. if ( format & 0x100) {
  171. uint8_t bdl = UART1_BDL;
  172. UART1_BDH |= UART_BDH_SBNS; // Turn on 2 stop bits - was turned off by set baud
  173. UART1_BDL = bdl; // Says BDH not acted on until BDL is written
  174. }
  175. #endif
  176. }
  177. void serial2_end(void)
  178. {
  179. if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return;
  180. while (transmitting) yield(); // wait for buffered data to send
  181. NVIC_DISABLE_IRQ(IRQ_UART1_STATUS);
  182. UART1_C2 = 0;
  183. #if defined(KINETISK)
  184. switch (rx_pin_num) {
  185. case 9: CORE_PIN9_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_MUX(1); break; // PTC3
  186. #if !(defined(__MK64FX512__) || defined(__MK66FX1M0__)) // not on T3.5 or T3.6
  187. case 26: CORE_PIN26_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_MUX(1); break; // PTE1
  188. #endif
  189. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  190. case 59: CORE_PIN59_CONFIG = 0; break;
  191. #endif
  192. }
  193. switch (tx_pin_num & 127) {
  194. case 10: CORE_PIN10_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_MUX(1); break; // PTC4
  195. #if !(defined(__MK64FX512__) || defined(__MK66FX1M0__)) // not on T3.5 or T3.6
  196. case 31: CORE_PIN31_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_MUX(1); break; // PTE0
  197. #endif
  198. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  199. case 58: CORE_PIN58_CONFIG = 0; break;
  200. #endif
  201. }
  202. #elif defined(KINETISL)
  203. CORE_PIN9_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_MUX(1); // PTC3
  204. CORE_PIN10_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_MUX(1); // PTC4
  205. #endif
  206. rx_buffer_head = 0;
  207. rx_buffer_tail = 0;
  208. if (rts_pin) rts_deassert();
  209. }
  210. void serial2_set_transmit_pin(uint8_t pin)
  211. {
  212. while (transmitting) ;
  213. pinMode(pin, OUTPUT);
  214. digitalWrite(pin, LOW);
  215. transmit_pin = portOutputRegister(pin);
  216. #if defined(KINETISL)
  217. transmit_mask = digitalPinToBitMask(pin);
  218. #endif
  219. }
  220. void serial2_set_tx(uint8_t pin, uint8_t opendrain)
  221. {
  222. #if defined(KINETISK)
  223. uint32_t cfg;
  224. if (opendrain) pin |= 128;
  225. if (pin == tx_pin_num) return;
  226. if ((SIM_SCGC4 & SIM_SCGC4_UART1)) {
  227. switch (tx_pin_num & 127) {
  228. case 10: CORE_PIN10_CONFIG = 0; break; // PTC4
  229. #if !(defined(__MK64FX512__) || defined(__MK66FX1M0__)) // not on T3.5 or T3.6
  230. case 31: CORE_PIN31_CONFIG = 0; break; // PTE0
  231. #endif
  232. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  233. case 58: CORE_PIN58_CONFIG = 0; break;
  234. #endif
  235. }
  236. if (opendrain) {
  237. cfg = PORT_PCR_DSE | PORT_PCR_ODE;
  238. } else {
  239. cfg = PORT_PCR_DSE | PORT_PCR_SRE;
  240. }
  241. switch (pin & 127) {
  242. case 10: CORE_PIN10_CONFIG = cfg | PORT_PCR_MUX(3); break;
  243. #if !(defined(__MK64FX512__) || defined(__MK66FX1M0__)) // not on T3.5 or T3.6
  244. case 31: CORE_PIN31_CONFIG = cfg | PORT_PCR_MUX(3); break;
  245. #endif
  246. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  247. case 58: CORE_PIN58_CONFIG = cfg | PORT_PCR_MUX(3); break;
  248. #endif
  249. }
  250. }
  251. tx_pin_num = pin;
  252. #endif
  253. }
  254. void serial2_set_rx(uint8_t pin)
  255. {
  256. #if defined(KINETISK)
  257. if (pin == rx_pin_num) return;
  258. if ((SIM_SCGC4 & SIM_SCGC4_UART1)) {
  259. switch (rx_pin_num) {
  260. case 9: CORE_PIN9_CONFIG = 0; break; // PTC3
  261. #if !(defined(__MK64FX512__) || defined(__MK66FX1M0__)) // not on T3.5 or T3.6
  262. case 26: CORE_PIN26_CONFIG = 0; break; // PTE1
  263. #endif
  264. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  265. case 59: CORE_PIN59_CONFIG = 0; break;
  266. #endif
  267. }
  268. switch (pin) {
  269. case 9: CORE_PIN9_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
  270. #if !(defined(__MK64FX512__) || defined(__MK66FX1M0__)) // not on T3.5 or T3.6
  271. case 26: CORE_PIN26_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
  272. #endif
  273. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  274. case 59: CORE_PIN59_CONFIG = PORT_PCR_PE | PORT_PCR_PS | PORT_PCR_PFE | PORT_PCR_MUX(3); break;
  275. #endif
  276. }
  277. }
  278. rx_pin_num = pin;
  279. #endif
  280. }
  281. int serial2_set_rts(uint8_t pin)
  282. {
  283. if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return 0;
  284. if (pin < CORE_NUM_DIGITAL) {
  285. rts_pin = portOutputRegister(pin);
  286. #if defined(KINETISL)
  287. rts_mask = digitalPinToBitMask(pin);
  288. #endif
  289. pinMode(pin, OUTPUT);
  290. rts_assert();
  291. } else {
  292. rts_pin = NULL;
  293. return 0;
  294. }
  295. /*
  296. if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return 0;
  297. if (pin == 22) {
  298. CORE_PIN22_CONFIG = PORT_PCR_MUX(3);
  299. } else {
  300. UART1_MODEM &= ~UART_MODEM_RXRTSE;
  301. return 0;
  302. }
  303. UART1_MODEM |= UART_MODEM_RXRTSE;
  304. */
  305. return 1;
  306. }
  307. int serial2_set_cts(uint8_t pin)
  308. {
  309. #if defined(KINETISK)
  310. if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return 0;
  311. if (pin == 23) {
  312. CORE_PIN23_CONFIG = PORT_PCR_MUX(3) | PORT_PCR_PE; // weak pulldown
  313. #if defined USE_SDCARD_PINS && (defined(__MK64FX512__) || defined(__MK66FX1M0__)) // on T3.5 or T3.6
  314. } else if (pin == 60) {
  315. CORE_PIN60_CONFIG = PORT_PCR_MUX(3) | PORT_PCR_PE; // weak pulldown
  316. #endif
  317. } else {
  318. UART1_MODEM &= ~UART_MODEM_TXCTSE;
  319. return 0;
  320. }
  321. UART1_MODEM |= UART_MODEM_TXCTSE;
  322. return 1;
  323. #else
  324. return 0;
  325. #endif
  326. }
  327. void serial2_putchar(uint32_t c)
  328. {
  329. uint32_t head, n;
  330. if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return;
  331. if (transmit_pin) transmit_assert();
  332. head = tx_buffer_head;
  333. if (++head >= TX_BUFFER_SIZE) head = 0;
  334. while (tx_buffer_tail == head) {
  335. int priority = nvic_execution_priority();
  336. if (priority <= IRQ_PRIORITY) {
  337. if ((UART1_S1 & UART_S1_TDRE)) {
  338. uint32_t tail = tx_buffer_tail;
  339. if (++tail >= TX_BUFFER_SIZE) tail = 0;
  340. n = tx_buffer[tail];
  341. if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2);
  342. UART1_D = n;
  343. tx_buffer_tail = tail;
  344. }
  345. } else if (priority >= 256) {
  346. yield(); // wait
  347. }
  348. }
  349. tx_buffer[head] = c;
  350. transmitting = 1;
  351. tx_buffer_head = head;
  352. UART1_C2 = C2_TX_ACTIVE;
  353. }
  354. #ifdef HAS_KINETISK_UART1_FIFO
  355. void serial2_write(const void *buf, unsigned int count)
  356. {
  357. const uint8_t *p = (const uint8_t *)buf;
  358. const uint8_t *end = p + count;
  359. uint32_t head, n;
  360. if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return;
  361. if (transmit_pin) transmit_assert();
  362. while (p < end) {
  363. head = tx_buffer_head;
  364. if (++head >= TX_BUFFER_SIZE) head = 0;
  365. if (tx_buffer_tail == head) {
  366. UART1_C2 = C2_TX_ACTIVE;
  367. do {
  368. int priority = nvic_execution_priority();
  369. if (priority <= IRQ_PRIORITY) {
  370. if ((UART1_S1 & UART_S1_TDRE)) {
  371. uint32_t tail = tx_buffer_tail;
  372. if (++tail >= TX_BUFFER_SIZE) tail = 0;
  373. n = tx_buffer[tail];
  374. if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2);
  375. UART1_D = n;
  376. tx_buffer_tail = tail;
  377. }
  378. } else if (priority >= 256) {
  379. yield();
  380. }
  381. } while (tx_buffer_tail == head);
  382. }
  383. tx_buffer[head] = *p++;
  384. transmitting = 1;
  385. tx_buffer_head = head;
  386. }
  387. UART1_C2 = C2_TX_ACTIVE;
  388. }
  389. #else
  390. void serial2_write(const void *buf, unsigned int count)
  391. {
  392. const uint8_t *p = (const uint8_t *)buf;
  393. while (count-- > 0) serial2_putchar(*p++);
  394. }
  395. #endif
  396. void serial2_flush(void)
  397. {
  398. while (transmitting) yield(); // wait
  399. }
  400. int serial2_write_buffer_free(void)
  401. {
  402. uint32_t head, tail;
  403. head = tx_buffer_head;
  404. tail = tx_buffer_tail;
  405. if (head >= tail) return TX_BUFFER_SIZE - 1 - head + tail;
  406. return tail - head - 1;
  407. }
  408. int serial2_available(void)
  409. {
  410. uint32_t head, tail;
  411. head = rx_buffer_head;
  412. tail = rx_buffer_tail;
  413. if (head >= tail) return head - tail;
  414. return RX_BUFFER_SIZE + head - tail;
  415. }
  416. int serial2_getchar(void)
  417. {
  418. uint32_t head, tail;
  419. int c;
  420. head = rx_buffer_head;
  421. tail = rx_buffer_tail;
  422. if (head == tail) return -1;
  423. if (++tail >= RX_BUFFER_SIZE) tail = 0;
  424. c = rx_buffer[tail];
  425. rx_buffer_tail = tail;
  426. if (rts_pin) {
  427. int avail;
  428. if (head >= tail) avail = head - tail;
  429. else avail = RX_BUFFER_SIZE + head - tail;
  430. if (avail <= RTS_LOW_WATERMARK) rts_assert();
  431. }
  432. return c;
  433. }
  434. int serial2_peek(void)
  435. {
  436. uint32_t head, tail;
  437. head = rx_buffer_head;
  438. tail = rx_buffer_tail;
  439. if (head == tail) return -1;
  440. if (++tail >= RX_BUFFER_SIZE) tail = 0;
  441. return rx_buffer[tail];
  442. }
  443. void serial2_clear(void)
  444. {
  445. #ifdef HAS_KINETISK_UART1_FIFO
  446. if (!(SIM_SCGC4 & SIM_SCGC4_UART1)) return;
  447. UART1_C2 &= ~(UART_C2_RE | UART_C2_RIE | UART_C2_ILIE);
  448. UART1_CFIFO = UART_CFIFO_RXFLUSH;
  449. UART1_C2 |= (UART_C2_RE | UART_C2_RIE | UART_C2_ILIE);
  450. #endif
  451. rx_buffer_head = rx_buffer_tail;
  452. if (rts_pin) rts_assert();
  453. }
  454. // status interrupt combines
  455. // Transmit data below watermark UART_S1_TDRE
  456. // Transmit complete UART_S1_TC
  457. // Idle line UART_S1_IDLE
  458. // Receive data above watermark UART_S1_RDRF
  459. // LIN break detect UART_S2_LBKDIF
  460. // RxD pin active edge UART_S2_RXEDGIF
  461. void uart1_status_isr(void)
  462. {
  463. uint32_t head, tail, n;
  464. uint8_t c;
  465. #ifdef HAS_KINETISK_UART1_FIFO
  466. uint32_t newhead;
  467. uint8_t avail;
  468. if (UART1_S1 & (UART_S1_RDRF | UART_S1_IDLE)) {
  469. __disable_irq();
  470. avail = UART1_RCFIFO;
  471. if (avail == 0) {
  472. // The only way to clear the IDLE interrupt flag is
  473. // to read the data register. But reading with no
  474. // data causes a FIFO underrun, which causes the
  475. // FIFO to return corrupted data. If anyone from
  476. // Freescale reads this, what a poor design! There
  477. // write should be a write-1-to-clear for IDLE.
  478. c = UART1_D;
  479. // flushing the fifo recovers from the underrun,
  480. // but there's a possible race condition where a
  481. // new character could be received between reading
  482. // RCFIFO == 0 and flushing the FIFO. To minimize
  483. // the chance, interrupts are disabled so a higher
  484. // priority interrupt (hopefully) doesn't delay.
  485. // TODO: change this to disabling the IDLE interrupt
  486. // which won't be simple, since we already manage
  487. // which transmit interrupts are enabled.
  488. UART1_CFIFO = UART_CFIFO_RXFLUSH;
  489. __enable_irq();
  490. } else {
  491. __enable_irq();
  492. head = rx_buffer_head;
  493. tail = rx_buffer_tail;
  494. do {
  495. if (use9Bits && (UART1_C3 & 0x80)) {
  496. n = UART1_D | 0x100;
  497. } else {
  498. n = UART1_D;
  499. }
  500. newhead = head + 1;
  501. if (newhead >= RX_BUFFER_SIZE) newhead = 0;
  502. if (newhead != tail) {
  503. head = newhead;
  504. rx_buffer[head] = n;
  505. }
  506. } while (--avail > 0);
  507. rx_buffer_head = head;
  508. if (rts_pin) {
  509. int avail;
  510. if (head >= tail) avail = head - tail;
  511. else avail = RX_BUFFER_SIZE + head - tail;
  512. if (avail >= RTS_HIGH_WATERMARK) rts_deassert();
  513. }
  514. }
  515. }
  516. c = UART1_C2;
  517. if ((c & UART_C2_TIE) && (UART1_S1 & UART_S1_TDRE)) {
  518. head = tx_buffer_head;
  519. tail = tx_buffer_tail;
  520. do {
  521. if (tail == head) break;
  522. if (++tail >= TX_BUFFER_SIZE) tail = 0;
  523. avail = UART1_S1;
  524. n = tx_buffer[tail];
  525. if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2);
  526. UART1_D = n;
  527. } while (UART1_TCFIFO < 8);
  528. tx_buffer_tail = tail;
  529. if (UART1_S1 & UART_S1_TDRE) UART1_C2 = C2_TX_COMPLETING;
  530. }
  531. #else
  532. if (UART1_S1 & UART_S1_RDRF) {
  533. n = UART1_D;
  534. if (use9Bits && (UART1_C3 & 0x80)) n |= 0x100;
  535. head = rx_buffer_head + 1;
  536. if (head >= RX_BUFFER_SIZE) head = 0;
  537. if (head != rx_buffer_tail) {
  538. rx_buffer[head] = n;
  539. rx_buffer_head = head;
  540. }
  541. }
  542. c = UART1_C2;
  543. if ((c & UART_C2_TIE) && (UART1_S1 & UART_S1_TDRE)) {
  544. head = tx_buffer_head;
  545. tail = tx_buffer_tail;
  546. if (head == tail) {
  547. UART1_C2 = C2_TX_COMPLETING;
  548. } else {
  549. if (++tail >= TX_BUFFER_SIZE) tail = 0;
  550. n = tx_buffer[tail];
  551. if (use9Bits) UART1_C3 = (UART1_C3 & ~0x40) | ((n & 0x100) >> 2);
  552. UART1_D = n;
  553. tx_buffer_tail = tail;
  554. }
  555. }
  556. #endif
  557. if ((c & UART_C2_TCIE) && (UART1_S1 & UART_S1_TC)) {
  558. transmitting = 0;
  559. if (transmit_pin) transmit_deassert();
  560. UART1_C2 = C2_TX_INACTIVE;
  561. }
  562. }