mbed-os

Fork of mbed-os by erkin yucel

Committer:
xuaner
Date:
Thu Jul 20 14:26:57 2017 +0000
Revision:
1:3deb71413561
Parent:
0:f269e3021894
mbed_os

Who changed what in which revision?

UserRevisionLine numberNew contents of line
elessair 0:f269e3021894 1 /* mbed Microcontroller Library
elessair 0:f269e3021894 2 * Copyright (c) 2006-2013 ARM Limited
elessair 0:f269e3021894 3 *
elessair 0:f269e3021894 4 * Licensed under the Apache License, Version 2.0 (the "License");
elessair 0:f269e3021894 5 * you may not use this file except in compliance with the License.
elessair 0:f269e3021894 6 * You may obtain a copy of the License at
elessair 0:f269e3021894 7 *
elessair 0:f269e3021894 8 * http://www.apache.org/licenses/LICENSE-2.0
elessair 0:f269e3021894 9 *
elessair 0:f269e3021894 10 * Unless required by applicable law or agreed to in writing, software
elessair 0:f269e3021894 11 * distributed under the License is distributed on an "AS IS" BASIS,
elessair 0:f269e3021894 12 * WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
elessair 0:f269e3021894 13 * See the License for the specific language governing permissions and
elessair 0:f269e3021894 14 * limitations under the License.
elessair 0:f269e3021894 15 */
elessair 0:f269e3021894 16 // math.h required for floating point operations for baud rate calculation
elessair 0:f269e3021894 17 #include "mbed_assert.h"
elessair 0:f269e3021894 18 #include <math.h>
elessair 0:f269e3021894 19 #include <string.h>
elessair 0:f269e3021894 20 #include <stdlib.h>
elessair 0:f269e3021894 21
elessair 0:f269e3021894 22 #include "serial_api.h"
elessair 0:f269e3021894 23 #include "cmsis.h"
elessair 0:f269e3021894 24 #include "pinmap.h"
elessair 0:f269e3021894 25
elessair 0:f269e3021894 26 /******************************************************************************
elessair 0:f269e3021894 27 * INITIALIZATION
elessair 0:f269e3021894 28 ******************************************************************************/
elessair 0:f269e3021894 29 #define UART_NUM 4
elessair 0:f269e3021894 30
elessair 0:f269e3021894 31 static const PinMap PinMap_UART_TX[] = {
elessair 0:f269e3021894 32 {P0_0, UART_3, 2},
elessair 0:f269e3021894 33 {P0_2, UART_0, 1},
elessair 0:f269e3021894 34 {P0_10, UART_2, 1},
elessair 0:f269e3021894 35 {P0_15, UART_1, 1},
elessair 0:f269e3021894 36 {P0_25, UART_3, 3},
elessair 0:f269e3021894 37 {P2_0 , UART_1, 2},
elessair 0:f269e3021894 38 {P2_8 , UART_2, 2},
elessair 0:f269e3021894 39 {P4_28, UART_3, 3},
elessair 0:f269e3021894 40 {NC , NC , 0}
elessair 0:f269e3021894 41 };
elessair 0:f269e3021894 42
elessair 0:f269e3021894 43 static const PinMap PinMap_UART_RX[] = {
elessair 0:f269e3021894 44 {P0_1 , UART_3, 2},
elessair 0:f269e3021894 45 {P0_3 , UART_0, 1},
elessair 0:f269e3021894 46 {P0_11, UART_2, 1},
elessair 0:f269e3021894 47 {P0_16, UART_1, 1},
elessair 0:f269e3021894 48 {P0_26, UART_3, 3},
elessair 0:f269e3021894 49 {P2_1 , UART_1, 2},
elessair 0:f269e3021894 50 {P2_9 , UART_2, 2},
elessair 0:f269e3021894 51 {P4_29, UART_3, 3},
elessair 0:f269e3021894 52 {NC , NC , 0}
elessair 0:f269e3021894 53 };
elessair 0:f269e3021894 54
elessair 0:f269e3021894 55 static uint32_t serial_irq_ids[UART_NUM] = {0};
elessair 0:f269e3021894 56 static uart_irq_handler irq_handler;
elessair 0:f269e3021894 57
elessair 0:f269e3021894 58 int stdio_uart_inited = 0;
elessair 0:f269e3021894 59 serial_t stdio_uart;
elessair 0:f269e3021894 60
elessair 0:f269e3021894 61 void serial_init(serial_t *obj, PinName tx, PinName rx) {
elessair 0:f269e3021894 62 int is_stdio_uart = 0;
elessair 0:f269e3021894 63
elessair 0:f269e3021894 64 // determine the UART to use
elessair 0:f269e3021894 65 UARTName uart_tx = (UARTName)pinmap_peripheral(tx, PinMap_UART_TX);
elessair 0:f269e3021894 66 UARTName uart_rx = (UARTName)pinmap_peripheral(rx, PinMap_UART_RX);
elessair 0:f269e3021894 67 UARTName uart = (UARTName)pinmap_merge(uart_tx, uart_rx);
elessair 0:f269e3021894 68 MBED_ASSERT((int)uart != NC);
elessair 0:f269e3021894 69
elessair 0:f269e3021894 70 obj->uart = (LPC_UART_TypeDef *)uart;
elessair 0:f269e3021894 71 // enable power
elessair 0:f269e3021894 72 switch (uart) {
elessair 0:f269e3021894 73 case UART_0: LPC_SC->PCONP |= 1 << 3; break;
elessair 0:f269e3021894 74 case UART_1: LPC_SC->PCONP |= 1 << 4; break;
elessair 0:f269e3021894 75 case UART_2: LPC_SC->PCONP |= 1 << 24; break;
elessair 0:f269e3021894 76 case UART_3: LPC_SC->PCONP |= 1 << 25; break;
elessair 0:f269e3021894 77 }
elessair 0:f269e3021894 78
elessair 0:f269e3021894 79 // enable fifos and default rx trigger level
elessair 0:f269e3021894 80 obj->uart->FCR = 1 << 0 // FIFO Enable - 0 = Disables, 1 = Enabled
elessair 0:f269e3021894 81 | 0 << 1 // Rx Fifo Reset
elessair 0:f269e3021894 82 | 0 << 2 // Tx Fifo Reset
elessair 0:f269e3021894 83 | 0 << 6; // Rx irq trigger level - 0 = 1 char, 1 = 4 chars, 2 = 8 chars, 3 = 14 chars
elessair 0:f269e3021894 84
elessair 0:f269e3021894 85 // disable irqs
elessair 0:f269e3021894 86 obj->uart->IER = 0 << 0 // Rx Data available irq enable
elessair 0:f269e3021894 87 | 0 << 1 // Tx Fifo empty irq enable
elessair 0:f269e3021894 88 | 0 << 2; // Rx Line Status irq enable
elessair 0:f269e3021894 89
elessair 0:f269e3021894 90 // set default baud rate and format
elessair 0:f269e3021894 91 serial_baud (obj, 9600);
elessair 0:f269e3021894 92 serial_format(obj, 8, ParityNone, 1);
elessair 0:f269e3021894 93
elessair 0:f269e3021894 94 // pinout the chosen uart
elessair 0:f269e3021894 95 pinmap_pinout(tx, PinMap_UART_TX);
elessair 0:f269e3021894 96 pinmap_pinout(rx, PinMap_UART_RX);
elessair 0:f269e3021894 97
elessair 0:f269e3021894 98 // set rx/tx pins in PullUp mode
elessair 0:f269e3021894 99 if (tx != NC) {
elessair 0:f269e3021894 100 pin_mode(tx, PullUp);
elessair 0:f269e3021894 101 }
elessair 0:f269e3021894 102 if (rx != NC) {
elessair 0:f269e3021894 103 pin_mode(rx, PullUp);
elessair 0:f269e3021894 104 }
elessair 0:f269e3021894 105
elessair 0:f269e3021894 106 switch (uart) {
elessair 0:f269e3021894 107 case UART_0: obj->index = 0; break;
elessair 0:f269e3021894 108 case UART_1: obj->index = 1; break;
elessair 0:f269e3021894 109 case UART_2: obj->index = 2; break;
elessair 0:f269e3021894 110 case UART_3: obj->index = 3; break;
elessair 0:f269e3021894 111 }
elessair 0:f269e3021894 112
elessair 0:f269e3021894 113 is_stdio_uart = (uart == STDIO_UART) ? (1) : (0);
elessair 0:f269e3021894 114
elessair 0:f269e3021894 115 if (is_stdio_uart) {
elessair 0:f269e3021894 116 stdio_uart_inited = 1;
elessair 0:f269e3021894 117 memcpy(&stdio_uart, obj, sizeof(serial_t));
elessair 0:f269e3021894 118 }
elessair 0:f269e3021894 119 }
elessair 0:f269e3021894 120
elessair 0:f269e3021894 121 void serial_free(serial_t *obj) {
elessair 0:f269e3021894 122 serial_irq_ids[obj->index] = 0;
elessair 0:f269e3021894 123 }
elessair 0:f269e3021894 124
elessair 0:f269e3021894 125 // serial_baud
elessair 0:f269e3021894 126 // set the baud rate, taking in to account the current SystemFrequency
elessair 0:f269e3021894 127 void serial_baud(serial_t *obj, int baudrate) {
elessair 0:f269e3021894 128 MBED_ASSERT((int)obj->uart <= UART_3);
elessair 0:f269e3021894 129 // The LPC2300 and LPC1700 have a divider and a fractional divider to control the
elessair 0:f269e3021894 130 // baud rate. The formula is:
elessair 0:f269e3021894 131 //
elessair 0:f269e3021894 132 // Baudrate = (1 / PCLK) * 16 * DL * (1 + DivAddVal / MulVal)
elessair 0:f269e3021894 133 // where:
elessair 0:f269e3021894 134 // 1 < MulVal <= 15
elessair 0:f269e3021894 135 // 0 <= DivAddVal < 14
elessair 0:f269e3021894 136 // DivAddVal < MulVal
elessair 0:f269e3021894 137 //
elessair 0:f269e3021894 138 // set pclk to /1
elessair 0:f269e3021894 139 switch ((int)obj->uart) {
elessair 0:f269e3021894 140 case UART_0: LPC_SC->PCLKSEL0 &= ~(0x3 << 6); LPC_SC->PCLKSEL0 |= (0x1 << 6); break;
elessair 0:f269e3021894 141 case UART_1: LPC_SC->PCLKSEL0 &= ~(0x3 << 8); LPC_SC->PCLKSEL0 |= (0x1 << 8); break;
elessair 0:f269e3021894 142 case UART_2: LPC_SC->PCLKSEL1 &= ~(0x3 << 16); LPC_SC->PCLKSEL1 |= (0x1 << 16); break;
elessair 0:f269e3021894 143 case UART_3: LPC_SC->PCLKSEL1 &= ~(0x3 << 18); LPC_SC->PCLKSEL1 |= (0x1 << 18); break;
elessair 0:f269e3021894 144 default: break;
elessair 0:f269e3021894 145 }
elessair 0:f269e3021894 146
elessair 0:f269e3021894 147 uint32_t PCLK = SystemCoreClock;
elessair 0:f269e3021894 148
elessair 0:f269e3021894 149 // First we check to see if the basic divide with no DivAddVal/MulVal
elessair 0:f269e3021894 150 // ratio gives us an integer result. If it does, we set DivAddVal = 0,
elessair 0:f269e3021894 151 // MulVal = 1. Otherwise, we search the valid ratio value range to find
elessair 0:f269e3021894 152 // the closest match. This could be more elegant, using search methods
elessair 0:f269e3021894 153 // and/or lookup tables, but the brute force method is not that much
elessair 0:f269e3021894 154 // slower, and is more maintainable.
elessair 0:f269e3021894 155 uint16_t DL = PCLK / (16 * baudrate);
elessair 0:f269e3021894 156
elessair 0:f269e3021894 157 uint8_t DivAddVal = 0;
elessair 0:f269e3021894 158 uint8_t MulVal = 1;
elessair 0:f269e3021894 159 int hit = 0;
elessair 0:f269e3021894 160 uint16_t dlv;
elessair 0:f269e3021894 161 uint8_t mv, dav;
elessair 0:f269e3021894 162 if ((PCLK % (16 * baudrate)) != 0) { // Checking for zero remainder
elessair 0:f269e3021894 163 int err_best = baudrate, b;
elessair 0:f269e3021894 164 for (mv = 1; mv < 16 && !hit; mv++)
elessair 0:f269e3021894 165 {
elessair 0:f269e3021894 166 for (dav = 0; dav < mv; dav++)
elessair 0:f269e3021894 167 {
elessair 0:f269e3021894 168 // baudrate = PCLK / (16 * dlv * (1 + (DivAdd / Mul))
elessair 0:f269e3021894 169 // solving for dlv, we get dlv = mul * PCLK / (16 * baudrate * (divadd + mul))
elessair 0:f269e3021894 170 // mul has 4 bits, PCLK has 27 so we have 1 bit headroom which can be used for rounding
elessair 0:f269e3021894 171 // for many values of mul and PCLK we have 2 or more bits of headroom which can be used to improve precision
elessair 0:f269e3021894 172 // note: X / 32 doesn't round correctly. Instead, we use ((X / 16) + 1) / 2 for correct rounding
elessair 0:f269e3021894 173
elessair 0:f269e3021894 174 if ((mv * PCLK * 2) & 0x80000000) // 1 bit headroom
elessair 0:f269e3021894 175 dlv = ((((2 * mv * PCLK) / (baudrate * (dav + mv))) / 16) + 1) / 2;
elessair 0:f269e3021894 176 else // 2 bits headroom, use more precision
elessair 0:f269e3021894 177 dlv = ((((4 * mv * PCLK) / (baudrate * (dav + mv))) / 32) + 1) / 2;
elessair 0:f269e3021894 178
elessair 0:f269e3021894 179 // datasheet says if DLL==DLM==0, then 1 is used instead since divide by zero is ungood
elessair 0:f269e3021894 180 if (dlv == 0)
elessair 0:f269e3021894 181 dlv = 1;
elessair 0:f269e3021894 182
elessair 0:f269e3021894 183 // datasheet says if dav > 0 then DL must be >= 2
elessair 0:f269e3021894 184 if ((dav > 0) && (dlv < 2))
elessair 0:f269e3021894 185 dlv = 2;
elessair 0:f269e3021894 186
elessair 0:f269e3021894 187 // integer rearrangement of the baudrate equation (with rounding)
elessair 0:f269e3021894 188 b = ((PCLK * mv / (dlv * (dav + mv) * 8)) + 1) / 2;
elessair 0:f269e3021894 189
elessair 0:f269e3021894 190 // check to see how we went
elessair 0:f269e3021894 191 b = abs(b - baudrate);
elessair 0:f269e3021894 192 if (b < err_best)
elessair 0:f269e3021894 193 {
elessair 0:f269e3021894 194 err_best = b;
elessair 0:f269e3021894 195
elessair 0:f269e3021894 196 DL = dlv;
elessair 0:f269e3021894 197 MulVal = mv;
elessair 0:f269e3021894 198 DivAddVal = dav;
elessair 0:f269e3021894 199
elessair 0:f269e3021894 200 if (b == baudrate)
elessair 0:f269e3021894 201 {
elessair 0:f269e3021894 202 hit = 1;
elessair 0:f269e3021894 203 break;
elessair 0:f269e3021894 204 }
elessair 0:f269e3021894 205 }
elessair 0:f269e3021894 206 }
elessair 0:f269e3021894 207 }
elessair 0:f269e3021894 208 }
elessair 0:f269e3021894 209
elessair 0:f269e3021894 210 // set LCR[DLAB] to enable writing to divider registers
elessair 0:f269e3021894 211 obj->uart->LCR |= (1 << 7);
elessair 0:f269e3021894 212
elessair 0:f269e3021894 213 // set divider values
elessair 0:f269e3021894 214 obj->uart->DLM = (DL >> 8) & 0xFF;
elessair 0:f269e3021894 215 obj->uart->DLL = (DL >> 0) & 0xFF;
elessair 0:f269e3021894 216 obj->uart->FDR = (uint32_t) DivAddVal << 0
elessair 0:f269e3021894 217 | (uint32_t) MulVal << 4;
elessair 0:f269e3021894 218
elessair 0:f269e3021894 219 // clear LCR[DLAB]
elessair 0:f269e3021894 220 obj->uart->LCR &= ~(1 << 7);
elessair 0:f269e3021894 221 }
elessair 0:f269e3021894 222
elessair 0:f269e3021894 223 void serial_format(serial_t *obj, int data_bits, SerialParity parity, int stop_bits) {
elessair 0:f269e3021894 224 MBED_ASSERT((stop_bits == 1) || (stop_bits == 2)); // 0: 1 stop bits, 1: 2 stop bits
elessair 0:f269e3021894 225 MBED_ASSERT((data_bits > 4) && (data_bits < 9)); // 0: 5 data bits ... 3: 8 data bits
elessair 0:f269e3021894 226 MBED_ASSERT((parity == ParityNone) || (parity == ParityOdd) || (parity == ParityEven) ||
elessair 0:f269e3021894 227 (parity == ParityForced1) || (parity == ParityForced0));
elessair 0:f269e3021894 228
elessair 0:f269e3021894 229 stop_bits -= 1;
elessair 0:f269e3021894 230 data_bits -= 5;
elessair 0:f269e3021894 231
elessair 0:f269e3021894 232 int parity_enable = 0, parity_select = 0;
elessair 0:f269e3021894 233 switch (parity) {
elessair 0:f269e3021894 234 case ParityNone: parity_enable = 0; parity_select = 0; break;
elessair 0:f269e3021894 235 case ParityOdd : parity_enable = 1; parity_select = 0; break;
elessair 0:f269e3021894 236 case ParityEven: parity_enable = 1; parity_select = 1; break;
elessair 0:f269e3021894 237 case ParityForced1: parity_enable = 1; parity_select = 2; break;
elessair 0:f269e3021894 238 case ParityForced0: parity_enable = 1; parity_select = 3; break;
elessair 0:f269e3021894 239 default:
elessair 0:f269e3021894 240 break;
elessair 0:f269e3021894 241 }
elessair 0:f269e3021894 242
elessair 0:f269e3021894 243 obj->uart->LCR = data_bits << 0
elessair 0:f269e3021894 244 | stop_bits << 2
elessair 0:f269e3021894 245 | parity_enable << 3
elessair 0:f269e3021894 246 | parity_select << 4;
elessair 0:f269e3021894 247 }
elessair 0:f269e3021894 248
elessair 0:f269e3021894 249 /******************************************************************************
elessair 0:f269e3021894 250 * INTERRUPTS HANDLING
elessair 0:f269e3021894 251 ******************************************************************************/
elessair 0:f269e3021894 252 static inline void uart_irq(uint32_t iir, uint32_t index) {
elessair 0:f269e3021894 253 // [Chapter 14] LPC17xx UART0/2/3: UARTn Interrupt Handling
elessair 0:f269e3021894 254 SerialIrq irq_type;
elessair 0:f269e3021894 255 switch (iir) {
elessair 0:f269e3021894 256 case 1: irq_type = TxIrq; break;
elessair 0:f269e3021894 257 case 2: irq_type = RxIrq; break;
elessair 0:f269e3021894 258 default: return;
elessair 0:f269e3021894 259 }
elessair 0:f269e3021894 260
elessair 0:f269e3021894 261 if (serial_irq_ids[index] != 0)
elessair 0:f269e3021894 262 irq_handler(serial_irq_ids[index], irq_type);
elessair 0:f269e3021894 263 }
elessair 0:f269e3021894 264
elessair 0:f269e3021894 265 void uart0_irq() {uart_irq((LPC_UART0->IIR >> 1) & 0x7, 0);}
elessair 0:f269e3021894 266 void uart1_irq() {uart_irq((LPC_UART1->IIR >> 1) & 0x7, 1);}
elessair 0:f269e3021894 267 void uart2_irq() {uart_irq((LPC_UART2->IIR >> 1) & 0x7, 2);}
elessair 0:f269e3021894 268 void uart3_irq() {uart_irq((LPC_UART3->IIR >> 1) & 0x7, 3);}
elessair 0:f269e3021894 269
elessair 0:f269e3021894 270 void serial_irq_handler(serial_t *obj, uart_irq_handler handler, uint32_t id) {
elessair 0:f269e3021894 271 irq_handler = handler;
elessair 0:f269e3021894 272 serial_irq_ids[obj->index] = id;
elessair 0:f269e3021894 273 }
elessair 0:f269e3021894 274
elessair 0:f269e3021894 275 void serial_irq_set(serial_t *obj, SerialIrq irq, uint32_t enable) {
elessair 0:f269e3021894 276 IRQn_Type irq_n = (IRQn_Type)0;
elessair 0:f269e3021894 277 uint32_t vector = 0;
elessair 0:f269e3021894 278 switch ((int)obj->uart) {
elessair 0:f269e3021894 279 case UART_0: irq_n=UART0_IRQn; vector = (uint32_t)&uart0_irq; break;
elessair 0:f269e3021894 280 case UART_1: irq_n=UART1_IRQn; vector = (uint32_t)&uart1_irq; break;
elessair 0:f269e3021894 281 case UART_2: irq_n=UART2_IRQn; vector = (uint32_t)&uart2_irq; break;
elessair 0:f269e3021894 282 case UART_3: irq_n=UART3_IRQn; vector = (uint32_t)&uart3_irq; break;
elessair 0:f269e3021894 283 }
elessair 0:f269e3021894 284
elessair 0:f269e3021894 285 if (enable) {
elessair 0:f269e3021894 286 obj->uart->IER |= 1 << irq;
elessair 0:f269e3021894 287 NVIC_SetVector(irq_n, vector);
elessair 0:f269e3021894 288 NVIC_EnableIRQ(irq_n);
elessair 0:f269e3021894 289 } else { // disable
elessair 0:f269e3021894 290 int all_disabled = 0;
elessair 0:f269e3021894 291 SerialIrq other_irq = (irq == RxIrq) ? (TxIrq) : (RxIrq);
elessair 0:f269e3021894 292 obj->uart->IER &= ~(1 << irq);
elessair 0:f269e3021894 293 all_disabled = (obj->uart->IER & (1 << other_irq)) == 0;
elessair 0:f269e3021894 294 if (all_disabled)
elessair 0:f269e3021894 295 NVIC_DisableIRQ(irq_n);
elessair 0:f269e3021894 296 }
elessair 0:f269e3021894 297 }
elessair 0:f269e3021894 298
elessair 0:f269e3021894 299 /******************************************************************************
elessair 0:f269e3021894 300 * READ/WRITE
elessair 0:f269e3021894 301 ******************************************************************************/
elessair 0:f269e3021894 302 int serial_getc(serial_t *obj) {
elessair 0:f269e3021894 303 while (!serial_readable(obj));
elessair 0:f269e3021894 304 return obj->uart->RBR;
elessair 0:f269e3021894 305 }
elessair 0:f269e3021894 306
elessair 0:f269e3021894 307 void serial_putc(serial_t *obj, int c) {
elessair 0:f269e3021894 308 while (!serial_writable(obj));
elessair 0:f269e3021894 309 obj->uart->THR = c;
elessair 0:f269e3021894 310 }
elessair 0:f269e3021894 311
elessair 0:f269e3021894 312 int serial_readable(serial_t *obj) {
elessair 0:f269e3021894 313 return obj->uart->LSR & 0x01;
elessair 0:f269e3021894 314 }
elessair 0:f269e3021894 315
elessair 0:f269e3021894 316 int serial_writable(serial_t *obj) {
elessair 0:f269e3021894 317 return obj->uart->LSR & 0x20;
elessair 0:f269e3021894 318 }
elessair 0:f269e3021894 319
elessair 0:f269e3021894 320 void serial_clear(serial_t *obj) {
elessair 0:f269e3021894 321 obj->uart->FCR = 1 << 1 // rx FIFO reset
elessair 0:f269e3021894 322 | 1 << 2 // tx FIFO reset
elessair 0:f269e3021894 323 | 0 << 6; // interrupt depth
elessair 0:f269e3021894 324 }
elessair 0:f269e3021894 325
elessair 0:f269e3021894 326 void serial_pinout_tx(PinName tx) {
elessair 0:f269e3021894 327 pinmap_pinout(tx, PinMap_UART_TX);
elessair 0:f269e3021894 328 }
elessair 0:f269e3021894 329
elessair 0:f269e3021894 330 void serial_break_set(serial_t *obj) {
elessair 0:f269e3021894 331 obj->uart->LCR |= (1 << 6);
elessair 0:f269e3021894 332 }
elessair 0:f269e3021894 333
elessair 0:f269e3021894 334 void serial_break_clear(serial_t *obj) {
elessair 0:f269e3021894 335 obj->uart->LCR &= ~(1 << 6);
elessair 0:f269e3021894 336 }
elessair 0:f269e3021894 337