1
2
3
4
5
6
7
8
9
10
11
12
13
14
15#include <common.h>
16#include <command.h>
17#include <pci.h>
18#include <asm/processor.h>
19#include <asm/immap_86xx.h>
20#include <asm/fsl_pci.h>
21#include <fsl_ddr_sdram.h>
22#include <asm/fsl_serdes.h>
23#include <libfdt.h>
24#include <fdt_support.h>
25
26DECLARE_GLOBAL_DATA_PTR;
27
28long int fixed_sdram (void);
29
30int board_early_init_f (void)
31{
32 return 0;
33}
34
35int checkboard (void)
36{
37 puts ("Board: Wind River SBC8641D\n");
38
39 return 0;
40}
41
42int dram_init(void)
43{
44 long dram_size = 0;
45
46#if defined(CONFIG_SPD_EEPROM)
47 dram_size = fsl_ddr_sdram();
48#else
49 dram_size = fixed_sdram ();
50#endif
51
52 debug (" DDR: ");
53 gd->ram_size = dram_size;
54
55 return 0;
56}
57
58#if defined(CONFIG_SYS_DRAM_TEST)
59int testdram (void)
60{
61 uint *pstart = (uint *) CONFIG_SYS_MEMTEST_START;
62 uint *pend = (uint *) CONFIG_SYS_MEMTEST_END;
63 uint *p;
64
65 puts ("SDRAM test phase 1:\n");
66 for (p = pstart; p < pend; p++)
67 *p = 0xaaaaaaaa;
68
69 for (p = pstart; p < pend; p++) {
70 if (*p != 0xaaaaaaaa) {
71 printf ("SDRAM test fails at: %08x\n", (uint) p);
72 return 1;
73 }
74 }
75
76 puts ("SDRAM test phase 2:\n");
77 for (p = pstart; p < pend; p++)
78 *p = 0x55555555;
79
80 for (p = pstart; p < pend; p++) {
81 if (*p != 0x55555555) {
82 printf ("SDRAM test fails at: %08x\n", (uint) p);
83 return 1;
84 }
85 }
86
87 puts ("SDRAM test passed.\n");
88 return 0;
89}
90#endif
91
92#if !defined(CONFIG_SPD_EEPROM)
93
94
95
96long int fixed_sdram (void)
97{
98#if !defined(CONFIG_SYS_RAMBOOT)
99 volatile immap_t *immap = (immap_t *) CONFIG_SYS_IMMR;
100 volatile struct ccsr_ddr *ddr = &immap->im_ddr1;
101
102 ddr->cs0_bnds = CONFIG_SYS_DDR_CS0_BNDS;
103 ddr->cs1_bnds = CONFIG_SYS_DDR_CS1_BNDS;
104 ddr->cs2_bnds = CONFIG_SYS_DDR_CS2_BNDS;
105 ddr->cs3_bnds = CONFIG_SYS_DDR_CS3_BNDS;
106 ddr->cs0_config = CONFIG_SYS_DDR_CS0_CONFIG;
107 ddr->cs1_config = CONFIG_SYS_DDR_CS1_CONFIG;
108 ddr->cs2_config = CONFIG_SYS_DDR_CS2_CONFIG;
109 ddr->cs3_config = CONFIG_SYS_DDR_CS3_CONFIG;
110 ddr->timing_cfg_3 = CONFIG_SYS_DDR_TIMING_3;
111 ddr->timing_cfg_0 = CONFIG_SYS_DDR_TIMING_0;
112 ddr->timing_cfg_1 = CONFIG_SYS_DDR_TIMING_1;
113 ddr->timing_cfg_2 = CONFIG_SYS_DDR_TIMING_2;
114 ddr->sdram_cfg = CONFIG_SYS_DDR_CFG_1A;
115 ddr->sdram_cfg_2 = CONFIG_SYS_DDR_CFG_2;
116 ddr->sdram_mode = CONFIG_SYS_DDR_MODE_1;
117 ddr->sdram_mode_2 = CONFIG_SYS_DDR_MODE_2;
118 ddr->sdram_md_cntl = CONFIG_SYS_DDR_MODE_CTL;
119 ddr->sdram_interval = CONFIG_SYS_DDR_INTERVAL;
120 ddr->sdram_data_init = CONFIG_SYS_DDR_DATA_INIT;
121 ddr->sdram_clk_cntl = CONFIG_SYS_DDR_CLK_CTRL;
122
123 asm ("sync;isync");
124
125 udelay (500);
126
127 ddr->sdram_cfg = CONFIG_SYS_DDR_CFG_1B;
128 asm ("sync; isync");
129
130 udelay (500);
131 ddr = &immap->im_ddr2;
132
133 ddr->cs0_bnds = CONFIG_SYS_DDR2_CS0_BNDS;
134 ddr->cs1_bnds = CONFIG_SYS_DDR2_CS1_BNDS;
135 ddr->cs2_bnds = CONFIG_SYS_DDR2_CS2_BNDS;
136 ddr->cs3_bnds = CONFIG_SYS_DDR2_CS3_BNDS;
137 ddr->cs0_config = CONFIG_SYS_DDR2_CS0_CONFIG;
138 ddr->cs1_config = CONFIG_SYS_DDR2_CS1_CONFIG;
139 ddr->cs2_config = CONFIG_SYS_DDR2_CS2_CONFIG;
140 ddr->cs3_config = CONFIG_SYS_DDR2_CS3_CONFIG;
141 ddr->timing_cfg_3 = CONFIG_SYS_DDR2_EXT_REFRESH;
142 ddr->timing_cfg_0 = CONFIG_SYS_DDR2_TIMING_0;
143 ddr->timing_cfg_1 = CONFIG_SYS_DDR2_TIMING_1;
144 ddr->timing_cfg_2 = CONFIG_SYS_DDR2_TIMING_2;
145 ddr->sdram_cfg = CONFIG_SYS_DDR2_CFG_1A;
146 ddr->sdram_cfg_2 = CONFIG_SYS_DDR2_CFG_2;
147 ddr->sdram_mode = CONFIG_SYS_DDR2_MODE_1;
148 ddr->sdram_mode_2 = CONFIG_SYS_DDR2_MODE_2;
149 ddr->sdram_md_cntl = CONFIG_SYS_DDR2_MODE_CTL;
150 ddr->sdram_interval = CONFIG_SYS_DDR2_INTERVAL;
151 ddr->sdram_data_init = CONFIG_SYS_DDR2_DATA_INIT;
152 ddr->sdram_clk_cntl = CONFIG_SYS_DDR2_CLK_CTRL;
153
154 asm ("sync;isync");
155
156 udelay (500);
157
158 ddr->sdram_cfg = CONFIG_SYS_DDR2_CFG_1B;
159 asm ("sync; isync");
160
161 udelay (500);
162#endif
163 return CONFIG_SYS_SDRAM_SIZE * 1024 * 1024;
164}
165#endif
166
167#if defined(CONFIG_PCI)
168
169
170
171
172void pci_init_board(void)
173{
174 fsl_pcie_init_board(0);
175}
176#endif
177
178
179#if defined(CONFIG_OF_BOARD_SETUP)
180int ft_board_setup(void *blob, bd_t *bd)
181{
182 ft_cpu_setup(blob, bd);
183
184 FT_FSL_PCI_SETUP;
185
186 return 0;
187}
188#endif
189
190void sbc8641d_reset_board (void)
191{
192 puts ("Resetting board....\n");
193}
194
195
196
197
198
199
200unsigned long get_board_sys_clk (ulong dummy)
201{
202 int i;
203 ulong val = 0;
204
205 i = 5;
206 i &= 0x07;
207
208 switch (i) {
209 case 0:
210 val = 33000000;
211 break;
212 case 1:
213 val = 40000000;
214 break;
215 case 2:
216 val = 50000000;
217 break;
218 case 3:
219 val = 66000000;
220 break;
221 case 4:
222 val = 83000000;
223 break;
224 case 5:
225 val = 100000000;
226 break;
227 case 6:
228 val = 134000000;
229 break;
230 case 7:
231 val = 166000000;
232 break;
233 }
234
235 return val;
236}
237
238void board_reset(void)
239{
240#ifdef CONFIG_SYS_RESET_ADDRESS
241 ulong addr = CONFIG_SYS_RESET_ADDRESS;
242
243
244 __asm__ __volatile__ ("mfspr 3, 1008" ::: "r3");
245 __asm__ __volatile__ ("ori 5, 5, 0xcc00" ::: "r5");
246 __asm__ __volatile__ ("ori 4, 3, 0xc00" ::: "r4");
247 __asm__ __volatile__ ("andc 5, 3, 5" ::: "r5");
248 __asm__ __volatile__ ("sync");
249 __asm__ __volatile__ ("mtspr 1008, 4");
250 __asm__ __volatile__ ("isync");
251 __asm__ __volatile__ ("sync");
252 __asm__ __volatile__ ("mtspr 1008, 5");
253 __asm__ __volatile__ ("isync");
254 __asm__ __volatile__ ("sync");
255
256
257
258
259
260 __asm__ __volatile__ ("mtspr 26, %0" :: "r" (addr));
261 __asm__ __volatile__ ("li 4, (1 << 6)" ::: "r4");
262 __asm__ __volatile__ ("mtspr 27, 4");
263 __asm__ __volatile__ ("rfi");
264#endif
265}
266