/* * (C) Copyright 2000 * Rob Taylor, Flying Pig Systems. robt@flyingpig.com. * * See file CREDITS for list of people who contributed to this * project. * * This program is free software; you can redistribute it and/or * modify it under the terms of the GNU General Public License as * published by the Free Software Foundation; either version 2 of * the License, or (at your option) any later version. * * This program is distributed in the hope that it will be useful, * but WITHOUT ANY WARRANTY; without even the implied warranty of * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the * GNU General Public License for more details. * * You should have received a copy of the GNU General Public License * along with this program; if not, write to the Free Software * Foundation, Inc., 59 Temple Place, Suite 330, Boston, * MA 02111-1307 USA */ #include #include #include #ifdef CONFIG_NS87308 #include #endif #include #ifndef CONFIG_NS16550_MIN_FUNCTIONS DECLARE_GLOBAL_DATA_PTR; #if !defined(CONFIG_CONS_INDEX) #elif (CONFIG_CONS_INDEX < 1) || (CONFIG_CONS_INDEX > 6) #error "Invalid console index value." #endif #if CONFIG_CONS_INDEX == 1 && !defined(CONFIG_SYS_NS16550_COM1) #error "Console port 1 defined but not configured." #elif CONFIG_CONS_INDEX == 2 && !defined(CONFIG_SYS_NS16550_COM2) #error "Console port 2 defined but not configured." #elif CONFIG_CONS_INDEX == 3 && !defined(CONFIG_SYS_NS16550_COM3) #error "Console port 3 defined but not configured." #elif CONFIG_CONS_INDEX == 4 && !defined(CONFIG_SYS_NS16550_COM4) #error "Console port 4 defined but not configured." #elif CONFIG_CONS_INDEX == 5 && !defined(CONFIG_SYS_NS16550_COM5) #error "Console port 5 defined but not configured." #elif CONFIG_CONS_INDEX == 6 && !defined(CONFIG_SYS_NS16550_COM6) #error "Console port 6 defined but not configured." #endif /* Note: The port number specified in the functions is 1 based. * the array is 0 based. */ static NS16550_t serial_ports[6] = { #ifdef CONFIG_SYS_NS16550_COM1 (NS16550_t)CONFIG_SYS_NS16550_COM1, #else NULL, #endif #ifdef CONFIG_SYS_NS16550_COM2 (NS16550_t)CONFIG_SYS_NS16550_COM2, #else NULL, #endif #ifdef CONFIG_SYS_NS16550_COM3 (NS16550_t)CONFIG_SYS_NS16550_COM3, #else NULL, #endif #ifdef CONFIG_SYS_NS16550_COM4 (NS16550_t)CONFIG_SYS_NS16550_COM4, #else NULL, #endif #ifdef CONFIG_SYS_NS16550_COM5 (NS16550_t)CONFIG_SYS_NS16550_COM5, #else NULL, #endif #ifdef CONFIG_SYS_NS16550_COM6 (NS16550_t)CONFIG_SYS_NS16550_COM6 #else NULL #endif }; #define PORT serial_ports[port-1] /* Multi serial device functions */ #define DECLARE_ESERIAL_FUNCTIONS(port) \ static int eserial##port##_init(void) \ { \ int clock_divisor; \ clock_divisor = calc_divisor(serial_ports[port-1]); \ NS16550_init(serial_ports[port-1], clock_divisor); \ return 0 ; \ } \ static void eserial##port##_setbrg(void) \ { \ serial_setbrg_dev(port); \ } \ static int eserial##port##_getc(void) \ { \ return serial_getc_dev(port); \ } \ static int eserial##port##_tstc(void) \ { \ return serial_tstc_dev(port); \ } \ static void eserial##port##_putc(const char c) \ { \ serial_putc_dev(port, c); \ } \ static void eserial##port##_puts(const char *s) \ { \ serial_puts_dev(port, s); \ } /* Serial device descriptor */ #define INIT_ESERIAL_STRUCTURE(port, __name) { \ .name = __name, \ .start = eserial##port##_init, \ .stop = NULL, \ .setbrg = eserial##port##_setbrg, \ .getc = eserial##port##_getc, \ .tstc = eserial##port##_tstc, \ .putc = eserial##port##_putc, \ .puts = eserial##port##_puts, \ } static int calc_divisor (NS16550_t port) { #ifdef CONFIG_OMAP1510 /* If can't cleanly clock 115200 set div to 1 */ if ((CONFIG_SYS_NS16550_CLK == 12000000) && (gd->baudrate == 115200)) { port->osc_12m_sel = OSC_12M_SEL; /* enable 6.5 * divisor */ return (1); /* return 1 for base divisor */ } port->osc_12m_sel = 0; /* clear if previsouly set */ #endif #ifdef CONFIG_OMAP1610 /* If can't cleanly clock 115200 set div to 1 */ if ((CONFIG_SYS_NS16550_CLK == 48000000) && (gd->baudrate == 115200)) { return (26); /* return 26 for base divisor */ } #endif #ifdef CONFIG_APTIX #define MODE_X_DIV 13 #else #define MODE_X_DIV 16 #endif /* Compute divisor value. Normally, we should simply return: * CONFIG_SYS_NS16550_CLK) / MODE_X_DIV / gd->baudrate * but we need to round that value by adding 0.5. * Rounding is especially important at high baud rates. */ return (CONFIG_SYS_NS16550_CLK + (gd->baudrate * (MODE_X_DIV / 2))) / (MODE_X_DIV * gd->baudrate); } void _serial_putc(const char c,const int port) { if (c == '\n') NS16550_putc(PORT, '\r'); NS16550_putc(PORT, c); } void _serial_putc_raw(const char c,const int port) { NS16550_putc(PORT, c); } void _serial_puts (const char *s,const int port) { while (*s) { _serial_putc (*s++,port); } } int _serial_getc(const int port) { return NS16550_getc(PORT); } int _serial_tstc(const int port) { return NS16550_tstc(PORT); } void _serial_setbrg (const int port) { int clock_divisor; clock_divisor = calc_divisor(PORT); NS16550_reinit(PORT, clock_divisor); } static inline void serial_putc_dev(unsigned int dev_index,const char c) { _serial_putc(c,dev_index); } static inline void serial_putc_raw_dev(unsigned int dev_index,const char c) { _serial_putc_raw(c,dev_index); } static inline void serial_puts_dev(unsigned int dev_index,const char *s) { _serial_puts(s,dev_index); } static inline int serial_getc_dev(unsigned int dev_index) { return _serial_getc(dev_index); } static inline int serial_tstc_dev(unsigned int dev_index) { return _serial_tstc(dev_index); } static inline void serial_setbrg_dev(unsigned int dev_index) { _serial_setbrg(dev_index); } #if defined(CONFIG_SYS_NS16550_COM1) DECLARE_ESERIAL_FUNCTIONS(1); struct serial_device eserial1_device = INIT_ESERIAL_STRUCTURE(1, "eserial0"); #endif #if defined(CONFIG_SYS_NS16550_COM2) DECLARE_ESERIAL_FUNCTIONS(2); struct serial_device eserial2_device = INIT_ESERIAL_STRUCTURE(2, "eserial1"); #endif #if defined(CONFIG_SYS_NS16550_COM3) DECLARE_ESERIAL_FUNCTIONS(3); struct serial_device eserial3_device = INIT_ESERIAL_STRUCTURE(3, "eserial2"); #endif #if defined(CONFIG_SYS_NS16550_COM4) DECLARE_ESERIAL_FUNCTIONS(4); struct serial_device eserial4_device = INIT_ESERIAL_STRUCTURE(4, "eserial3"); #endif #if defined(CONFIG_SYS_NS16550_COM5) DECLARE_ESERIAL_FUNCTIONS(5); struct serial_device eserial5_device = INIT_ESERIAL_STRUCTURE(5, "eserial4"); #endif #if defined(CONFIG_SYS_NS16550_COM6) DECLARE_ESERIAL_FUNCTIONS(6); struct serial_device eserial6_device = INIT_ESERIAL_STRUCTURE(6, "eserial5"); #endif __weak struct serial_device *default_serial_console(void) { #if CONFIG_CONS_INDEX == 1 return &eserial1_device; #elif CONFIG_CONS_INDEX == 2 return &eserial2_device; #elif CONFIG_CONS_INDEX == 3 return &eserial3_device; #elif CONFIG_CONS_INDEX == 4 return &eserial4_device; #elif CONFIG_CONS_INDEX == 5 return &eserial5_device; #elif CONFIG_CONS_INDEX == 6 return &eserial6_device; #else #error "Bad CONFIG_CONS_INDEX." #endif } void ns16550_serial_initialize(void) { #if defined(CONFIG_SYS_NS16550_COM1) serial_register(&eserial1_device); #endif #if defined(CONFIG_SYS_NS16550_COM2) serial_register(&eserial2_device); #endif #if defined(CONFIG_SYS_NS16550_COM3) serial_register(&eserial3_device); #endif #if defined(CONFIG_SYS_NS16550_COM4) serial_register(&eserial4_device); #endif #if defined(CONFIG_SYS_NS16550_COM5) serial_register(&eserial5_device); #endif #if defined(CONFIG_SYS_NS16550_COM6) serial_register(&eserial6_device); #endif } #endif /* !CONFIG_NS16550_MIN_FUNCTIONS */