Daisuke Nojiri | 3a2ac88 | 2015-02-09 19:39:39 -0800 | [diff] [blame^] | 1 | /* |
| 2 | * (C) Copyright 2000 |
| 3 | * Rob Taylor, Flying Pig Systems. robt@flyingpig.com. |
| 4 | * |
| 5 | * SPDX-License-Identifier: GPL-2.0+ |
| 6 | */ |
| 7 | |
| 8 | #include <common.h> |
| 9 | #include <linux/compiler.h> |
| 10 | |
| 11 | #include <ns16550.h> |
| 12 | #ifdef CONFIG_NS87308 |
| 13 | #include <ns87308.h> |
| 14 | #endif |
| 15 | |
| 16 | #include <serial.h> |
| 17 | |
| 18 | #ifndef CONFIG_NS16550_MIN_FUNCTIONS |
| 19 | |
| 20 | DECLARE_GLOBAL_DATA_PTR; |
| 21 | |
| 22 | #if !defined(CONFIG_CONS_INDEX) |
| 23 | #elif (CONFIG_CONS_INDEX < 1) || (CONFIG_CONS_INDEX > 6) |
| 24 | #error "Invalid console index value." |
| 25 | #endif |
| 26 | |
| 27 | #if CONFIG_CONS_INDEX == 1 && !defined(CONFIG_SYS_NS16550_COM1) |
| 28 | #error "Console port 1 defined but not configured." |
| 29 | #elif CONFIG_CONS_INDEX == 2 && !defined(CONFIG_SYS_NS16550_COM2) |
| 30 | #error "Console port 2 defined but not configured." |
| 31 | #elif CONFIG_CONS_INDEX == 3 && !defined(CONFIG_SYS_NS16550_COM3) |
| 32 | #error "Console port 3 defined but not configured." |
| 33 | #elif CONFIG_CONS_INDEX == 4 && !defined(CONFIG_SYS_NS16550_COM4) |
| 34 | #error "Console port 4 defined but not configured." |
| 35 | #elif CONFIG_CONS_INDEX == 5 && !defined(CONFIG_SYS_NS16550_COM5) |
| 36 | #error "Console port 5 defined but not configured." |
| 37 | #elif CONFIG_CONS_INDEX == 6 && !defined(CONFIG_SYS_NS16550_COM6) |
| 38 | #error "Console port 6 defined but not configured." |
| 39 | #endif |
| 40 | |
| 41 | /* Note: The port number specified in the functions is 1 based. |
| 42 | * the array is 0 based. |
| 43 | */ |
| 44 | static NS16550_t serial_ports[6] = { |
| 45 | #ifdef CONFIG_SYS_NS16550_COM1 |
| 46 | (NS16550_t)CONFIG_SYS_NS16550_COM1, |
| 47 | #else |
| 48 | NULL, |
| 49 | #endif |
| 50 | #ifdef CONFIG_SYS_NS16550_COM2 |
| 51 | (NS16550_t)CONFIG_SYS_NS16550_COM2, |
| 52 | #else |
| 53 | NULL, |
| 54 | #endif |
| 55 | #ifdef CONFIG_SYS_NS16550_COM3 |
| 56 | (NS16550_t)CONFIG_SYS_NS16550_COM3, |
| 57 | #else |
| 58 | NULL, |
| 59 | #endif |
| 60 | #ifdef CONFIG_SYS_NS16550_COM4 |
| 61 | (NS16550_t)CONFIG_SYS_NS16550_COM4, |
| 62 | #else |
| 63 | NULL, |
| 64 | #endif |
| 65 | #ifdef CONFIG_SYS_NS16550_COM5 |
| 66 | (NS16550_t)CONFIG_SYS_NS16550_COM5, |
| 67 | #else |
| 68 | NULL, |
| 69 | #endif |
| 70 | #ifdef CONFIG_SYS_NS16550_COM6 |
| 71 | (NS16550_t)CONFIG_SYS_NS16550_COM6 |
| 72 | #else |
| 73 | NULL |
| 74 | #endif |
| 75 | }; |
| 76 | |
| 77 | #define PORT serial_ports[port-1] |
| 78 | |
| 79 | /* Multi serial device functions */ |
| 80 | #define DECLARE_ESERIAL_FUNCTIONS(port) \ |
| 81 | static int eserial##port##_init(void) \ |
| 82 | { \ |
| 83 | int clock_divisor; \ |
| 84 | clock_divisor = calc_divisor(serial_ports[port-1]); \ |
| 85 | NS16550_init(serial_ports[port-1], clock_divisor); \ |
| 86 | return 0 ; \ |
| 87 | } \ |
| 88 | static void eserial##port##_setbrg(void) \ |
| 89 | { \ |
| 90 | serial_setbrg_dev(port); \ |
| 91 | } \ |
| 92 | static int eserial##port##_getc(void) \ |
| 93 | { \ |
| 94 | return serial_getc_dev(port); \ |
| 95 | } \ |
| 96 | static int eserial##port##_tstc(void) \ |
| 97 | { \ |
| 98 | return serial_tstc_dev(port); \ |
| 99 | } \ |
| 100 | static void eserial##port##_putc(const char c) \ |
| 101 | { \ |
| 102 | serial_putc_dev(port, c); \ |
| 103 | } \ |
| 104 | static void eserial##port##_puts(const char *s) \ |
| 105 | { \ |
| 106 | serial_puts_dev(port, s); \ |
| 107 | } |
| 108 | |
| 109 | /* Serial device descriptor */ |
| 110 | #define INIT_ESERIAL_STRUCTURE(port, __name) { \ |
| 111 | .name = __name, \ |
| 112 | .start = eserial##port##_init, \ |
| 113 | .stop = NULL, \ |
| 114 | .setbrg = eserial##port##_setbrg, \ |
| 115 | .getc = eserial##port##_getc, \ |
| 116 | .tstc = eserial##port##_tstc, \ |
| 117 | .putc = eserial##port##_putc, \ |
| 118 | .puts = eserial##port##_puts, \ |
| 119 | } |
| 120 | |
| 121 | int calc_divisor(NS16550_t port) |
| 122 | { |
| 123 | #ifdef CONFIG_OMAP1510 |
| 124 | /* If can't cleanly clock 115200 set div to 1 */ |
| 125 | if ((CONFIG_SYS_NS16550_CLK == 12000000) && (gd->baudrate == 115200)) { |
| 126 | port->osc_12m_sel = OSC_12M_SEL; /* enable 6.5 * divisor */ |
| 127 | return (1); /* return 1 for base divisor */ |
| 128 | } |
| 129 | port->osc_12m_sel = 0; /* clear if previsouly set */ |
| 130 | #endif |
| 131 | #ifdef CONFIG_OMAP1610 |
| 132 | /* If can't cleanly clock 115200 set div to 1 */ |
| 133 | if ((CONFIG_SYS_NS16550_CLK == 48000000) && (gd->baudrate == 115200)) { |
| 134 | return (26); /* return 26 for base divisor */ |
| 135 | } |
| 136 | #endif |
| 137 | |
| 138 | #define MODE_X_DIV 16 |
| 139 | /* Compute divisor value. Normally, we should simply return: |
| 140 | * CONFIG_SYS_NS16550_CLK) / MODE_X_DIV / gd->baudrate |
| 141 | * but we need to round that value by adding 0.5. |
| 142 | * Rounding is especially important at high baud rates. |
| 143 | */ |
| 144 | return (CONFIG_SYS_NS16550_CLK + (gd->baudrate * (MODE_X_DIV / 2))) / |
| 145 | (MODE_X_DIV * gd->baudrate); |
| 146 | } |
| 147 | |
| 148 | void |
| 149 | _serial_putc(const char c,const int port) |
| 150 | { |
| 151 | if (c == '\n') |
| 152 | NS16550_putc(PORT, '\r'); |
| 153 | |
| 154 | NS16550_putc(PORT, c); |
| 155 | } |
| 156 | |
| 157 | void |
| 158 | _serial_putc_raw(const char c,const int port) |
| 159 | { |
| 160 | NS16550_putc(PORT, c); |
| 161 | } |
| 162 | |
| 163 | void |
| 164 | _serial_puts (const char *s,const int port) |
| 165 | { |
| 166 | while (*s) { |
| 167 | _serial_putc (*s++,port); |
| 168 | } |
| 169 | } |
| 170 | |
| 171 | |
| 172 | int |
| 173 | _serial_getc(const int port) |
| 174 | { |
| 175 | return NS16550_getc(PORT); |
| 176 | } |
| 177 | |
| 178 | int |
| 179 | _serial_tstc(const int port) |
| 180 | { |
| 181 | return NS16550_tstc(PORT); |
| 182 | } |
| 183 | |
| 184 | void |
| 185 | _serial_setbrg (const int port) |
| 186 | { |
| 187 | int clock_divisor; |
| 188 | |
| 189 | clock_divisor = calc_divisor(PORT); |
| 190 | NS16550_reinit(PORT, clock_divisor); |
| 191 | } |
| 192 | |
| 193 | static inline void |
| 194 | serial_putc_dev(unsigned int dev_index,const char c) |
| 195 | { |
| 196 | _serial_putc(c,dev_index); |
| 197 | } |
| 198 | |
| 199 | static inline void |
| 200 | serial_putc_raw_dev(unsigned int dev_index,const char c) |
| 201 | { |
| 202 | _serial_putc_raw(c,dev_index); |
| 203 | } |
| 204 | |
| 205 | static inline void |
| 206 | serial_puts_dev(unsigned int dev_index,const char *s) |
| 207 | { |
| 208 | _serial_puts(s,dev_index); |
| 209 | } |
| 210 | |
| 211 | static inline int |
| 212 | serial_getc_dev(unsigned int dev_index) |
| 213 | { |
| 214 | return _serial_getc(dev_index); |
| 215 | } |
| 216 | |
| 217 | static inline int |
| 218 | serial_tstc_dev(unsigned int dev_index) |
| 219 | { |
| 220 | return _serial_tstc(dev_index); |
| 221 | } |
| 222 | |
| 223 | static inline void |
| 224 | serial_setbrg_dev(unsigned int dev_index) |
| 225 | { |
| 226 | _serial_setbrg(dev_index); |
| 227 | } |
| 228 | |
| 229 | #if defined(CONFIG_SYS_NS16550_COM1) |
| 230 | DECLARE_ESERIAL_FUNCTIONS(1); |
| 231 | struct serial_device eserial1_device = |
| 232 | INIT_ESERIAL_STRUCTURE(1, "eserial0"); |
| 233 | #endif |
| 234 | #if defined(CONFIG_SYS_NS16550_COM2) |
| 235 | DECLARE_ESERIAL_FUNCTIONS(2); |
| 236 | struct serial_device eserial2_device = |
| 237 | INIT_ESERIAL_STRUCTURE(2, "eserial1"); |
| 238 | #endif |
| 239 | #if defined(CONFIG_SYS_NS16550_COM3) |
| 240 | DECLARE_ESERIAL_FUNCTIONS(3); |
| 241 | struct serial_device eserial3_device = |
| 242 | INIT_ESERIAL_STRUCTURE(3, "eserial2"); |
| 243 | #endif |
| 244 | #if defined(CONFIG_SYS_NS16550_COM4) |
| 245 | DECLARE_ESERIAL_FUNCTIONS(4); |
| 246 | struct serial_device eserial4_device = |
| 247 | INIT_ESERIAL_STRUCTURE(4, "eserial3"); |
| 248 | #endif |
| 249 | #if defined(CONFIG_SYS_NS16550_COM5) |
| 250 | DECLARE_ESERIAL_FUNCTIONS(5); |
| 251 | struct serial_device eserial5_device = |
| 252 | INIT_ESERIAL_STRUCTURE(5, "eserial4"); |
| 253 | #endif |
| 254 | #if defined(CONFIG_SYS_NS16550_COM6) |
| 255 | DECLARE_ESERIAL_FUNCTIONS(6); |
| 256 | struct serial_device eserial6_device = |
| 257 | INIT_ESERIAL_STRUCTURE(6, "eserial5"); |
| 258 | #endif |
| 259 | |
| 260 | __weak struct serial_device *default_serial_console(void) |
| 261 | { |
| 262 | #if CONFIG_CONS_INDEX == 1 |
| 263 | return &eserial1_device; |
| 264 | #elif CONFIG_CONS_INDEX == 2 |
| 265 | return &eserial2_device; |
| 266 | #elif CONFIG_CONS_INDEX == 3 |
| 267 | return &eserial3_device; |
| 268 | #elif CONFIG_CONS_INDEX == 4 |
| 269 | return &eserial4_device; |
| 270 | #elif CONFIG_CONS_INDEX == 5 |
| 271 | return &eserial5_device; |
| 272 | #elif CONFIG_CONS_INDEX == 6 |
| 273 | return &eserial6_device; |
| 274 | #else |
| 275 | #error "Bad CONFIG_CONS_INDEX." |
| 276 | #endif |
| 277 | } |
| 278 | |
| 279 | void ns16550_serial_initialize(void) |
| 280 | { |
| 281 | #if defined(CONFIG_SYS_NS16550_COM1) |
| 282 | serial_register(&eserial1_device); |
| 283 | #endif |
| 284 | #if defined(CONFIG_SYS_NS16550_COM2) |
| 285 | serial_register(&eserial2_device); |
| 286 | #endif |
| 287 | #if defined(CONFIG_SYS_NS16550_COM3) |
| 288 | serial_register(&eserial3_device); |
| 289 | #endif |
| 290 | #if defined(CONFIG_SYS_NS16550_COM4) |
| 291 | serial_register(&eserial4_device); |
| 292 | #endif |
| 293 | #if defined(CONFIG_SYS_NS16550_COM5) |
| 294 | serial_register(&eserial5_device); |
| 295 | #endif |
| 296 | #if defined(CONFIG_SYS_NS16550_COM6) |
| 297 | serial_register(&eserial6_device); |
| 298 | #endif |
| 299 | } |
| 300 | |
| 301 | #endif /* !CONFIG_NS16550_MIN_FUNCTIONS */ |