|  | /* | 
|  | * (C) Copyright 2007 | 
|  | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. | 
|  | * | 
|  | * Author: Igor Lisitsin <igor@emcraft.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 <common.h> | 
|  |  | 
|  | /* | 
|  | * UART test | 
|  | * | 
|  | * The controllers are configured to loopback mode and several | 
|  | * characters are transmitted. | 
|  | */ | 
|  |  | 
|  | #ifdef CONFIG_POST | 
|  |  | 
|  | #include <post.h> | 
|  |  | 
|  | #if CONFIG_POST & CFG_POST_UART | 
|  |  | 
|  | /* | 
|  | * This table defines the UART's that should be tested and can | 
|  | * be overridden in the board config file | 
|  | */ | 
|  | #ifndef CFG_POST_UART_TABLE | 
|  | #define CFG_POST_UART_TABLE	{UART0_BASE, UART1_BASE, UART2_BASE, UART3_BASE} | 
|  | #endif | 
|  |  | 
|  | #include <asm/processor.h> | 
|  | #include <serial.h> | 
|  |  | 
|  | #if defined(CONFIG_440) | 
|  | #if defined(CONFIG_440EP) || defined(CONFIG_440GR) || \ | 
|  | defined(CONFIG_440EPX) || defined(CONFIG_440GRX) | 
|  | #define UART0_BASE  CFG_PERIPHERAL_BASE + 0x00000300 | 
|  | #define UART1_BASE  CFG_PERIPHERAL_BASE + 0x00000400 | 
|  | #define UART2_BASE  CFG_PERIPHERAL_BASE + 0x00000500 | 
|  | #define UART3_BASE  CFG_PERIPHERAL_BASE + 0x00000600 | 
|  | #else | 
|  | #define UART0_BASE  CFG_PERIPHERAL_BASE + 0x00000200 | 
|  | #define UART1_BASE  CFG_PERIPHERAL_BASE + 0x00000300 | 
|  | #endif | 
|  |  | 
|  | #if defined(CONFIG_440SP) || defined(CONFIG_440SPE) | 
|  | #define UART2_BASE  CFG_PERIPHERAL_BASE + 0x00000600 | 
|  | #endif | 
|  |  | 
|  | #if defined(CONFIG_440GP) | 
|  | #define CR0_MASK        0x3fff0000 | 
|  | #define CR0_EXTCLK_ENA  0x00600000 | 
|  | #define CR0_UDIV_POS    16 | 
|  | #define UDIV_SUBTRACT	1 | 
|  | #define UART0_SDR	cntrl0 | 
|  | #define MFREG(a, d)	d = mfdcr(a) | 
|  | #define MTREG(a, d)	mtdcr(a, d) | 
|  | #else /* #if defined(CONFIG_440GP) */ | 
|  | /* all other 440 PPC's access clock divider via sdr register */ | 
|  | #define CR0_MASK        0xdfffffff | 
|  | #define CR0_EXTCLK_ENA  0x00800000 | 
|  | #define CR0_UDIV_POS    0 | 
|  | #define UDIV_SUBTRACT	0 | 
|  | #define UART0_SDR	sdr_uart0 | 
|  | #define UART1_SDR	sdr_uart1 | 
|  | #if defined(CONFIG_440EP) || defined(CONFIG_440EPx) || \ | 
|  | defined(CONFIG_440GR) || defined(CONFIG_440GRx) || \ | 
|  | defined(CONFIG_440SP) || defined(CONFIG_440SPe) | 
|  | #define UART2_SDR	sdr_uart2 | 
|  | #endif | 
|  | #if defined(CONFIG_440EP) || defined(CONFIG_440EPx) || \ | 
|  | defined(CONFIG_440GR) || defined(CONFIG_440GRx) | 
|  | #define UART3_SDR	sdr_uart3 | 
|  | #endif | 
|  | #define MFREG(a, d)	mfsdr(a, d) | 
|  | #define MTREG(a, d)	mtsdr(a, d) | 
|  | #endif /* #if defined(CONFIG_440GP) */ | 
|  | #elif defined(CONFIG_405EP) || defined(CONFIG_405EZ) | 
|  | #define UART0_BASE      0xef600300 | 
|  | #define UART1_BASE      0xef600400 | 
|  | #define UCR0_MASK       0x0000007f | 
|  | #define UCR1_MASK       0x00007f00 | 
|  | #define UCR0_UDIV_POS   0 | 
|  | #define UCR1_UDIV_POS   8 | 
|  | #define UDIV_MAX        127 | 
|  | #elif defined(CONFIG_405EX) | 
|  | #define UART0_BASE	0xef600200 | 
|  | #define UART1_BASE	0xef600300 | 
|  | #define CR0_MASK	0x000000ff | 
|  | #define CR0_EXTCLK_ENA	0x00800000 | 
|  | #define CR0_UDIV_POS	0 | 
|  | #define UDIV_SUBTRACT	0 | 
|  | #define UART0_SDR	sdr_uart0 | 
|  | #define UART1_SDR	sdr_uart1 | 
|  | #define MFREG(a, d)	mfsdr(a, d) | 
|  | #define MTREG(a, d)	mtsdr(a, d) | 
|  | #else /* CONFIG_405GP || CONFIG_405CR */ | 
|  | #define UART0_BASE      0xef600300 | 
|  | #define UART1_BASE      0xef600400 | 
|  | #define CR0_MASK        0x00001fff | 
|  | #define CR0_EXTCLK_ENA  0x000000c0 | 
|  | #define CR0_UDIV_POS    1 | 
|  | #define UDIV_MAX        32 | 
|  | #endif | 
|  |  | 
|  | #define UART_RBR    0x00 | 
|  | #define UART_THR    0x00 | 
|  | #define UART_IER    0x01 | 
|  | #define UART_IIR    0x02 | 
|  | #define UART_FCR    0x02 | 
|  | #define UART_LCR    0x03 | 
|  | #define UART_MCR    0x04 | 
|  | #define UART_LSR    0x05 | 
|  | #define UART_MSR    0x06 | 
|  | #define UART_SCR    0x07 | 
|  | #define UART_DLL    0x00 | 
|  | #define UART_DLM    0x01 | 
|  |  | 
|  | /* | 
|  | * Line Status Register. | 
|  | */ | 
|  | #define asyncLSRDataReady1            0x01 | 
|  | #define asyncLSROverrunError1         0x02 | 
|  | #define asyncLSRParityError1          0x04 | 
|  | #define asyncLSRFramingError1         0x08 | 
|  | #define asyncLSRBreakInterrupt1       0x10 | 
|  | #define asyncLSRTxHoldEmpty1          0x20 | 
|  | #define asyncLSRTxShiftEmpty1         0x40 | 
|  | #define asyncLSRRxFifoError1          0x80 | 
|  |  | 
|  | DECLARE_GLOBAL_DATA_PTR; | 
|  |  | 
|  | #if defined(CONFIG_440) || defined(CONFIG_405EX) | 
|  | #if !defined(CFG_EXT_SERIAL_CLOCK) | 
|  | static void serial_divs (int baudrate, unsigned long *pudiv, | 
|  | unsigned short *pbdiv) | 
|  | { | 
|  | sys_info_t sysinfo; | 
|  | unsigned long div;		/* total divisor udiv * bdiv */ | 
|  | unsigned long umin;		/* minimum udiv */ | 
|  | unsigned short diff;		/* smallest diff */ | 
|  | unsigned long udiv;		/* best udiv */ | 
|  | unsigned short idiff;		/* current diff */ | 
|  | unsigned short ibdiv;		/* current bdiv */ | 
|  | unsigned long i; | 
|  | unsigned long est;		/* current estimate */ | 
|  |  | 
|  | get_sys_info(&sysinfo); | 
|  |  | 
|  | udiv = 32;			/* Assume lowest possible serial clk */ | 
|  | div = sysinfo.freqPLB / (16 * baudrate); /* total divisor */ | 
|  | umin = sysinfo.pllOpbDiv << 1;	/* 2 x OPB divisor */ | 
|  | diff = 32;			/* highest possible */ | 
|  |  | 
|  | /* i is the test udiv value -- start with the largest | 
|  | * possible (32) to minimize serial clock and constrain | 
|  | * search to umin. | 
|  | */ | 
|  | for (i = 32; i > umin; i--) { | 
|  | ibdiv = div / i; | 
|  | est = i * ibdiv; | 
|  | idiff = (est > div) ? (est-div) : (div-est); | 
|  | if (idiff == 0) { | 
|  | udiv = i; | 
|  | break;	/* can't do better */ | 
|  | } else if (idiff < diff) { | 
|  | udiv = i;	/* best so far */ | 
|  | diff = idiff;	/* update lowest diff*/ | 
|  | } | 
|  | } | 
|  |  | 
|  | *pudiv = udiv; | 
|  | *pbdiv = div / udiv; | 
|  | } | 
|  | #endif | 
|  |  | 
|  | static int uart_post_init (unsigned long dev_base) | 
|  | { | 
|  | unsigned long reg = 0; | 
|  | unsigned long udiv; | 
|  | unsigned short bdiv; | 
|  | volatile char val; | 
|  | #ifdef CFG_EXT_SERIAL_CLOCK | 
|  | unsigned long tmp; | 
|  | #endif | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < 3500; i++) { | 
|  | if (in8 (dev_base + UART_LSR) & asyncLSRTxHoldEmpty1) | 
|  | break; | 
|  | udelay (100); | 
|  | } | 
|  | MFREG(UART0_SDR, reg); | 
|  | reg &= ~CR0_MASK; | 
|  |  | 
|  | #ifdef CFG_EXT_SERIAL_CLOCK | 
|  | reg |= CR0_EXTCLK_ENA; | 
|  | udiv = 1; | 
|  | tmp  = gd->baudrate * 16; | 
|  | bdiv = (CFG_EXT_SERIAL_CLOCK + tmp / 2) / tmp; | 
|  | #else | 
|  | /* For 440, the cpu clock is on divider chain A, UART on divider | 
|  | * chain B ... so cpu clock is irrelevant. Get the "optimized" | 
|  | * values that are subject to the 1/2 opb clock constraint | 
|  | */ | 
|  | serial_divs (gd->baudrate, &udiv, &bdiv); | 
|  | #endif | 
|  |  | 
|  | reg |= (udiv - UDIV_SUBTRACT) << CR0_UDIV_POS;	/* set the UART divisor */ | 
|  |  | 
|  | /* | 
|  | * Configure input clock to baudrate generator for all | 
|  | * available serial ports here | 
|  | */ | 
|  | MTREG(UART0_SDR, reg); | 
|  | #if defined(UART1_SDR) | 
|  | MTREG(UART1_SDR, reg); | 
|  | #endif | 
|  | #if defined(UART2_SDR) | 
|  | MTREG(UART2_SDR, reg); | 
|  | #endif | 
|  | #if defined(UART3_SDR) | 
|  | MTREG(UART3_SDR, reg); | 
|  | #endif | 
|  |  | 
|  | out8(dev_base + UART_LCR, 0x80);	/* set DLAB bit */ | 
|  | out8(dev_base + UART_DLL, bdiv);	/* set baudrate divisor */ | 
|  | out8(dev_base + UART_DLM, bdiv >> 8);	/* set baudrate divisor */ | 
|  | out8(dev_base + UART_LCR, 0x03);	/* clear DLAB; set 8 bits, no parity */ | 
|  | out8(dev_base + UART_FCR, 0x00);	/* disable FIFO */ | 
|  | out8(dev_base + UART_MCR, 0x10);	/* enable loopback mode */ | 
|  | val = in8(dev_base + UART_LSR);		/* clear line status */ | 
|  | val = in8(dev_base + UART_RBR);		/* read receive buffer */ | 
|  | out8(dev_base + UART_SCR, 0x00);	/* set scratchpad */ | 
|  | out8(dev_base + UART_IER, 0x00);	/* set interrupt enable reg */ | 
|  |  | 
|  | return 0; | 
|  | } | 
|  |  | 
|  | #else /* CONFIG_440 */ | 
|  |  | 
|  | static int uart_post_init (unsigned long dev_base) | 
|  | { | 
|  | unsigned long reg; | 
|  | unsigned long tmp; | 
|  | unsigned long clk; | 
|  | unsigned long udiv; | 
|  | unsigned short bdiv; | 
|  | volatile char val; | 
|  | int i; | 
|  |  | 
|  | for (i = 0; i < 3500; i++) { | 
|  | if (in8 (dev_base + UART_LSR) & asyncLSRTxHoldEmpty1) | 
|  | break; | 
|  | udelay (100); | 
|  | } | 
|  |  | 
|  | #if defined(CONFIG_405EZ) | 
|  | serial_divs(gd->baudrate, &udiv, &bdiv); | 
|  | clk = tmp = reg = 0; | 
|  | #else | 
|  | #ifdef CONFIG_405EP | 
|  | reg = mfdcr(cpc0_ucr) & ~(UCR0_MASK | UCR1_MASK); | 
|  | clk = gd->cpu_clk; | 
|  | tmp = CFG_BASE_BAUD * 16; | 
|  | udiv = (clk + tmp / 2) / tmp; | 
|  | if (udiv > UDIV_MAX)                    /* max. n bits for udiv */ | 
|  | udiv = UDIV_MAX; | 
|  | reg |= (udiv) << UCR0_UDIV_POS;	        /* set the UART divisor */ | 
|  | reg |= (udiv) << UCR1_UDIV_POS;	        /* set the UART divisor */ | 
|  | mtdcr (cpc0_ucr, reg); | 
|  | #else /* CONFIG_405EP */ | 
|  | reg = mfdcr(cntrl0) & ~CR0_MASK; | 
|  | #ifdef CFG_EXT_SERIAL_CLOCK | 
|  | clk = CFG_EXT_SERIAL_CLOCK; | 
|  | udiv = 1; | 
|  | reg |= CR0_EXTCLK_ENA; | 
|  | #else | 
|  | clk = gd->cpu_clk; | 
|  | #ifdef CFG_405_UART_ERRATA_59 | 
|  | udiv = 31;			/* Errata 59: stuck at 31 */ | 
|  | #else | 
|  | tmp = CFG_BASE_BAUD * 16; | 
|  | udiv = (clk + tmp / 2) / tmp; | 
|  | if (udiv > UDIV_MAX)                    /* max. n bits for udiv */ | 
|  | udiv = UDIV_MAX; | 
|  | #endif | 
|  | #endif | 
|  | reg |= (udiv - 1) << CR0_UDIV_POS;	/* set the UART divisor */ | 
|  | mtdcr (cntrl0, reg); | 
|  | #endif /* CONFIG_405EP */ | 
|  | tmp = gd->baudrate * udiv * 16; | 
|  | bdiv = (clk + tmp / 2) / tmp; | 
|  | #endif /* CONFIG_405EZ */ | 
|  |  | 
|  | out8(dev_base + UART_LCR, 0x80);	/* set DLAB bit */ | 
|  | out8(dev_base + UART_DLL, bdiv);	/* set baudrate divisor */ | 
|  | out8(dev_base + UART_DLM, bdiv >> 8);	/* set baudrate divisor */ | 
|  | out8(dev_base + UART_LCR, 0x03);	/* clear DLAB; set 8 bits, no parity */ | 
|  | out8(dev_base + UART_FCR, 0x00);	/* disable FIFO */ | 
|  | out8(dev_base + UART_MCR, 0x10);	/* enable loopback mode */ | 
|  | val = in8(dev_base + UART_LSR);	/* clear line status */ | 
|  | val = in8(dev_base + UART_RBR);	/* read receive buffer */ | 
|  | out8(dev_base + UART_SCR, 0x00);	/* set scratchpad */ | 
|  | out8(dev_base + UART_IER, 0x00);	/* set interrupt enable reg */ | 
|  |  | 
|  | return (0); | 
|  | } | 
|  | #endif /* CONFIG_440 */ | 
|  |  | 
|  | static void uart_post_putc (unsigned long dev_base, char c) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | out8 (dev_base + UART_THR, c);	/* put character out */ | 
|  |  | 
|  | /* Wait for transfer completion */ | 
|  | for (i = 0; i < 3500; i++) { | 
|  | if (in8 (dev_base + UART_LSR) & asyncLSRTxHoldEmpty1) | 
|  | break; | 
|  | udelay (100); | 
|  | } | 
|  | } | 
|  |  | 
|  | static int uart_post_getc (unsigned long dev_base) | 
|  | { | 
|  | int i; | 
|  |  | 
|  | /* Wait for character available */ | 
|  | for (i = 0; i < 3500; i++) { | 
|  | if (in8 (dev_base + UART_LSR) & asyncLSRDataReady1) | 
|  | break; | 
|  | udelay (100); | 
|  | } | 
|  | return 0xff & in8 (dev_base + UART_RBR); | 
|  | } | 
|  |  | 
|  | static int test_ctlr (unsigned long dev_base, int index) | 
|  | { | 
|  | int res = -1; | 
|  | char test_str[] = "*** UART Test String ***\r\n"; | 
|  | int i; | 
|  |  | 
|  | uart_post_init (dev_base); | 
|  |  | 
|  | for (i = 0; i < sizeof (test_str) - 1; i++) { | 
|  | uart_post_putc (dev_base, test_str[i]); | 
|  | if (uart_post_getc (dev_base) != test_str[i]) | 
|  | goto done; | 
|  | } | 
|  | res = 0; | 
|  | done: | 
|  | if (res) | 
|  | post_log ("uart%d test failed\n", index); | 
|  |  | 
|  | return res; | 
|  | } | 
|  |  | 
|  | int uart_post_test (int flags) | 
|  | { | 
|  | int i, res = 0; | 
|  | static unsigned long base[] = CFG_POST_UART_TABLE; | 
|  |  | 
|  | for (i = 0; i < sizeof (base) / sizeof (base[0]); i++) { | 
|  | if (test_ctlr (base[i], i)) | 
|  | res = -1; | 
|  | } | 
|  | serial_reinit_all (); | 
|  |  | 
|  | return res; | 
|  | } | 
|  |  | 
|  | #endif /* CONFIG_POST & CFG_POST_UART */ | 
|  | #endif /* CONFIG_POST */ |