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.

600 line
18KB

  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. }