1
2
3
4
5
6
7
8
9
10#include <common.h>
11#include <command.h>
12#include <netdev.h>
13#include <linux/compiler.h>
14#include <asm/mmu.h>
15#include <asm/processor.h>
16#include <asm/cache.h>
17#include <asm/immap_85xx.h>
18#include <asm/fsl_law.h>
19#include <asm/fsl_serdes.h>
20#include <asm/fsl_portals.h>
21#include <asm/fsl_liodn.h>
22#include <fm_eth.h>
23
24#include "../common/common.h"
25#include "kmp204x.h"
26
27DECLARE_GLOBAL_DATA_PTR;
28
29static uchar ivm_content[CONFIG_SYS_IVM_EEPROM_MAX_LEN];
30
31int checkboard(void)
32{
33 printf("Board: Keymile %s\n", CONFIG_KM_BOARD_NAME);
34
35 return 0;
36}
37
38
39
40
41
42
43
44
45
46
47#define DEBLOCK_PORT1 GPIO_A
48#define DEBLOCK_SCL1 20
49#define DEBLOCK_SDA1 21
50
51
52static void i2c_deblock_gpio_cfg(void)
53{
54
55 qrio_gpio_direction_input(DEBLOCK_PORT1, DEBLOCK_SCL1);
56 qrio_gpio_direction_input(DEBLOCK_PORT1, DEBLOCK_SDA1);
57
58 qrio_set_gpio(DEBLOCK_PORT1, DEBLOCK_SCL1, 0);
59 qrio_set_gpio(DEBLOCK_PORT1, DEBLOCK_SDA1, 0);
60}
61
62void set_sda(int state)
63{
64 qrio_set_opendrain_gpio(DEBLOCK_PORT1, DEBLOCK_SDA1, state);
65}
66
67void set_scl(int state)
68{
69 qrio_set_opendrain_gpio(DEBLOCK_PORT1, DEBLOCK_SCL1, state);
70}
71
72int get_sda(void)
73{
74 return qrio_get_gpio(DEBLOCK_PORT1, DEBLOCK_SDA1);
75}
76
77int get_scl(void)
78{
79 return qrio_get_gpio(DEBLOCK_PORT1, DEBLOCK_SCL1);
80}
81
82
83#define ZL30158_RST 8
84#define BFTIC4_RST 0
85#define RSTRQSR1_WDT_RR 0x00200000
86#define RSTRQSR1_SW_RR 0x00100000
87
88int board_early_init_f(void)
89{
90 ccsr_gur_t *gur = (void *)(CONFIG_SYS_MPC85xx_GUTS_ADDR);
91 bool cpuwd_flag = false;
92
93
94 qrio_uprstreq(UPREQ_CORE_RST);
95
96
97 setbits_be32(&gur->ddrclkdr, 0x001f000f);
98
99
100 if ((gur->rstrqsr1 & (RSTRQSR1_WDT_RR | RSTRQSR1_SW_RR)) ==
101 RSTRQSR1_WDT_RR)
102 cpuwd_flag = true;
103
104 qrio_cpuwd_flag(cpuwd_flag);
105
106 setbits_be32(&gur->rstrqsr1, RSTRQSR1_WDT_RR | RSTRQSR1_SW_RR);
107
108
109 qrio_prstcfg(BFTIC4_RST, PRSTCFG_POWUP_UNIT_RST);
110
111 qrio_wdmask(BFTIC4_RST, true);
112
113
114 qrio_prstcfg(ZL30158_RST, PRSTCFG_POWUP_RST);
115
116 qrio_prst(ZL30158_RST, false, false);
117
118 return 0;
119}
120
121int board_early_init_r(void)
122{
123 int ret = 0;
124
125 flush_dcache();
126 invalidate_icache();
127
128 set_liodns();
129 setup_portals();
130
131 ret = trigger_fpga_config();
132 if (ret)
133 printf("error triggering PCIe FPGA config\n");
134
135
136 qrio_set_leds();
137
138
139 qrio_enable_app_buffer();
140
141 return ret;
142}
143
144unsigned long get_board_sys_clk(unsigned long dummy)
145{
146 return 66666666;
147}
148
149#define ETH_FRONT_PHY_RST 15
150#define QSFP2_RST 11
151#define QSFP1_RST 10
152#define ZL30343_RST 9
153
154int misc_init_f(void)
155{
156
157 i2c_deblock_gpio_cfg();
158
159
160 qrio_prstcfg(ETH_FRONT_PHY_RST, PRSTCFG_POWUP_UNIT_CORE_RST);
161 qrio_prst(ETH_FRONT_PHY_RST, false, false);
162
163
164 qrio_prstcfg(ZL30343_RST, PRSTCFG_POWUP_RST);
165
166 qrio_wdmask(ZL30343_RST, true);
167
168
169 qrio_prstcfg(QSFP1_RST, PRSTCFG_POWUP_UNIT_RST);
170 qrio_prstcfg(QSFP2_RST, PRSTCFG_POWUP_UNIT_RST);
171
172
173 qrio_wdmask(QSFP1_RST, true);
174 qrio_wdmask(QSFP2_RST, true);
175
176 return 0;
177}
178
179#define NUM_SRDS_BANKS 2
180
181int misc_init_r(void)
182{
183 serdes_corenet_t *regs = (void *)CONFIG_SYS_FSL_CORENET_SERDES_ADDR;
184 u32 expected[NUM_SRDS_BANKS] = {SRDS_PLLCR0_RFCK_SEL_100,
185 SRDS_PLLCR0_RFCK_SEL_125};
186 unsigned int i;
187
188
189 for (i = 0; i < NUM_SRDS_BANKS; i++) {
190 u32 actual = in_be32(®s->bank[i].pllcr0);
191 actual &= SRDS_PLLCR0_RFCK_SEL_MASK;
192 if (actual != expected[i]) {
193 printf("Warning: SERDES bank %u expects reference \
194 clock %sMHz, but actual is %sMHz\n", i + 1,
195 serdes_clock_to_string(expected[i]),
196 serdes_clock_to_string(actual));
197 }
198 }
199
200 ivm_read_eeprom(ivm_content, CONFIG_SYS_IVM_EEPROM_MAX_LEN);
201 return 0;
202}
203
204#if defined(CONFIG_HUSH_INIT_VAR)
205int hush_init_var(void)
206{
207 ivm_analyze_eeprom(ivm_content, CONFIG_SYS_IVM_EEPROM_MAX_LEN);
208 return 0;
209}
210#endif
211
212#if defined(CONFIG_LAST_STAGE_INIT)
213
214int last_stage_init(void)
215{
216#if defined(CONFIG_KMCOGE4)
217
218 struct bfticu_iomap *bftic4 =
219 (struct bfticu_iomap *)CONFIG_SYS_LBAPP2_BASE;
220 u8 dip_switch = in_8((u8 *)&(bftic4->mswitch)) & BFTICU_DIPSWITCH_MASK;
221
222 if (dip_switch != 0) {
223
224 puts("DIP: Enabled\n");
225 setenv("actual_bank", "0");
226 }
227#endif
228 set_km_env();
229
230 return 0;
231}
232#endif
233
234#ifdef CONFIG_SYS_DPAA_FMAN
235void fdt_fixup_fman_mac_addresses(void *blob)
236{
237 int node, i, ret;
238 char *tmp, *end;
239 unsigned char mac_addr[6];
240
241
242 tmp = getenv("ethaddr");
243 if (!tmp) {
244 printf("ethaddr env variable not defined\n");
245 return;
246 }
247 for (i = 0; i < 6; i++) {
248 mac_addr[i] = tmp ? simple_strtoul(tmp, &end, 16) : 0;
249 if (tmp)
250 tmp = (*end) ? end+1 : end;
251 }
252
253
254 node = fdt_path_offset(blob, "/soc/fman/ethernet@e8000");
255 if (node < 0) {
256 printf("no /soc/fman/ethernet path offset\n");
257 return;
258 }
259 ret = fdt_setprop(blob, node, "local-mac-address", &mac_addr, 6);
260 if (ret) {
261 printf("error setting local-mac-address property\n");
262 return;
263 }
264}
265#endif
266
267int ft_board_setup(void *blob, bd_t *bd)
268{
269 phys_addr_t base;
270 phys_size_t size;
271
272 ft_cpu_setup(blob, bd);
273
274 base = getenv_bootm_low();
275 size = getenv_bootm_size();
276
277 fdt_fixup_memory(blob, (u64)base, (u64)size);
278
279#if defined(CONFIG_HAS_FSL_DR_USB) || defined(CONFIG_HAS_FSL_MPH_USB)
280 fsl_fdt_fixup_dr_usb(blob, bd);
281#endif
282
283#ifdef CONFIG_PCI
284 pci_of_setup(blob, bd);
285#endif
286
287 fdt_fixup_liodn(blob);
288#ifdef CONFIG_SYS_DPAA_FMAN
289 fdt_fixup_fman_ethernet(blob);
290 fdt_fixup_fman_mac_addresses(blob);
291#endif
292
293 return 0;
294}
295
296#if defined(CONFIG_POST)
297
298
299#define SELFTEST_PORT GPIO_A
300#define SELFTEST_PIN 31
301
302int post_hotkeys_pressed(void)
303{
304 qrio_gpio_direction_input(SELFTEST_PORT, SELFTEST_PIN);
305 return qrio_get_gpio(SELFTEST_PORT, SELFTEST_PIN);
306}
307#endif
308