| /* | 
|  * Copyright 2007 Wind River Systemes, Inc. <www.windriver.com> | 
|  * Copyright 2007 Embedded Specialties, Inc. | 
|  * Joe Hamman joe.hamman@embeddedspecialties.com | 
|  * | 
|  * Copyright 2004 Freescale Semiconductor. | 
|  * Jeff Brown | 
|  * Srikanth Srinivasan (srikanth.srinivasan@freescale.com) | 
|  * | 
|  * (C) Copyright 2002 Scott McNutt <smcnutt@artesyncp.com> | 
|  * | 
|  * SPDX-License-Identifier:    GPL-2.0+ | 
|  */ | 
|   | 
| #include <common.h> | 
| #include <command.h> | 
| #include <pci.h> | 
| #include <asm/processor.h> | 
| #include <asm/immap_86xx.h> | 
| #include <asm/fsl_pci.h> | 
| #include <fsl_ddr_sdram.h> | 
| #include <asm/fsl_serdes.h> | 
| #include <linux/libfdt.h> | 
| #include <fdt_support.h> | 
|   | 
| DECLARE_GLOBAL_DATA_PTR; | 
|   | 
| long int fixed_sdram (void); | 
|   | 
| int board_early_init_f (void) | 
| { | 
|     return 0; | 
| } | 
|   | 
| int checkboard (void) | 
| { | 
|     puts ("Board: Wind River SBC8641D\n"); | 
|   | 
|     return 0; | 
| } | 
|   | 
| int dram_init(void) | 
| { | 
|     long dram_size = 0; | 
|   | 
| #if defined(CONFIG_SPD_EEPROM) | 
|     dram_size = fsl_ddr_sdram(); | 
| #else | 
|     dram_size = fixed_sdram (); | 
| #endif | 
|   | 
|     debug ("    DDR: "); | 
|     gd->ram_size = dram_size; | 
|   | 
|     return 0; | 
| } | 
|   | 
| #if defined(CONFIG_SYS_DRAM_TEST) | 
| int testdram (void) | 
| { | 
|     uint *pstart = (uint *) CONFIG_SYS_MEMTEST_START; | 
|     uint *pend = (uint *) CONFIG_SYS_MEMTEST_END; | 
|     uint *p; | 
|   | 
|     puts ("SDRAM test phase 1:\n"); | 
|     for (p = pstart; p < pend; p++) | 
|         *p = 0xaaaaaaaa; | 
|   | 
|     for (p = pstart; p < pend; p++) { | 
|         if (*p != 0xaaaaaaaa) { | 
|             printf ("SDRAM test fails at: %08x\n", (uint) p); | 
|             return 1; | 
|         } | 
|     } | 
|   | 
|     puts ("SDRAM test phase 2:\n"); | 
|     for (p = pstart; p < pend; p++) | 
|         *p = 0x55555555; | 
|   | 
|     for (p = pstart; p < pend; p++) { | 
|         if (*p != 0x55555555) { | 
|             printf ("SDRAM test fails at: %08x\n", (uint) p); | 
|             return 1; | 
|         } | 
|     } | 
|   | 
|     puts ("SDRAM test passed.\n"); | 
|     return 0; | 
| } | 
| #endif | 
|   | 
| #if !defined(CONFIG_SPD_EEPROM) | 
| /* | 
|  * Fixed sdram init -- doesn't use serial presence detect. | 
|  */ | 
| long int fixed_sdram (void) | 
| { | 
| #if !defined(CONFIG_SYS_RAMBOOT) | 
|     volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR; | 
|     volatile struct ccsr_ddr *ddr = &immap->im_ddr1; | 
|   | 
|     ddr->cs0_bnds = CONFIG_SYS_DDR_CS0_BNDS; | 
|     ddr->cs1_bnds = CONFIG_SYS_DDR_CS1_BNDS; | 
|     ddr->cs2_bnds = CONFIG_SYS_DDR_CS2_BNDS; | 
|     ddr->cs3_bnds = CONFIG_SYS_DDR_CS3_BNDS; | 
|     ddr->cs0_config = CONFIG_SYS_DDR_CS0_CONFIG; | 
|     ddr->cs1_config = CONFIG_SYS_DDR_CS1_CONFIG; | 
|     ddr->cs2_config = CONFIG_SYS_DDR_CS2_CONFIG; | 
|     ddr->cs3_config = CONFIG_SYS_DDR_CS3_CONFIG; | 
|     ddr->timing_cfg_3 = CONFIG_SYS_DDR_TIMING_3; | 
|     ddr->timing_cfg_0 = CONFIG_SYS_DDR_TIMING_0; | 
|     ddr->timing_cfg_1 = CONFIG_SYS_DDR_TIMING_1; | 
|     ddr->timing_cfg_2 = CONFIG_SYS_DDR_TIMING_2; | 
|     ddr->sdram_cfg = CONFIG_SYS_DDR_CFG_1A; | 
|     ddr->sdram_cfg_2 = CONFIG_SYS_DDR_CFG_2; | 
|     ddr->sdram_mode = CONFIG_SYS_DDR_MODE_1; | 
|     ddr->sdram_mode_2 = CONFIG_SYS_DDR_MODE_2; | 
|     ddr->sdram_md_cntl = CONFIG_SYS_DDR_MODE_CTL; | 
|     ddr->sdram_interval = CONFIG_SYS_DDR_INTERVAL; | 
|     ddr->sdram_data_init = CONFIG_SYS_DDR_DATA_INIT; | 
|     ddr->sdram_clk_cntl = CONFIG_SYS_DDR_CLK_CTRL; | 
|   | 
|     asm ("sync;isync"); | 
|   | 
|     udelay (500); | 
|   | 
|     ddr->sdram_cfg = CONFIG_SYS_DDR_CFG_1B; | 
|     asm ("sync; isync"); | 
|   | 
|     udelay (500); | 
|     ddr = &immap->im_ddr2; | 
|   | 
|     ddr->cs0_bnds = CONFIG_SYS_DDR2_CS0_BNDS; | 
|     ddr->cs1_bnds = CONFIG_SYS_DDR2_CS1_BNDS; | 
|     ddr->cs2_bnds = CONFIG_SYS_DDR2_CS2_BNDS; | 
|     ddr->cs3_bnds = CONFIG_SYS_DDR2_CS3_BNDS; | 
|     ddr->cs0_config = CONFIG_SYS_DDR2_CS0_CONFIG; | 
|     ddr->cs1_config = CONFIG_SYS_DDR2_CS1_CONFIG; | 
|     ddr->cs2_config = CONFIG_SYS_DDR2_CS2_CONFIG; | 
|     ddr->cs3_config = CONFIG_SYS_DDR2_CS3_CONFIG; | 
|     ddr->timing_cfg_3 = CONFIG_SYS_DDR2_EXT_REFRESH; | 
|     ddr->timing_cfg_0 = CONFIG_SYS_DDR2_TIMING_0; | 
|     ddr->timing_cfg_1 = CONFIG_SYS_DDR2_TIMING_1; | 
|     ddr->timing_cfg_2 = CONFIG_SYS_DDR2_TIMING_2; | 
|     ddr->sdram_cfg = CONFIG_SYS_DDR2_CFG_1A; | 
|     ddr->sdram_cfg_2 = CONFIG_SYS_DDR2_CFG_2; | 
|     ddr->sdram_mode = CONFIG_SYS_DDR2_MODE_1; | 
|     ddr->sdram_mode_2 = CONFIG_SYS_DDR2_MODE_2; | 
|     ddr->sdram_md_cntl = CONFIG_SYS_DDR2_MODE_CTL; | 
|     ddr->sdram_interval = CONFIG_SYS_DDR2_INTERVAL; | 
|     ddr->sdram_data_init = CONFIG_SYS_DDR2_DATA_INIT; | 
|     ddr->sdram_clk_cntl = CONFIG_SYS_DDR2_CLK_CTRL; | 
|   | 
|     asm ("sync;isync"); | 
|   | 
|     udelay (500); | 
|   | 
|     ddr->sdram_cfg = CONFIG_SYS_DDR2_CFG_1B; | 
|     asm ("sync; isync"); | 
|   | 
|     udelay (500); | 
| #endif | 
|     return CONFIG_SYS_SDRAM_SIZE * 1024 * 1024; | 
| } | 
| #endif                /* !defined(CONFIG_SPD_EEPROM) */ | 
|   | 
| #if defined(CONFIG_PCI) | 
| /* | 
|  * Initialize PCI Devices, report devices found. | 
|  */ | 
|   | 
| void pci_init_board(void) | 
| { | 
|     fsl_pcie_init_board(0); | 
| } | 
| #endif /* CONFIG_PCI */ | 
|   | 
|   | 
| #if defined(CONFIG_OF_BOARD_SETUP) | 
| int ft_board_setup(void *blob, bd_t *bd) | 
| { | 
|     ft_cpu_setup(blob, bd); | 
|   | 
|     FT_FSL_PCI_SETUP; | 
|   | 
|     return 0; | 
| } | 
| #endif | 
|   | 
| void sbc8641d_reset_board (void) | 
| { | 
|     puts ("Resetting board....\n"); | 
| } | 
|   | 
| /* | 
|  * get_board_sys_clk | 
|  *      Clock is fixed at 1GHz on this board. Used for CONFIG_SYS_CLK_FREQ | 
|  */ | 
|   | 
| unsigned long get_board_sys_clk (ulong dummy) | 
| { | 
|     int i; | 
|     ulong val = 0; | 
|   | 
|     i = 5; | 
|     i &= 0x07; | 
|   | 
|     switch (i) { | 
|     case 0: | 
|         val = 33000000; | 
|         break; | 
|     case 1: | 
|         val = 40000000; | 
|         break; | 
|     case 2: | 
|         val = 50000000; | 
|         break; | 
|     case 3: | 
|         val = 66000000; | 
|         break; | 
|     case 4: | 
|         val = 83000000; | 
|         break; | 
|     case 5: | 
|         val = 100000000; | 
|         break; | 
|     case 6: | 
|         val = 134000000; | 
|         break; | 
|     case 7: | 
|         val = 166000000; | 
|         break; | 
|     } | 
|   | 
|     return val; | 
| } | 
|   | 
| void board_reset(void) | 
| { | 
| #ifdef CONFIG_SYS_RESET_ADDRESS | 
|     ulong addr = CONFIG_SYS_RESET_ADDRESS; | 
|   | 
|     /* flush and disable I/D cache */ | 
|     __asm__ __volatile__ ("mfspr    3, 1008"    ::: "r3"); | 
|     __asm__ __volatile__ ("ori    5, 5, 0xcc00"    ::: "r5"); | 
|     __asm__ __volatile__ ("ori    4, 3, 0xc00"    ::: "r4"); | 
|     __asm__ __volatile__ ("andc    5, 3, 5"    ::: "r5"); | 
|     __asm__ __volatile__ ("sync"); | 
|     __asm__ __volatile__ ("mtspr    1008, 4"); | 
|     __asm__ __volatile__ ("isync"); | 
|     __asm__ __volatile__ ("sync"); | 
|     __asm__ __volatile__ ("mtspr    1008, 5"); | 
|     __asm__ __volatile__ ("isync"); | 
|     __asm__ __volatile__ ("sync"); | 
|   | 
|     /* | 
|      * SRR0 has system reset vector, SRR1 has default MSR value | 
|      * rfi restores MSR from SRR1 and sets the PC to the SRR0 value | 
|      */ | 
|     __asm__ __volatile__ ("mtspr    26, %0"        :: "r" (addr)); | 
|     __asm__ __volatile__ ("li    4, (1 << 6)"    ::: "r4"); | 
|     __asm__ __volatile__ ("mtspr    27, 4"); | 
|     __asm__ __volatile__ ("rfi"); | 
| #endif | 
| } |