Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 1 | /* |
| 2 | * Copyright 2007 Wind River Systemes, Inc. <www.windriver.com> |
| 3 | * Copyright 2007 Embedded Specialties, Inc. |
| 4 | * Joe Hamman joe.hamman@embeddedspecialties.com |
| 5 | * |
| 6 | * Copyright 2004 Freescale Semiconductor. |
| 7 | * Jeff Brown |
| 8 | * Srikanth Srinivasan (srikanth.srinivasan@freescale.com) |
| 9 | * |
| 10 | * (C) Copyright 2002 Scott McNutt <smcnutt@artesyncp.com> |
| 11 | * |
| 12 | * See file CREDITS for list of people who contributed to this |
| 13 | * project. |
| 14 | * |
| 15 | * This program is free software; you can redistribute it and/or |
| 16 | * modify it under the terms of the GNU General Public License as |
| 17 | * published by the Free Software Foundation; either version 2 of |
| 18 | * the License, or (at your option) any later version. |
| 19 | * |
| 20 | * This program is distributed in the hope that it will be useful, |
| 21 | * but WITHOUT ANY WARRANTY; without even the implied warranty of |
| 22 | * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the |
| 23 | * GNU General Public License for more details. |
| 24 | * |
| 25 | * You should have received a copy of the GNU General Public License |
| 26 | * along with this program; if not, write to the Free Software |
| 27 | * Foundation, Inc., 59 Temple Place, Suite 330, Boston, |
| 28 | * MA 02111-1307 USA |
| 29 | */ |
| 30 | |
| 31 | #include <common.h> |
| 32 | #include <command.h> |
| 33 | #include <pci.h> |
| 34 | #include <asm/processor.h> |
| 35 | #include <asm/immap_86xx.h> |
Kumar Gala | c851462 | 2009-04-02 13:22:48 -0500 | [diff] [blame] | 36 | #include <asm/fsl_pci.h> |
Kumar Gala | 9bd4e59 | 2008-08-26 15:01:37 -0500 | [diff] [blame] | 37 | #include <asm/fsl_ddr_sdram.h> |
Kumar Gala | 5d27e02 | 2010-12-15 04:55:20 -0600 | [diff] [blame^] | 38 | #include <asm/fsl_serdes.h> |
Jon Loeliger | 13f5433 | 2008-02-18 14:01:56 -0600 | [diff] [blame] | 39 | #include <libfdt.h> |
| 40 | #include <fdt_support.h> |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 41 | |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 42 | long int fixed_sdram (void); |
| 43 | |
| 44 | int board_early_init_f (void) |
| 45 | { |
| 46 | return 0; |
| 47 | } |
| 48 | |
| 49 | int checkboard (void) |
| 50 | { |
| 51 | puts ("Board: Wind River SBC8641D\n"); |
| 52 | |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 53 | return 0; |
| 54 | } |
| 55 | |
Becky Bruce | 9973e3c | 2008-06-09 16:03:40 -0500 | [diff] [blame] | 56 | phys_size_t initdram (int board_type) |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 57 | { |
| 58 | long dram_size = 0; |
| 59 | |
| 60 | #if defined(CONFIG_SPD_EEPROM) |
Kumar Gala | 9bd4e59 | 2008-08-26 15:01:37 -0500 | [diff] [blame] | 61 | dram_size = fsl_ddr_sdram(); |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 62 | #else |
| 63 | dram_size = fixed_sdram (); |
| 64 | #endif |
| 65 | |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 66 | puts (" DDR: "); |
| 67 | return dram_size; |
| 68 | } |
| 69 | |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 70 | #if defined(CONFIG_SYS_DRAM_TEST) |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 71 | int testdram (void) |
| 72 | { |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 73 | uint *pstart = (uint *) CONFIG_SYS_MEMTEST_START; |
| 74 | uint *pend = (uint *) CONFIG_SYS_MEMTEST_END; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 75 | uint *p; |
| 76 | |
| 77 | puts ("SDRAM test phase 1:\n"); |
| 78 | for (p = pstart; p < pend; p++) |
| 79 | *p = 0xaaaaaaaa; |
| 80 | |
| 81 | for (p = pstart; p < pend; p++) { |
| 82 | if (*p != 0xaaaaaaaa) { |
| 83 | printf ("SDRAM test fails at: %08x\n", (uint) p); |
| 84 | return 1; |
| 85 | } |
| 86 | } |
| 87 | |
| 88 | puts ("SDRAM test phase 2:\n"); |
| 89 | for (p = pstart; p < pend; p++) |
| 90 | *p = 0x55555555; |
| 91 | |
| 92 | for (p = pstart; p < pend; p++) { |
| 93 | if (*p != 0x55555555) { |
| 94 | printf ("SDRAM test fails at: %08x\n", (uint) p); |
| 95 | return 1; |
| 96 | } |
| 97 | } |
| 98 | |
| 99 | puts ("SDRAM test passed.\n"); |
| 100 | return 0; |
| 101 | } |
| 102 | #endif |
| 103 | |
| 104 | #if !defined(CONFIG_SPD_EEPROM) |
| 105 | /* |
| 106 | * Fixed sdram init -- doesn't use serial presence detect. |
| 107 | */ |
| 108 | long int fixed_sdram (void) |
| 109 | { |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 110 | #if !defined(CONFIG_SYS_RAMBOOT) |
| 111 | volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 112 | volatile ccsr_ddr_t *ddr = &immap->im_ddr1; |
| 113 | |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 114 | ddr->cs0_bnds = CONFIG_SYS_DDR_CS0_BNDS; |
| 115 | ddr->cs1_bnds = CONFIG_SYS_DDR_CS1_BNDS; |
| 116 | ddr->cs2_bnds = CONFIG_SYS_DDR_CS2_BNDS; |
| 117 | ddr->cs3_bnds = CONFIG_SYS_DDR_CS3_BNDS; |
| 118 | ddr->cs0_config = CONFIG_SYS_DDR_CS0_CONFIG; |
| 119 | ddr->cs1_config = CONFIG_SYS_DDR_CS1_CONFIG; |
| 120 | ddr->cs2_config = CONFIG_SYS_DDR_CS2_CONFIG; |
| 121 | ddr->cs3_config = CONFIG_SYS_DDR_CS3_CONFIG; |
| 122 | ddr->timing_cfg_3 = CONFIG_SYS_DDR_TIMING_3; |
| 123 | ddr->timing_cfg_0 = CONFIG_SYS_DDR_TIMING_0; |
| 124 | ddr->timing_cfg_1 = CONFIG_SYS_DDR_TIMING_1; |
| 125 | ddr->timing_cfg_2 = CONFIG_SYS_DDR_TIMING_2; |
Peter Tyser | e7ee23e | 2009-07-17 10:14:45 -0500 | [diff] [blame] | 126 | ddr->sdram_cfg = CONFIG_SYS_DDR_CFG_1A; |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 127 | ddr->sdram_cfg_2 = CONFIG_SYS_DDR_CFG_2; |
Peter Tyser | e7ee23e | 2009-07-17 10:14:45 -0500 | [diff] [blame] | 128 | ddr->sdram_mode = CONFIG_SYS_DDR_MODE_1; |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 129 | ddr->sdram_mode_2 = CONFIG_SYS_DDR_MODE_2; |
| 130 | ddr->sdram_mode_cntl = CONFIG_SYS_DDR_MODE_CTL; |
| 131 | ddr->sdram_interval = CONFIG_SYS_DDR_INTERVAL; |
| 132 | ddr->sdram_data_init = CONFIG_SYS_DDR_DATA_INIT; |
| 133 | ddr->sdram_clk_cntl = CONFIG_SYS_DDR_CLK_CTRL; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 134 | |
| 135 | asm ("sync;isync"); |
| 136 | |
| 137 | udelay (500); |
| 138 | |
Peter Tyser | e7ee23e | 2009-07-17 10:14:45 -0500 | [diff] [blame] | 139 | ddr->sdram_cfg = CONFIG_SYS_DDR_CFG_1B; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 140 | asm ("sync; isync"); |
| 141 | |
| 142 | udelay (500); |
| 143 | ddr = &immap->im_ddr2; |
| 144 | |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 145 | ddr->cs0_bnds = CONFIG_SYS_DDR2_CS0_BNDS; |
| 146 | ddr->cs1_bnds = CONFIG_SYS_DDR2_CS1_BNDS; |
| 147 | ddr->cs2_bnds = CONFIG_SYS_DDR2_CS2_BNDS; |
| 148 | ddr->cs3_bnds = CONFIG_SYS_DDR2_CS3_BNDS; |
| 149 | ddr->cs0_config = CONFIG_SYS_DDR2_CS0_CONFIG; |
| 150 | ddr->cs1_config = CONFIG_SYS_DDR2_CS1_CONFIG; |
| 151 | ddr->cs2_config = CONFIG_SYS_DDR2_CS2_CONFIG; |
| 152 | ddr->cs3_config = CONFIG_SYS_DDR2_CS3_CONFIG; |
| 153 | ddr->timing_cfg_3 = CONFIG_SYS_DDR2_EXT_REFRESH; |
| 154 | ddr->timing_cfg_0 = CONFIG_SYS_DDR2_TIMING_0; |
| 155 | ddr->timing_cfg_1 = CONFIG_SYS_DDR2_TIMING_1; |
| 156 | ddr->timing_cfg_2 = CONFIG_SYS_DDR2_TIMING_2; |
Peter Tyser | e7ee23e | 2009-07-17 10:14:45 -0500 | [diff] [blame] | 157 | ddr->sdram_cfg = CONFIG_SYS_DDR2_CFG_1A; |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 158 | ddr->sdram_cfg_2 = CONFIG_SYS_DDR2_CFG_2; |
Peter Tyser | e7ee23e | 2009-07-17 10:14:45 -0500 | [diff] [blame] | 159 | ddr->sdram_mode = CONFIG_SYS_DDR2_MODE_1; |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 160 | ddr->sdram_mode_2 = CONFIG_SYS_DDR2_MODE_2; |
| 161 | ddr->sdram_mode_cntl = CONFIG_SYS_DDR2_MODE_CTL; |
| 162 | ddr->sdram_interval = CONFIG_SYS_DDR2_INTERVAL; |
| 163 | ddr->sdram_data_init = CONFIG_SYS_DDR2_DATA_INIT; |
| 164 | ddr->sdram_clk_cntl = CONFIG_SYS_DDR2_CLK_CTRL; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 165 | |
| 166 | asm ("sync;isync"); |
| 167 | |
| 168 | udelay (500); |
| 169 | |
Peter Tyser | e7ee23e | 2009-07-17 10:14:45 -0500 | [diff] [blame] | 170 | ddr->sdram_cfg = CONFIG_SYS_DDR2_CFG_1B; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 171 | asm ("sync; isync"); |
| 172 | |
| 173 | udelay (500); |
| 174 | #endif |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 175 | return CONFIG_SYS_SDRAM_SIZE * 1024 * 1024; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 176 | } |
| 177 | #endif /* !defined(CONFIG_SPD_EEPROM) */ |
| 178 | |
| 179 | #if defined(CONFIG_PCI) |
| 180 | /* |
| 181 | * Initialize PCI Devices, report devices found. |
| 182 | */ |
| 183 | |
| 184 | #ifndef CONFIG_PCI_PNP |
| 185 | static struct pci_config_table pci_fsl86xxads_config_table[] = { |
| 186 | {PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, PCI_ANY_ID, |
| 187 | PCI_IDSEL_NUMBER, PCI_ANY_ID, |
| 188 | pci_cfgfunc_config_device, {PCI_ENET0_IOADDR, |
| 189 | PCI_ENET0_MEMADDR, |
| 190 | PCI_COMMAND_MEMORY | PCI_COMMAND_MASTER}}, |
| 191 | {} |
| 192 | }; |
| 193 | #endif |
| 194 | |
Kumar Gala | 46f3e38 | 2010-07-09 00:02:34 -0500 | [diff] [blame] | 195 | static struct pci_controller pcie1_hose = { |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 196 | #ifndef CONFIG_PCI_PNP |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 197 | config_table:pci_mpc86xxcts_config_table |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 198 | #endif |
| 199 | }; |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 200 | #endif /* CONFIG_PCI */ |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 201 | |
Kumar Gala | 46f3e38 | 2010-07-09 00:02:34 -0500 | [diff] [blame] | 202 | #ifdef CONFIG_PCIE2 |
| 203 | static struct pci_controller pcie2_hose; |
| 204 | #endif /* CONFIG_PCIE2 */ |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 205 | |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 206 | int first_free_busno = 0; |
| 207 | |
| 208 | void pci_init_board(void) |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 209 | { |
Peter Tyser | 4e339b8 | 2010-09-29 13:37:27 -0500 | [diff] [blame] | 210 | struct fsl_pci_info pci_info[2]; |
Jean-Christophe PLAGNIOL-VILLARD | 6d0f6bc | 2008-10-16 15:01:15 +0200 | [diff] [blame] | 211 | volatile immap_t *immap = (immap_t *) CONFIG_SYS_CCSRBAR; |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 212 | volatile ccsr_gur_t *gur = &immap->im_gur; |
Peter Tyser | 4e339b8 | 2010-09-29 13:37:27 -0500 | [diff] [blame] | 213 | uint devdisr = in_be32(&gur->devdisr); |
Peter Tyser | 4e339b8 | 2010-09-29 13:37:27 -0500 | [diff] [blame] | 214 | int pcie_ep; |
| 215 | int num = 0; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 216 | |
Kumar Gala | 46f3e38 | 2010-07-09 00:02:34 -0500 | [diff] [blame] | 217 | #ifdef CONFIG_PCIE1 |
Kumar Gala | 5d27e02 | 2010-12-15 04:55:20 -0600 | [diff] [blame^] | 218 | int pcie_configured = is_serdes_configured(PCIE1); |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 219 | |
Peter Tyser | 4e339b8 | 2010-09-29 13:37:27 -0500 | [diff] [blame] | 220 | if (pcie_configured && !(devdisr & MPC86xx_DEVDISR_PCIEX1)) { |
| 221 | SET_STD_PCIE_INFO(pci_info[num], 1); |
| 222 | pcie_ep = fsl_setup_hose(&pcie1_hose, pci_info[num].regs); |
Peter Tyser | 8ca78f2 | 2010-10-29 17:59:24 -0500 | [diff] [blame] | 223 | printf("PCIE1: connected as %s (base addr %lx)\n", |
| 224 | pcie_ep ? "Endpoint" : "Root Complex", |
| 225 | pci_info[num].regs); |
Peter Tyser | 4e339b8 | 2010-09-29 13:37:27 -0500 | [diff] [blame] | 226 | first_free_busno = fsl_pci_init_port(&pci_info[num++], |
| 227 | &pcie1_hose, first_free_busno); |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 228 | } else { |
Peter Tyser | 8ca78f2 | 2010-10-29 17:59:24 -0500 | [diff] [blame] | 229 | puts("PCIE1: disabled\n"); |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 230 | } |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 231 | #else |
Peter Tyser | 8ca78f2 | 2010-10-29 17:59:24 -0500 | [diff] [blame] | 232 | puts("PCIE1: disabled\n"); |
Kumar Gala | 46f3e38 | 2010-07-09 00:02:34 -0500 | [diff] [blame] | 233 | #endif /* CONFIG_PCIE1 */ |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 234 | |
Kumar Gala | 46f3e38 | 2010-07-09 00:02:34 -0500 | [diff] [blame] | 235 | #ifdef CONFIG_PCIE2 |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 236 | |
Peter Tyser | 4e339b8 | 2010-09-29 13:37:27 -0500 | [diff] [blame] | 237 | SET_STD_PCIE_INFO(pci_info[num], 2); |
| 238 | pcie_ep = fsl_setup_hose(&pcie2_hose, pci_info[num].regs); |
Peter Tyser | 8ca78f2 | 2010-10-29 17:59:24 -0500 | [diff] [blame] | 239 | printf("PCIE2: connected as %s (base addr %lx)\n", |
| 240 | pcie_ep ? "Endpoint" : "Root Complex", |
| 241 | pci_info[num].regs); |
Peter Tyser | 4e339b8 | 2010-09-29 13:37:27 -0500 | [diff] [blame] | 242 | first_free_busno = fsl_pci_init_port(&pci_info[num++], |
| 243 | &pcie2_hose, first_free_busno); |
Joe Hamman | cca3496 | 2007-08-11 06:54:58 -0500 | [diff] [blame] | 244 | #else |
Peter Tyser | 8ca78f2 | 2010-10-29 17:59:24 -0500 | [diff] [blame] | 245 | puts("PCIE2: disabled\n"); |
Kumar Gala | 46f3e38 | 2010-07-09 00:02:34 -0500 | [diff] [blame] | 246 | #endif /* CONFIG_PCIE2 */ |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 247 | } |
| 248 | |
Jon Loeliger | 13f5433 | 2008-02-18 14:01:56 -0600 | [diff] [blame] | 249 | |
| 250 | #if defined(CONFIG_OF_BOARD_SETUP) |
Kumar Gala | c2083e0 | 2008-10-22 14:38:55 -0500 | [diff] [blame] | 251 | void ft_board_setup (void *blob, bd_t *bd) |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 252 | { |
Jon Loeliger | 13f5433 | 2008-02-18 14:01:56 -0600 | [diff] [blame] | 253 | ft_cpu_setup(blob, bd); |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 254 | |
Kumar Gala | 6525d51 | 2010-07-08 22:37:44 -0500 | [diff] [blame] | 255 | FT_FSL_PCI_SETUP; |
Joe Hamman | 8ac2732 | 2007-08-09 15:10:53 -0500 | [diff] [blame] | 256 | } |
| 257 | #endif |
| 258 | |
| 259 | void sbc8641d_reset_board (void) |
| 260 | { |
| 261 | puts ("Resetting board....\n"); |
| 262 | } |
| 263 | |
| 264 | /* |
| 265 | * get_board_sys_clk |
| 266 | * Clock is fixed at 1GHz on this board. Used for CONFIG_SYS_CLK_FREQ |
| 267 | */ |
| 268 | |
| 269 | unsigned long get_board_sys_clk (ulong dummy) |
| 270 | { |
| 271 | int i; |
| 272 | ulong val = 0; |
| 273 | |
| 274 | i = 5; |
| 275 | i &= 0x07; |
| 276 | |
| 277 | switch (i) { |
| 278 | case 0: |
| 279 | val = 33000000; |
| 280 | break; |
| 281 | case 1: |
| 282 | val = 40000000; |
| 283 | break; |
| 284 | case 2: |
| 285 | val = 50000000; |
| 286 | break; |
| 287 | case 3: |
| 288 | val = 66000000; |
| 289 | break; |
| 290 | case 4: |
| 291 | val = 83000000; |
| 292 | break; |
| 293 | case 5: |
| 294 | val = 100000000; |
| 295 | break; |
| 296 | case 6: |
| 297 | val = 134000000; |
| 298 | break; |
| 299 | case 7: |
| 300 | val = 166000000; |
| 301 | break; |
| 302 | } |
| 303 | |
| 304 | return val; |
| 305 | } |
Peter Tyser | 4ef630d | 2009-02-05 11:25:25 -0600 | [diff] [blame] | 306 | |
| 307 | void board_reset(void) |
| 308 | { |
| 309 | #ifdef CONFIG_SYS_RESET_ADDRESS |
| 310 | ulong addr = CONFIG_SYS_RESET_ADDRESS; |
| 311 | |
| 312 | /* flush and disable I/D cache */ |
| 313 | __asm__ __volatile__ ("mfspr 3, 1008" ::: "r3"); |
| 314 | __asm__ __volatile__ ("ori 5, 5, 0xcc00" ::: "r5"); |
| 315 | __asm__ __volatile__ ("ori 4, 3, 0xc00" ::: "r4"); |
| 316 | __asm__ __volatile__ ("andc 5, 3, 5" ::: "r5"); |
| 317 | __asm__ __volatile__ ("sync"); |
| 318 | __asm__ __volatile__ ("mtspr 1008, 4"); |
| 319 | __asm__ __volatile__ ("isync"); |
| 320 | __asm__ __volatile__ ("sync"); |
| 321 | __asm__ __volatile__ ("mtspr 1008, 5"); |
| 322 | __asm__ __volatile__ ("isync"); |
| 323 | __asm__ __volatile__ ("sync"); |
| 324 | |
| 325 | /* |
| 326 | * SRR0 has system reset vector, SRR1 has default MSR value |
| 327 | * rfi restores MSR from SRR1 and sets the PC to the SRR0 value |
| 328 | */ |
| 329 | __asm__ __volatile__ ("mtspr 26, %0" :: "r" (addr)); |
| 330 | __asm__ __volatile__ ("li 4, (1 << 6)" ::: "r4"); |
| 331 | __asm__ __volatile__ ("mtspr 27, 4"); |
| 332 | __asm__ __volatile__ ("rfi"); |
| 333 | #endif |
| 334 | } |
Becky Bruce | f6ef8b7 | 2009-03-31 18:38:37 -0500 | [diff] [blame] | 335 | |
Kumar Gala | 7649a59 | 2009-03-31 23:02:38 -0500 | [diff] [blame] | 336 | #ifdef CONFIG_MP |
Becky Bruce | f6ef8b7 | 2009-03-31 18:38:37 -0500 | [diff] [blame] | 337 | extern void cpu_mp_lmb_reserve(struct lmb *lmb); |
| 338 | |
| 339 | void board_lmb_reserve(struct lmb *lmb) |
| 340 | { |
| 341 | cpu_mp_lmb_reserve(lmb); |
| 342 | } |
| 343 | #endif |