wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 1 | /* |
Wolfgang Denk | c80857e | 2006-07-21 11:56:05 +0200 | [diff] [blame] | 2 | * (C) Copyright 2000-2006 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 3 | * Wolfgang Denk, DENX Software Engineering, wd@denx.de. |
| 4 | * |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 5 | * (C) Copyright 2010 |
| 6 | * Stefan Roese, DENX Software Engineering, sr@denx.de. |
| 7 | * |
Wolfgang Denk | 815c967 | 2013-09-17 11:24:06 +0200 | [diff] [blame] | 8 | * SPDX-License-Identifier: GPL-2.0 IBM-pibs |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 9 | */ |
Stefan Roese | 1a47115 | 2007-10-22 16:22:40 +0200 | [diff] [blame] | 10 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 11 | #include <common.h> |
| 12 | #include <commproc.h> |
| 13 | #include <asm/processor.h> |
Stefan Roese | 1a47115 | 2007-10-22 16:22:40 +0200 | [diff] [blame] | 14 | #include <asm/io.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 15 | #include <watchdog.h> |
Stefan Roese | 247e9d7 | 2010-09-09 19:18:00 +0200 | [diff] [blame] | 16 | #include <asm/ppc4xx.h> |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 17 | |
Wolfgang Denk | 6405a15 | 2006-03-31 18:32:53 +0200 | [diff] [blame] | 18 | DECLARE_GLOBAL_DATA_PTR; |
| 19 | |
Matthias Fuchs | e54a67f | 2013-08-07 12:10:38 +0200 | [diff] [blame] | 20 | #if defined(CONFIG_405GP) || \ |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 21 | defined(CONFIG_405EP) || defined(CONFIG_405EZ) || \ |
Stefan Roese | 153b3e2 | 2007-10-05 17:10:59 +0200 | [diff] [blame] | 22 | defined(CONFIG_405EX) || defined(CONFIG_440) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 23 | |
| 24 | #if defined(CONFIG_440) |
Stefan Roese | bdd13d1 | 2008-03-11 15:05:26 +0100 | [diff] [blame] | 25 | |
Stefan Roese | 42fbddd | 2006-09-07 11:51:23 +0200 | [diff] [blame] | 26 | #if defined(CONFIG_440GP) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 27 | #define CR0_MASK 0x3fff0000 |
| 28 | #define CR0_EXTCLK_ENA 0x00600000 |
| 29 | #define CR0_UDIV_POS 16 |
Stefan Roese | 42fbddd | 2006-09-07 11:51:23 +0200 | [diff] [blame] | 30 | #define UDIV_SUBTRACT 1 |
Stefan Roese | 918010a | 2009-09-09 16:25:29 +0200 | [diff] [blame] | 31 | #define UART0_SDR CPC0_CR0 |
Stefan Roese | 42fbddd | 2006-09-07 11:51:23 +0200 | [diff] [blame] | 32 | #define MFREG(a, d) d = mfdcr(a) |
| 33 | #define MTREG(a, d) mtdcr(a, d) |
| 34 | #else /* #if defined(CONFIG_440GP) */ |
| 35 | /* all other 440 PPC's access clock divider via sdr register */ |
| 36 | #define CR0_MASK 0xdfffffff |
| 37 | #define CR0_EXTCLK_ENA 0x00800000 |
| 38 | #define CR0_UDIV_POS 0 |
| 39 | #define UDIV_SUBTRACT 0 |
Stefan Roese | 918010a | 2009-09-09 16:25:29 +0200 | [diff] [blame] | 40 | #define UART0_SDR SDR0_UART0 |
| 41 | #define UART1_SDR SDR0_UART1 |
Stefan Roese | 422853e | 2008-06-06 16:10:41 +0200 | [diff] [blame] | 42 | #if defined(CONFIG_440EP) || defined(CONFIG_440EPX) || \ |
| 43 | defined(CONFIG_440GR) || defined(CONFIG_440GRX) || \ |
| 44 | defined(CONFIG_440SP) || defined(CONFIG_440SPE) || \ |
Stefan Roese | bdd13d1 | 2008-03-11 15:05:26 +0100 | [diff] [blame] | 45 | defined(CONFIG_460EX) || defined(CONFIG_460GT) |
Stefan Roese | 918010a | 2009-09-09 16:25:29 +0200 | [diff] [blame] | 46 | #define UART2_SDR SDR0_UART2 |
Stefan Roese | 42fbddd | 2006-09-07 11:51:23 +0200 | [diff] [blame] | 47 | #endif |
Stefan Roese | 422853e | 2008-06-06 16:10:41 +0200 | [diff] [blame] | 48 | #if defined(CONFIG_440EP) || defined(CONFIG_440EPX) || \ |
| 49 | defined(CONFIG_440GR) || defined(CONFIG_440GRX) || \ |
Stefan Roese | bdd13d1 | 2008-03-11 15:05:26 +0100 | [diff] [blame] | 50 | defined(CONFIG_460EX) || defined(CONFIG_460GT) |
Stefan Roese | 918010a | 2009-09-09 16:25:29 +0200 | [diff] [blame] | 51 | #define UART3_SDR SDR0_UART3 |
Stefan Roese | 42fbddd | 2006-09-07 11:51:23 +0200 | [diff] [blame] | 52 | #endif |
| 53 | #define MFREG(a, d) mfsdr(a, d) |
| 54 | #define MTREG(a, d) mtsdr(a, d) |
| 55 | #endif /* #if defined(CONFIG_440GP) */ |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 56 | #elif defined(CONFIG_405EP) || defined(CONFIG_405EZ) |
stroese | 937d667 | 2003-05-23 11:25:57 +0000 | [diff] [blame] | 57 | #define UCR0_MASK 0x0000007f |
| 58 | #define UCR1_MASK 0x00007f00 |
| 59 | #define UCR0_UDIV_POS 0 |
| 60 | #define UCR1_UDIV_POS 8 |
| 61 | #define UDIV_MAX 127 |
Stefan Roese | 153b3e2 | 2007-10-05 17:10:59 +0200 | [diff] [blame] | 62 | #elif defined(CONFIG_405EX) |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 63 | #define MFREG(a, d) mfsdr(a, d) |
| 64 | #define MTREG(a, d) mtsdr(a, d) |
Stefan Roese | 153b3e2 | 2007-10-05 17:10:59 +0200 | [diff] [blame] | 65 | #define CR0_MASK 0x000000ff |
| 66 | #define CR0_EXTCLK_ENA 0x00800000 |
| 67 | #define CR0_UDIV_POS 0 |
| 68 | #define UDIV_SUBTRACT 0 |
Stefan Roese | 918010a | 2009-09-09 16:25:29 +0200 | [diff] [blame] | 69 | #define UART0_SDR SDR0_UART0 |
| 70 | #define UART1_SDR SDR0_UART1 |
Matthias Fuchs | e54a67f | 2013-08-07 12:10:38 +0200 | [diff] [blame] | 71 | #else /* CONFIG_405GP */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 72 | #define CR0_MASK 0x00001fff |
stroese | 85d0fec | 2003-02-17 16:06:06 +0000 | [diff] [blame] | 73 | #define CR0_EXTCLK_ENA 0x000000c0 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 74 | #define CR0_UDIV_POS 1 |
stroese | 937d667 | 2003-05-23 11:25:57 +0000 | [diff] [blame] | 75 | #define UDIV_MAX 32 |
| 76 | #endif |
| 77 | |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 78 | #if defined(CONFIG_405EP) && defined(CONFIG_SYS_EXT_SERIAL_CLOCK) |
Wolfgang Denk | 0ee7077 | 2005-09-23 11:05:55 +0200 | [diff] [blame] | 79 | #error "External serial clock not supported on AMCC PPC405EP!" |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 80 | #endif |
| 81 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 82 | #if (defined(CONFIG_405EX) || defined(CONFIG_405EZ) || \ |
| 83 | defined(CONFIG_440)) && !defined(CONFIG_SYS_EXT_SERIAL_CLOCK) |
| 84 | /* |
| 85 | * For some SoC's, the cpu clock is on divider chain A, UART on |
| 86 | * divider chain B ... so cpu clock is irrelevant. Get the |
| 87 | * "optimized" values that are subject to the 1/2 opb clock |
| 88 | * constraint. |
| 89 | */ |
| 90 | static u16 serial_bdiv(int baudrate, u32 *udiv) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 91 | { |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 92 | sys_info_t sysinfo; |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 93 | u32 div; /* total divisor udiv * bdiv */ |
| 94 | u32 umin; /* minimum udiv */ |
| 95 | u16 diff; /* smallest diff */ |
| 96 | u16 idiff; /* current diff */ |
| 97 | u16 ibdiv; /* current bdiv */ |
| 98 | u32 i; |
| 99 | u32 est; /* current estimate */ |
| 100 | u32 max; |
| 101 | #if defined(CONFIG_405EZ) |
| 102 | u32 cpr_pllc; |
| 103 | u32 plloutb; |
| 104 | u32 reg; |
| 105 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 106 | |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 107 | get_sys_info(&sysinfo); |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 108 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 109 | #if defined(CONFIG_405EZ) |
Stefan Roese | 87476ba | 2007-08-13 09:05:33 +0200 | [diff] [blame] | 110 | /* check the pll feedback source */ |
Stefan Roese | 918010a | 2009-09-09 16:25:29 +0200 | [diff] [blame] | 111 | mfcpr(CPR0_PLLC, cpr_pllc); |
Stefan Roese | 3dae28e | 2007-08-14 15:03:17 +0200 | [diff] [blame] | 112 | plloutb = ((CONFIG_SYS_CLK_FREQ * ((cpr_pllc & PLLC_SRC_MASK) ? |
Stefan Roese | 1a47115 | 2007-10-22 16:22:40 +0200 | [diff] [blame] | 113 | sysinfo.pllFwdDivB : sysinfo.pllFwdDiv) * |
| 114 | sysinfo.pllFbkDiv) / sysinfo.pllFwdDivB); |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 115 | div = plloutb / (16 * baudrate); /* total divisor */ |
| 116 | umin = (plloutb / get_OPB_freq()) << 1; /* 2 x OPB divisor */ |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 117 | max = 256; /* highest possible */ |
| 118 | #else /* 405EZ */ |
| 119 | div = sysinfo.freqPLB / (16 * baudrate); /* total divisor */ |
| 120 | umin = sysinfo.pllOpbDiv << 1; /* 2 x OPB divisor */ |
| 121 | max = 32; /* highest possible */ |
| 122 | #endif /* 405EZ */ |
| 123 | |
| 124 | *udiv = diff = max; |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 125 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 126 | /* |
| 127 | * i is the test udiv value -- start with the largest |
| 128 | * possible (max) to minimize serial clock and constrain |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 129 | * search to umin. |
| 130 | */ |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 131 | for (i = max; i > umin; i--) { |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 132 | ibdiv = div / i; |
| 133 | est = i * ibdiv; |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 134 | idiff = (est > div) ? (est - div) : (div - est); |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 135 | if (idiff == 0) { |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 136 | *udiv = i; |
| 137 | break; /* can't do better */ |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 138 | } else if (idiff < diff) { |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 139 | *udiv = i; /* best so far */ |
| 140 | diff = idiff; /* update lowest diff*/ |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 141 | } |
| 142 | } |
| 143 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 144 | #if defined(CONFIG_405EZ) |
Stefan Roese | 8cb251a | 2010-09-12 06:21:37 +0200 | [diff] [blame] | 145 | mfcpr(CPR0_PERD0, reg); |
Stefan Roese | 17ffbc8 | 2007-03-21 13:38:59 +0100 | [diff] [blame] | 146 | reg &= ~0x0000ffff; |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 147 | reg |= ((*udiv - 0) << 8) | (*udiv - 0); |
Stefan Roese | 8cb251a | 2010-09-12 06:21:37 +0200 | [diff] [blame] | 148 | mtcpr(CPR0_PERD0, reg); |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 149 | #endif |
| 150 | |
| 151 | return div / *udiv; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 152 | } |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 153 | #endif /* #if (defined(CONFIG_405EP) ... */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 154 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 155 | /* |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 156 | * This function returns the UART clock used by the common |
| 157 | * NS16550 driver. Additionally the SoC internal divisors for |
| 158 | * optimal UART baudrate are configured. |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 159 | */ |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 160 | int get_serial_clock(void) |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 161 | { |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 162 | u32 clk; |
| 163 | u32 udiv; |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 164 | #if !defined(CONFIG_405EZ) |
| 165 | u32 reg; |
wdenk | 96c7a8c | 2005-01-09 22:28:56 +0000 | [diff] [blame] | 166 | #endif |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 167 | #if !defined(CONFIG_SYS_EXT_SERIAL_CLOCK) |
| 168 | PPC4xx_SYS_INFO sys_info; |
Stefan Roese | 153b3e2 | 2007-10-05 17:10:59 +0200 | [diff] [blame] | 169 | #endif |
Stefan Roese | 153b3e2 | 2007-10-05 17:10:59 +0200 | [diff] [blame] | 170 | |
| 171 | /* |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 172 | * Programming of the internal divisors is SoC specific. |
| 173 | * Let's handle this in some #ifdef's for the SoC's. |
Stefan Roese | 153b3e2 | 2007-10-05 17:10:59 +0200 | [diff] [blame] | 174 | */ |
Stefan Roese | 153b3e2 | 2007-10-05 17:10:59 +0200 | [diff] [blame] | 175 | |
Matthias Fuchs | e54a67f | 2013-08-07 12:10:38 +0200 | [diff] [blame] | 176 | #if defined(CONFIG_405GP) |
Stefan Roese | 918010a | 2009-09-09 16:25:29 +0200 | [diff] [blame] | 177 | reg = mfdcr(CPC0_CR0) & ~CR0_MASK; |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 178 | #ifdef CONFIG_SYS_EXT_SERIAL_CLOCK |
| 179 | clk = CONFIG_SYS_EXT_SERIAL_CLOCK; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 180 | udiv = 1; |
| 181 | reg |= CR0_EXTCLK_ENA; |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 182 | #else /* CONFIG_SYS_EXT_SERIAL_CLOCK */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 183 | clk = gd->cpu_clk; |
Jean-Christophe PLAGNIOL-VILLARD | 0383694 | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 184 | #ifdef CONFIG_SYS_405_UART_ERRATA_59 |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 185 | udiv = 31; /* Errata 59: stuck at 31 */ |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 186 | #else /* CONFIG_SYS_405_UART_ERRATA_59 */ |
Wolfgang Denk | df59292 | 2011-10-29 09:37:52 +0000 | [diff] [blame] | 187 | { |
| 188 | u32 tmp = CONFIG_SYS_BASE_BAUD * 16; |
| 189 | |
| 190 | udiv = (clk + tmp / 2) / tmp; |
| 191 | } |
stroese | 937d667 | 2003-05-23 11:25:57 +0000 | [diff] [blame] | 192 | if (udiv > UDIV_MAX) /* max. n bits for udiv */ |
| 193 | udiv = UDIV_MAX; |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 194 | #endif /* CONFIG_SYS_405_UART_ERRATA_59 */ |
| 195 | #endif /* CONFIG_SYS_EXT_SERIAL_CLOCK */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 196 | reg |= (udiv - 1) << CR0_UDIV_POS; /* set the UART divisor */ |
Stefan Roese | 918010a | 2009-09-09 16:25:29 +0200 | [diff] [blame] | 197 | mtdcr (CPC0_CR0, reg); |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 198 | #ifdef CONFIG_SYS_EXT_SERIAL_CLOCK |
| 199 | clk = CONFIG_SYS_EXT_SERIAL_CLOCK; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 200 | #else |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 201 | clk = CONFIG_SYS_BASE_BAUD * 16; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 202 | #endif |
Matthias Fuchs | e54a67f | 2013-08-07 12:10:38 +0200 | [diff] [blame] | 203 | #endif |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 204 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 205 | #if defined(CONFIG_405EP) |
Wolfgang Denk | df59292 | 2011-10-29 09:37:52 +0000 | [diff] [blame] | 206 | { |
| 207 | u32 tmp = CONFIG_SYS_BASE_BAUD * 16; |
| 208 | |
| 209 | reg = mfdcr(CPC0_UCR) & ~(UCR0_MASK | UCR1_MASK); |
| 210 | clk = gd->cpu_clk; |
| 211 | udiv = (clk + tmp / 2) / tmp; |
| 212 | if (udiv > UDIV_MAX) /* max. n bits for udiv */ |
| 213 | udiv = UDIV_MAX; |
| 214 | } |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 215 | reg |= udiv << UCR0_UDIV_POS; /* set the UART divisor */ |
| 216 | reg |= udiv << UCR1_UDIV_POS; /* set the UART divisor */ |
| 217 | mtdcr(CPC0_UCR, reg); |
| 218 | clk = CONFIG_SYS_BASE_BAUD * 16; |
| 219 | #endif /* CONFIG_405EP */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 220 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 221 | #if defined(CONFIG_405EX) || defined(CONFIG_440) |
| 222 | MFREG(UART0_SDR, reg); |
| 223 | reg &= ~CR0_MASK; |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 224 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 225 | #ifdef CONFIG_SYS_EXT_SERIAL_CLOCK |
| 226 | reg |= CR0_EXTCLK_ENA; |
| 227 | udiv = 1; |
| 228 | clk = CONFIG_SYS_EXT_SERIAL_CLOCK; |
| 229 | #else /* CONFIG_SYS_EXT_SERIAL_CLOCK */ |
| 230 | clk = gd->baudrate * serial_bdiv(gd->baudrate, &udiv) * 16; |
| 231 | #endif /* CONFIG_SYS_EXT_SERIAL_CLOCK */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 232 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 233 | reg |= (udiv - UDIV_SUBTRACT) << CR0_UDIV_POS; /* set the UART divisor */ |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 234 | |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 235 | /* |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 236 | * Configure input clock to baudrate generator for all |
| 237 | * available serial ports here |
wdenk | fe8c280 | 2002-11-03 00:38:21 +0000 | [diff] [blame] | 238 | */ |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 239 | MTREG(UART0_SDR, reg); |
| 240 | #if defined(UART1_SDR) |
| 241 | MTREG(UART1_SDR, reg); |
Jon Loeliger | 07efe2a | 2007-07-10 10:27:39 -0500 | [diff] [blame] | 242 | #endif |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 243 | #if defined(UART2_SDR) |
| 244 | MTREG(UART2_SDR, reg); |
| 245 | #endif |
| 246 | #if defined(UART3_SDR) |
| 247 | MTREG(UART3_SDR, reg); |
| 248 | #endif |
| 249 | #endif /* CONFIG_405EX ... */ |
wdenk | 96c7a8c | 2005-01-09 22:28:56 +0000 | [diff] [blame] | 250 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 251 | #if defined(CONFIG_405EZ) |
| 252 | clk = gd->baudrate * serial_bdiv(gd->baudrate, &udiv) * 16; |
| 253 | #endif /* CONFIG_405EZ */ |
wdenk | 96c7a8c | 2005-01-09 22:28:56 +0000 | [diff] [blame] | 254 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 255 | /* |
| 256 | * Correct UART frequency in bd-info struct now that |
| 257 | * the UART divisor is available |
| 258 | */ |
| 259 | #ifdef CONFIG_SYS_EXT_SERIAL_CLOCK |
Simon Glass | 004cc85 | 2012-12-13 20:48:59 +0000 | [diff] [blame] | 260 | gd->arch.uart_clk = CONFIG_SYS_EXT_SERIAL_CLOCK; |
Stefan Roese | 1a47115 | 2007-10-22 16:22:40 +0200 | [diff] [blame] | 261 | #else |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 262 | get_sys_info(&sys_info); |
Simon Glass | 004cc85 | 2012-12-13 20:48:59 +0000 | [diff] [blame] | 263 | gd->arch.uart_clk = sys_info.freqUART / udiv; |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 264 | #endif |
Stefan Roese | 1a47115 | 2007-10-22 16:22:40 +0200 | [diff] [blame] | 265 | |
Stefan Roese | 3ddce57 | 2010-09-20 16:05:31 +0200 | [diff] [blame] | 266 | return clk; |
Stefan Roese | 1a47115 | 2007-10-22 16:22:40 +0200 | [diff] [blame] | 267 | } |
Matthias Fuchs | e54a67f | 2013-08-07 12:10:38 +0200 | [diff] [blame] | 268 | #endif /* CONFIG_405GP */ |