Mouse code for the MacroRat

Dependencies:   ITG3200 QEI

Committer:
sahilmgandhi
Date:
Sat Jun 03 00:22:44 2017 +0000
Revision:
46:b156ef445742
Parent:
18:6a4db94011d3
Final code for internal battlebot competition.

Who changed what in which revision?

UserRevisionLine numberNew contents of line
sahilmgandhi 18:6a4db94011d3 1 /* mbed Microcontroller Library
sahilmgandhi 18:6a4db94011d3 2 * Copyright (c) 2006-2013 ARM Limited
sahilmgandhi 18:6a4db94011d3 3 *
sahilmgandhi 18:6a4db94011d3 4 * Licensed under the Apache License, Version 2.0 (the "License");
sahilmgandhi 18:6a4db94011d3 5 * you may not use this file except in compliance with the License.
sahilmgandhi 18:6a4db94011d3 6 * You may obtain a copy of the License at
sahilmgandhi 18:6a4db94011d3 7 *
sahilmgandhi 18:6a4db94011d3 8 * http://www.apache.org/licenses/LICENSE-2.0
sahilmgandhi 18:6a4db94011d3 9 *
sahilmgandhi 18:6a4db94011d3 10 * Unless required by applicable law or agreed to in writing, software
sahilmgandhi 18:6a4db94011d3 11 * distributed under the License is distributed on an "AS IS" BASIS,
sahilmgandhi 18:6a4db94011d3 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
sahilmgandhi 18:6a4db94011d3 13 * See the License for the specific language governing permissions and
sahilmgandhi 18:6a4db94011d3 14 * limitations under the License.
sahilmgandhi 18:6a4db94011d3 15 */
sahilmgandhi 18:6a4db94011d3 16 // math.h required for floating point operations for baud rate calculation
sahilmgandhi 18:6a4db94011d3 17 #include "mbed_assert.h"
sahilmgandhi 18:6a4db94011d3 18 #include <math.h>
sahilmgandhi 18:6a4db94011d3 19 #include <string.h>
sahilmgandhi 18:6a4db94011d3 20
sahilmgandhi 18:6a4db94011d3 21 #include "serial_api.h"
sahilmgandhi 18:6a4db94011d3 22 #include "cmsis.h"
sahilmgandhi 18:6a4db94011d3 23 #include "pinmap.h"
sahilmgandhi 18:6a4db94011d3 24 #include "mbed_error.h"
sahilmgandhi 18:6a4db94011d3 25
sahilmgandhi 18:6a4db94011d3 26 /******************************************************************************
sahilmgandhi 18:6a4db94011d3 27 * INITIALIZATION
sahilmgandhi 18:6a4db94011d3 28 ******************************************************************************/
sahilmgandhi 18:6a4db94011d3 29 #define UART_NUM 3
sahilmgandhi 18:6a4db94011d3 30
sahilmgandhi 18:6a4db94011d3 31 static const SWM_Map SWM_UART_TX[] = {
sahilmgandhi 18:6a4db94011d3 32 {0, 0},
sahilmgandhi 18:6a4db94011d3 33 {1, 8},
sahilmgandhi 18:6a4db94011d3 34 {2, 16},
sahilmgandhi 18:6a4db94011d3 35 };
sahilmgandhi 18:6a4db94011d3 36
sahilmgandhi 18:6a4db94011d3 37 static const SWM_Map SWM_UART_RX[] = {
sahilmgandhi 18:6a4db94011d3 38 {0, 8},
sahilmgandhi 18:6a4db94011d3 39 {1, 16},
sahilmgandhi 18:6a4db94011d3 40 {2, 24},
sahilmgandhi 18:6a4db94011d3 41 };
sahilmgandhi 18:6a4db94011d3 42
sahilmgandhi 18:6a4db94011d3 43 static const SWM_Map SWM_UART_RTS[] = {
sahilmgandhi 18:6a4db94011d3 44 {0, 16},
sahilmgandhi 18:6a4db94011d3 45 {1, 24},
sahilmgandhi 18:6a4db94011d3 46 {3, 0},
sahilmgandhi 18:6a4db94011d3 47 };
sahilmgandhi 18:6a4db94011d3 48
sahilmgandhi 18:6a4db94011d3 49 static const SWM_Map SWM_UART_CTS[] = {
sahilmgandhi 18:6a4db94011d3 50 {0, 24},
sahilmgandhi 18:6a4db94011d3 51 {2, 0},
sahilmgandhi 18:6a4db94011d3 52 {3, 8}
sahilmgandhi 18:6a4db94011d3 53 };
sahilmgandhi 18:6a4db94011d3 54
sahilmgandhi 18:6a4db94011d3 55 // bit flags for used UARTs
sahilmgandhi 18:6a4db94011d3 56 static unsigned char uart_used = 0;
sahilmgandhi 18:6a4db94011d3 57 static int get_available_uart(void) {
sahilmgandhi 18:6a4db94011d3 58 int i;
sahilmgandhi 18:6a4db94011d3 59 for (i=0; i<3; i++) {
sahilmgandhi 18:6a4db94011d3 60 if ((uart_used & (1 << i)) == 0)
sahilmgandhi 18:6a4db94011d3 61 return i;
sahilmgandhi 18:6a4db94011d3 62 }
sahilmgandhi 18:6a4db94011d3 63 return -1;
sahilmgandhi 18:6a4db94011d3 64 }
sahilmgandhi 18:6a4db94011d3 65
sahilmgandhi 18:6a4db94011d3 66 #define UART_EN (0x01<<0)
sahilmgandhi 18:6a4db94011d3 67
sahilmgandhi 18:6a4db94011d3 68 #define CTS_DELTA (0x01<<5)
sahilmgandhi 18:6a4db94011d3 69 #define RXBRK (0x01<<10)
sahilmgandhi 18:6a4db94011d3 70 #define DELTA_RXBRK (0x01<<11)
sahilmgandhi 18:6a4db94011d3 71
sahilmgandhi 18:6a4db94011d3 72 #define RXRDY (0x01<<0)
sahilmgandhi 18:6a4db94011d3 73 #define TXRDY (0x01<<2)
sahilmgandhi 18:6a4db94011d3 74
sahilmgandhi 18:6a4db94011d3 75 #define TXBRKEN (0x01<<1)
sahilmgandhi 18:6a4db94011d3 76 #define CTSEN (0x01<<9)
sahilmgandhi 18:6a4db94011d3 77
sahilmgandhi 18:6a4db94011d3 78 static uint32_t UARTSysClk;
sahilmgandhi 18:6a4db94011d3 79
sahilmgandhi 18:6a4db94011d3 80 static uint32_t serial_irq_ids[UART_NUM] = {0};
sahilmgandhi 18:6a4db94011d3 81 static uart_irq_handler irq_handler;
sahilmgandhi 18:6a4db94011d3 82
sahilmgandhi 18:6a4db94011d3 83 int stdio_uart_inited = 0;
sahilmgandhi 18:6a4db94011d3 84 serial_t stdio_uart;
sahilmgandhi 18:6a4db94011d3 85
sahilmgandhi 18:6a4db94011d3 86 void serial_init(serial_t *obj, PinName tx, PinName rx) {
sahilmgandhi 18:6a4db94011d3 87 int is_stdio_uart = 0;
sahilmgandhi 18:6a4db94011d3 88
sahilmgandhi 18:6a4db94011d3 89 int uart_n = get_available_uart();
sahilmgandhi 18:6a4db94011d3 90 if (uart_n == -1) {
sahilmgandhi 18:6a4db94011d3 91 error("No available UART");
sahilmgandhi 18:6a4db94011d3 92 }
sahilmgandhi 18:6a4db94011d3 93 obj->index = uart_n;
sahilmgandhi 18:6a4db94011d3 94 obj->uart = (LPC_USART_TypeDef *)(LPC_USART0_BASE + (0x4000 * uart_n));
sahilmgandhi 18:6a4db94011d3 95 uart_used |= (1 << uart_n);
sahilmgandhi 18:6a4db94011d3 96
sahilmgandhi 18:6a4db94011d3 97 const SWM_Map *swm;
sahilmgandhi 18:6a4db94011d3 98 uint32_t regVal;
sahilmgandhi 18:6a4db94011d3 99
sahilmgandhi 18:6a4db94011d3 100 swm = &SWM_UART_TX[uart_n];
sahilmgandhi 18:6a4db94011d3 101 regVal = LPC_SWM->PINASSIGN[swm->n] & ~(0xFF << swm->offset);
sahilmgandhi 18:6a4db94011d3 102 LPC_SWM->PINASSIGN[swm->n] = regVal | (tx << swm->offset);
sahilmgandhi 18:6a4db94011d3 103
sahilmgandhi 18:6a4db94011d3 104 swm = &SWM_UART_RX[uart_n];
sahilmgandhi 18:6a4db94011d3 105 regVal = LPC_SWM->PINASSIGN[swm->n] & ~(0xFF << swm->offset);
sahilmgandhi 18:6a4db94011d3 106 LPC_SWM->PINASSIGN[swm->n] = regVal | (rx << swm->offset);
sahilmgandhi 18:6a4db94011d3 107
sahilmgandhi 18:6a4db94011d3 108 /* uart clock divided by 1 */
sahilmgandhi 18:6a4db94011d3 109 LPC_SYSCON->UARTCLKDIV = 1;
sahilmgandhi 18:6a4db94011d3 110
sahilmgandhi 18:6a4db94011d3 111 /* disable uart interrupts */
sahilmgandhi 18:6a4db94011d3 112 NVIC_DisableIRQ((IRQn_Type)(UART0_IRQn + uart_n));
sahilmgandhi 18:6a4db94011d3 113
sahilmgandhi 18:6a4db94011d3 114 /* Enable UART clock */
sahilmgandhi 18:6a4db94011d3 115 LPC_SYSCON->SYSAHBCLKCTRL |= (1 << (14 + uart_n));
sahilmgandhi 18:6a4db94011d3 116
sahilmgandhi 18:6a4db94011d3 117 /* Peripheral reset control to UART, a "1" bring it out of reset. */
sahilmgandhi 18:6a4db94011d3 118 LPC_SYSCON->PRESETCTRL &= ~(0x1 << (3 + uart_n));
sahilmgandhi 18:6a4db94011d3 119 LPC_SYSCON->PRESETCTRL |= (0x1 << (3 + uart_n));
sahilmgandhi 18:6a4db94011d3 120
sahilmgandhi 18:6a4db94011d3 121 // Derive UART Clock from MainClock
sahilmgandhi 18:6a4db94011d3 122 UARTSysClk = MainClock / LPC_SYSCON->UARTCLKDIV;
sahilmgandhi 18:6a4db94011d3 123
sahilmgandhi 18:6a4db94011d3 124 // set default baud rate and format
sahilmgandhi 18:6a4db94011d3 125 serial_baud (obj, 9600);
sahilmgandhi 18:6a4db94011d3 126 serial_format(obj, 8, ParityNone, 1);
sahilmgandhi 18:6a4db94011d3 127
sahilmgandhi 18:6a4db94011d3 128 /* Clear all status bits. */
sahilmgandhi 18:6a4db94011d3 129 obj->uart->STAT = CTS_DELTA | DELTA_RXBRK;
sahilmgandhi 18:6a4db94011d3 130
sahilmgandhi 18:6a4db94011d3 131 /* enable uart interrupts */
sahilmgandhi 18:6a4db94011d3 132 NVIC_EnableIRQ((IRQn_Type)(UART0_IRQn + uart_n));
sahilmgandhi 18:6a4db94011d3 133
sahilmgandhi 18:6a4db94011d3 134 /* Enable UART interrupt */
sahilmgandhi 18:6a4db94011d3 135 // obj->uart->INTENSET = RXRDY | TXRDY | DELTA_RXBRK;
sahilmgandhi 18:6a4db94011d3 136
sahilmgandhi 18:6a4db94011d3 137 /* Enable UART */
sahilmgandhi 18:6a4db94011d3 138 obj->uart->CFG |= UART_EN;
sahilmgandhi 18:6a4db94011d3 139
sahilmgandhi 18:6a4db94011d3 140 is_stdio_uart = ((tx == USBTX) && (rx == USBRX));
sahilmgandhi 18:6a4db94011d3 141
sahilmgandhi 18:6a4db94011d3 142 if (is_stdio_uart) {
sahilmgandhi 18:6a4db94011d3 143 stdio_uart_inited = 1;
sahilmgandhi 18:6a4db94011d3 144 memcpy(&stdio_uart, obj, sizeof(serial_t));
sahilmgandhi 18:6a4db94011d3 145 }
sahilmgandhi 18:6a4db94011d3 146 }
sahilmgandhi 18:6a4db94011d3 147
sahilmgandhi 18:6a4db94011d3 148 void serial_free(serial_t *obj) {
sahilmgandhi 18:6a4db94011d3 149 uart_used &= ~(1 << obj->index);
sahilmgandhi 18:6a4db94011d3 150 serial_irq_ids[obj->index] = 0;
sahilmgandhi 18:6a4db94011d3 151 }
sahilmgandhi 18:6a4db94011d3 152
sahilmgandhi 18:6a4db94011d3 153 // serial_baud
sahilmgandhi 18:6a4db94011d3 154 // set the baud rate, taking in to account the current SystemFrequency
sahilmgandhi 18:6a4db94011d3 155 void serial_baud(serial_t *obj, int baudrate) {
sahilmgandhi 18:6a4db94011d3 156 /* Integer divider:
sahilmgandhi 18:6a4db94011d3 157 BRG = UARTSysClk/(Baudrate * 16) - 1
sahilmgandhi 18:6a4db94011d3 158
sahilmgandhi 18:6a4db94011d3 159 Frational divider:
sahilmgandhi 18:6a4db94011d3 160 FRG = ((UARTSysClk / (Baudrate * 16 * (BRG + 1))) - 1)
sahilmgandhi 18:6a4db94011d3 161
sahilmgandhi 18:6a4db94011d3 162 where
sahilmgandhi 18:6a4db94011d3 163 FRG = (LPC_SYSCON->UARTFRDADD + 1) / (LPC_SYSCON->UARTFRDSUB + 1)
sahilmgandhi 18:6a4db94011d3 164
sahilmgandhi 18:6a4db94011d3 165 (1) The easiest way is set SUB value to 256, -1 encoded, thus SUB
sahilmgandhi 18:6a4db94011d3 166 register is 0xFF.
sahilmgandhi 18:6a4db94011d3 167 (2) In ADD register value, depending on the value of UartSysClk,
sahilmgandhi 18:6a4db94011d3 168 baudrate, BRG register value, and SUB register value, be careful
sahilmgandhi 18:6a4db94011d3 169 about the order of multiplier and divider and make sure any
sahilmgandhi 18:6a4db94011d3 170 multiplier doesn't exceed 32-bit boundary and any divider doesn't get
sahilmgandhi 18:6a4db94011d3 171 down below one(integer 0).
sahilmgandhi 18:6a4db94011d3 172 (3) ADD should be always less than SUB.
sahilmgandhi 18:6a4db94011d3 173 */
sahilmgandhi 18:6a4db94011d3 174 obj->uart->BRG = UARTSysClk / 16 / baudrate - 1;
sahilmgandhi 18:6a4db94011d3 175
sahilmgandhi 18:6a4db94011d3 176 LPC_SYSCON->UARTFRGDIV = 0xFF;
sahilmgandhi 18:6a4db94011d3 177 LPC_SYSCON->UARTFRGMULT = ( ((UARTSysClk / 16) * (LPC_SYSCON->UARTFRGDIV + 1)) /
sahilmgandhi 18:6a4db94011d3 178 (baudrate * (obj->uart->BRG + 1))
sahilmgandhi 18:6a4db94011d3 179 ) - (LPC_SYSCON->UARTFRGDIV + 1);
sahilmgandhi 18:6a4db94011d3 180
sahilmgandhi 18:6a4db94011d3 181 }
sahilmgandhi 18:6a4db94011d3 182
sahilmgandhi 18:6a4db94011d3 183 void serial_format(serial_t *obj, int data_bits, SerialParity parity, int stop_bits) {
sahilmgandhi 18:6a4db94011d3 184 // 0: 1 stop bits, 1: 2 stop bits
sahilmgandhi 18:6a4db94011d3 185 MBED_ASSERT((stop_bits == 1) || (stop_bits == 2));
sahilmgandhi 18:6a4db94011d3 186 MBED_ASSERT((data_bits > 6) && (data_bits < 10)); // 0: 7 data bits ... 2: 9 data bits
sahilmgandhi 18:6a4db94011d3 187 MBED_ASSERT((parity == ParityNone) || (parity == ParityEven) || (parity == ParityOdd));
sahilmgandhi 18:6a4db94011d3 188 stop_bits -= 1;
sahilmgandhi 18:6a4db94011d3 189 data_bits -= 7;
sahilmgandhi 18:6a4db94011d3 190
sahilmgandhi 18:6a4db94011d3 191 int paritysel;
sahilmgandhi 18:6a4db94011d3 192 switch (parity) {
sahilmgandhi 18:6a4db94011d3 193 case ParityNone: paritysel = 0; break;
sahilmgandhi 18:6a4db94011d3 194 case ParityEven: paritysel = 2; break;
sahilmgandhi 18:6a4db94011d3 195 case ParityOdd : paritysel = 3; break;
sahilmgandhi 18:6a4db94011d3 196 default:
sahilmgandhi 18:6a4db94011d3 197 break;
sahilmgandhi 18:6a4db94011d3 198 }
sahilmgandhi 18:6a4db94011d3 199
sahilmgandhi 18:6a4db94011d3 200 // First disable the the usart as described in documentation and then enable while updating CFG
sahilmgandhi 18:6a4db94011d3 201
sahilmgandhi 18:6a4db94011d3 202 // 24.6.1 USART Configuration register
sahilmgandhi 18:6a4db94011d3 203 // Remark: If software needs to change configuration values, the following sequence should
sahilmgandhi 18:6a4db94011d3 204 // be used: 1) Make sure the USART is not currently sending or receiving data. 2) Disable
sahilmgandhi 18:6a4db94011d3 205 // the USART by writing a 0 to the Enable bit (0 may be written to the entire register). 3)
sahilmgandhi 18:6a4db94011d3 206 // Write the new configuration value, with the ENABLE bit set to 1.
sahilmgandhi 18:6a4db94011d3 207 obj->uart->CFG &= ~(1 << 0);
sahilmgandhi 18:6a4db94011d3 208
sahilmgandhi 18:6a4db94011d3 209 obj->uart->CFG = (1 << 0) // this will enable the usart
sahilmgandhi 18:6a4db94011d3 210 | (data_bits << 2)
sahilmgandhi 18:6a4db94011d3 211 | (paritysel << 4)
sahilmgandhi 18:6a4db94011d3 212 | (stop_bits << 6);
sahilmgandhi 18:6a4db94011d3 213 }
sahilmgandhi 18:6a4db94011d3 214
sahilmgandhi 18:6a4db94011d3 215 /******************************************************************************
sahilmgandhi 18:6a4db94011d3 216 * INTERRUPTS HANDLING
sahilmgandhi 18:6a4db94011d3 217 ******************************************************************************/
sahilmgandhi 18:6a4db94011d3 218 static inline void uart_irq(uint32_t iir, uint32_t index) {
sahilmgandhi 18:6a4db94011d3 219 // [Chapter 14] LPC17xx UART0/2/3: UARTn Interrupt Handling
sahilmgandhi 18:6a4db94011d3 220 SerialIrq irq_type;
sahilmgandhi 18:6a4db94011d3 221 switch (iir) {
sahilmgandhi 18:6a4db94011d3 222 case 1: irq_type = TxIrq; break;
sahilmgandhi 18:6a4db94011d3 223 case 2: irq_type = RxIrq; break;
sahilmgandhi 18:6a4db94011d3 224 default: return;
sahilmgandhi 18:6a4db94011d3 225 }
sahilmgandhi 18:6a4db94011d3 226
sahilmgandhi 18:6a4db94011d3 227 if (serial_irq_ids[index] != 0)
sahilmgandhi 18:6a4db94011d3 228 irq_handler(serial_irq_ids[index], irq_type);
sahilmgandhi 18:6a4db94011d3 229 }
sahilmgandhi 18:6a4db94011d3 230
sahilmgandhi 18:6a4db94011d3 231 void uart0_irq() {uart_irq((LPC_USART0->STAT & (1 << 2)) ? 2 : 1, 0);}
sahilmgandhi 18:6a4db94011d3 232 void uart1_irq() {uart_irq((LPC_USART1->STAT & (1 << 2)) ? 2 : 1, 1);}
sahilmgandhi 18:6a4db94011d3 233 void uart2_irq() {uart_irq((LPC_USART2->STAT & (1 << 2)) ? 2 : 1, 2);}
sahilmgandhi 18:6a4db94011d3 234
sahilmgandhi 18:6a4db94011d3 235 void serial_irq_handler(serial_t *obj, uart_irq_handler handler, uint32_t id) {
sahilmgandhi 18:6a4db94011d3 236 irq_handler = handler;
sahilmgandhi 18:6a4db94011d3 237 serial_irq_ids[obj->index] = id;
sahilmgandhi 18:6a4db94011d3 238 }
sahilmgandhi 18:6a4db94011d3 239
sahilmgandhi 18:6a4db94011d3 240 void serial_irq_set(serial_t *obj, SerialIrq irq, uint32_t enable) {
sahilmgandhi 18:6a4db94011d3 241 IRQn_Type irq_n = (IRQn_Type)0;
sahilmgandhi 18:6a4db94011d3 242 uint32_t vector = 0;
sahilmgandhi 18:6a4db94011d3 243 switch ((int)obj->uart) {
sahilmgandhi 18:6a4db94011d3 244 case LPC_USART0_BASE: irq_n=UART0_IRQn; vector = (uint32_t)&uart0_irq; break;
sahilmgandhi 18:6a4db94011d3 245 case LPC_USART1_BASE: irq_n=UART1_IRQn; vector = (uint32_t)&uart1_irq; break;
sahilmgandhi 18:6a4db94011d3 246 case LPC_USART2_BASE: irq_n=UART2_IRQn; vector = (uint32_t)&uart2_irq; break;
sahilmgandhi 18:6a4db94011d3 247 }
sahilmgandhi 18:6a4db94011d3 248
sahilmgandhi 18:6a4db94011d3 249 if (enable) {
sahilmgandhi 18:6a4db94011d3 250 obj->uart->INTENSET = (1 << ((irq == RxIrq) ? 0 : 2));
sahilmgandhi 18:6a4db94011d3 251 NVIC_SetVector(irq_n, vector);
sahilmgandhi 18:6a4db94011d3 252 NVIC_EnableIRQ(irq_n);
sahilmgandhi 18:6a4db94011d3 253 } else { // disable
sahilmgandhi 18:6a4db94011d3 254 int all_disabled = 0;
sahilmgandhi 18:6a4db94011d3 255 SerialIrq other_irq = (irq == RxIrq) ? (TxIrq) : (RxIrq);
sahilmgandhi 18:6a4db94011d3 256 obj->uart->INTENSET &= ~(1 << ((irq == RxIrq) ? 0 : 2));
sahilmgandhi 18:6a4db94011d3 257 all_disabled = (obj->uart->INTENSET & (1 << ((other_irq == RxIrq) ? 0 : 2))) == 0;
sahilmgandhi 18:6a4db94011d3 258 if (all_disabled)
sahilmgandhi 18:6a4db94011d3 259 NVIC_DisableIRQ(irq_n);
sahilmgandhi 18:6a4db94011d3 260 }
sahilmgandhi 18:6a4db94011d3 261 }
sahilmgandhi 18:6a4db94011d3 262
sahilmgandhi 18:6a4db94011d3 263 /******************************************************************************
sahilmgandhi 18:6a4db94011d3 264 * READ/WRITE
sahilmgandhi 18:6a4db94011d3 265 ******************************************************************************/
sahilmgandhi 18:6a4db94011d3 266 int serial_getc(serial_t *obj) {
sahilmgandhi 18:6a4db94011d3 267 while (!serial_readable(obj));
sahilmgandhi 18:6a4db94011d3 268 return obj->uart->RXDATA;
sahilmgandhi 18:6a4db94011d3 269 }
sahilmgandhi 18:6a4db94011d3 270
sahilmgandhi 18:6a4db94011d3 271 void serial_putc(serial_t *obj, int c) {
sahilmgandhi 18:6a4db94011d3 272 while (!serial_writable(obj));
sahilmgandhi 18:6a4db94011d3 273 obj->uart->TXDATA = c;
sahilmgandhi 18:6a4db94011d3 274 }
sahilmgandhi 18:6a4db94011d3 275
sahilmgandhi 18:6a4db94011d3 276 int serial_readable(serial_t *obj) {
sahilmgandhi 18:6a4db94011d3 277 return obj->uart->STAT & RXRDY;
sahilmgandhi 18:6a4db94011d3 278 }
sahilmgandhi 18:6a4db94011d3 279
sahilmgandhi 18:6a4db94011d3 280 int serial_writable(serial_t *obj) {
sahilmgandhi 18:6a4db94011d3 281 return obj->uart->STAT & TXRDY;
sahilmgandhi 18:6a4db94011d3 282 }
sahilmgandhi 18:6a4db94011d3 283
sahilmgandhi 18:6a4db94011d3 284 void serial_clear(serial_t *obj) {
sahilmgandhi 18:6a4db94011d3 285 // [TODO]
sahilmgandhi 18:6a4db94011d3 286 }
sahilmgandhi 18:6a4db94011d3 287
sahilmgandhi 18:6a4db94011d3 288 void serial_pinout_tx(PinName tx) {
sahilmgandhi 18:6a4db94011d3 289
sahilmgandhi 18:6a4db94011d3 290 }
sahilmgandhi 18:6a4db94011d3 291
sahilmgandhi 18:6a4db94011d3 292 void serial_break_set(serial_t *obj) {
sahilmgandhi 18:6a4db94011d3 293 obj->uart->CTRL |= TXBRKEN;
sahilmgandhi 18:6a4db94011d3 294 }
sahilmgandhi 18:6a4db94011d3 295
sahilmgandhi 18:6a4db94011d3 296 void serial_break_clear(serial_t *obj) {
sahilmgandhi 18:6a4db94011d3 297 obj->uart->CTRL &= ~TXBRKEN;
sahilmgandhi 18:6a4db94011d3 298 }
sahilmgandhi 18:6a4db94011d3 299
sahilmgandhi 18:6a4db94011d3 300 void serial_set_flow_control(serial_t *obj, FlowControl type, PinName rxflow, PinName txflow) {
sahilmgandhi 18:6a4db94011d3 301 const SWM_Map *swm_rts, *swm_cts;
sahilmgandhi 18:6a4db94011d3 302 uint32_t regVal_rts, regVal_cts;
sahilmgandhi 18:6a4db94011d3 303
sahilmgandhi 18:6a4db94011d3 304 swm_rts = &SWM_UART_RTS[obj->index];
sahilmgandhi 18:6a4db94011d3 305 swm_cts = &SWM_UART_CTS[obj->index];
sahilmgandhi 18:6a4db94011d3 306 regVal_rts = LPC_SWM->PINASSIGN[swm_rts->n] & ~(0xFF << swm_rts->offset);
sahilmgandhi 18:6a4db94011d3 307 regVal_cts = LPC_SWM->PINASSIGN[swm_cts->n] & ~(0xFF << swm_cts->offset);
sahilmgandhi 18:6a4db94011d3 308
sahilmgandhi 18:6a4db94011d3 309 if (FlowControlNone == type) {
sahilmgandhi 18:6a4db94011d3 310 LPC_SWM->PINASSIGN[swm_rts->n] = regVal_rts | (0xFF << swm_rts->offset);
sahilmgandhi 18:6a4db94011d3 311 LPC_SWM->PINASSIGN[swm_cts->n] = regVal_cts | (0xFF << swm_cts->offset);
sahilmgandhi 18:6a4db94011d3 312 obj->uart->CFG &= ~CTSEN;
sahilmgandhi 18:6a4db94011d3 313 return;
sahilmgandhi 18:6a4db94011d3 314 }
sahilmgandhi 18:6a4db94011d3 315 if ((FlowControlRTS == type || FlowControlRTSCTS == type) && (rxflow != NC)) {
sahilmgandhi 18:6a4db94011d3 316 LPC_SWM->PINASSIGN[swm_rts->n] = regVal_rts | (rxflow << swm_rts->offset);
sahilmgandhi 18:6a4db94011d3 317 if (FlowControlRTS == type) {
sahilmgandhi 18:6a4db94011d3 318 LPC_SWM->PINASSIGN[swm_cts->n] = regVal_cts | (0xFF << swm_cts->offset);
sahilmgandhi 18:6a4db94011d3 319 obj->uart->CFG &= ~CTSEN;
sahilmgandhi 18:6a4db94011d3 320 }
sahilmgandhi 18:6a4db94011d3 321 }
sahilmgandhi 18:6a4db94011d3 322 if ((FlowControlCTS == type || FlowControlRTSCTS == type) && (txflow != NC)) {
sahilmgandhi 18:6a4db94011d3 323 LPC_SWM->PINASSIGN[swm_cts->n] = regVal_cts | (txflow << swm_cts->offset);
sahilmgandhi 18:6a4db94011d3 324 obj->uart->CFG |= CTSEN;
sahilmgandhi 18:6a4db94011d3 325 if (FlowControlCTS == type) {
sahilmgandhi 18:6a4db94011d3 326 LPC_SWM->PINASSIGN[swm_rts->n] = regVal_rts | (0xFF << swm_rts->offset);
sahilmgandhi 18:6a4db94011d3 327 }
sahilmgandhi 18:6a4db94011d3 328 }
sahilmgandhi 18:6a4db94011d3 329 }
sahilmgandhi 18:6a4db94011d3 330