]> git.sur5r.net Git - u-boot/blob - board/xilinx/zynqmp/zynqmp.c
arm64: zynqmp: Call psu_init from board_early_init_f
[u-boot] / board / xilinx / zynqmp / zynqmp.c
1 /*
2  * (C) Copyright 2014 - 2015 Xilinx, Inc.
3  * Michal Simek <michal.simek@xilinx.com>
4  *
5  * SPDX-License-Identifier:     GPL-2.0+
6  */
7
8 #include <common.h>
9 #include <sata.h>
10 #include <ahci.h>
11 #include <scsi.h>
12 #include <malloc.h>
13 #include <asm/arch/clk.h>
14 #include <asm/arch/hardware.h>
15 #include <asm/arch/sys_proto.h>
16 #include <asm/io.h>
17 #include <usb.h>
18 #include <dwc3-uboot.h>
19 #include <zynqmppl.h>
20 #include <i2c.h>
21 #include <g_dnl.h>
22
23 DECLARE_GLOBAL_DATA_PTR;
24
25 #if defined(CONFIG_FPGA) && defined(CONFIG_FPGA_ZYNQMPPL) && \
26     !defined(CONFIG_SPL_BUILD)
27 static xilinx_desc zynqmppl = XILINX_ZYNQMP_DESC;
28
29 static const struct {
30         uint32_t id;
31         char *name;
32 } zynqmp_devices[] = {
33         {
34                 .id = 0x10,
35                 .name = "3eg",
36         },
37         {
38                 .id = 0x11,
39                 .name = "2eg",
40         },
41         {
42                 .id = 0x20,
43                 .name = "5ev",
44         },
45         {
46                 .id = 0x21,
47                 .name = "4ev",
48         },
49         {
50                 .id = 0x30,
51                 .name = "7ev",
52         },
53         {
54                 .id = 0x38,
55                 .name = "9eg",
56         },
57         {
58                 .id = 0x39,
59                 .name = "6eg",
60         },
61         {
62                 .id = 0x40,
63                 .name = "11eg",
64         },
65         {
66                 .id = 0x50,
67                 .name = "15eg",
68         },
69         {
70                 .id = 0x58,
71                 .name = "19eg",
72         },
73         {
74                 .id = 0x59,
75                 .name = "17eg",
76         },
77 };
78
79 static int chip_id(void)
80 {
81         struct pt_regs regs;
82         regs.regs[0] = ZYNQMP_SIP_SVC_CSU_DMA_CHIPID;
83         regs.regs[1] = 0;
84         regs.regs[2] = 0;
85         regs.regs[3] = 0;
86
87         smc_call(&regs);
88
89         /*
90          * SMC returns:
91          * regs[0][31:0]  = status of the operation
92          * regs[0][63:32] = CSU.IDCODE register
93          * regs[1][31:0]  = CSU.version register
94          */
95         regs.regs[0] = upper_32_bits(regs.regs[0]);
96         regs.regs[0] &= ZYNQMP_CSU_IDCODE_DEVICE_CODE_MASK |
97                         ZYNQMP_CSU_IDCODE_SVD_MASK;
98         regs.regs[0] >>= ZYNQMP_CSU_IDCODE_SVD_SHIFT;
99
100         return regs.regs[0];
101 }
102
103 static char *zynqmp_get_silicon_idcode_name(void)
104 {
105         uint32_t i, id;
106
107         id = chip_id();
108         for (i = 0; i < ARRAY_SIZE(zynqmp_devices); i++) {
109                 if (zynqmp_devices[i].id == id)
110                         return zynqmp_devices[i].name;
111         }
112         return "unknown";
113 }
114 #endif
115
116 int board_early_init_f(void)
117 {
118 #if !defined(CONFIG_SPL_BUILD) && defined(CONFIG_CLK_ZYNQMP)
119         zynqmp_pmufw_version();
120 #endif
121
122 #if defined(CONFIG_SPL_BUILD)
123         psu_init();
124 #endif
125
126         return 0;
127 }
128
129 #define ZYNQMP_VERSION_SIZE     9
130
131 int board_init(void)
132 {
133         printf("EL Level:\tEL%d\n", current_el());
134
135 #if defined(CONFIG_FPGA) && defined(CONFIG_FPGA_ZYNQMPPL) && \
136     !defined(CONFIG_SPL_BUILD) || (defined(CONFIG_SPL_FPGA_SUPPORT) && \
137     defined(CONFIG_SPL_BUILD))
138         if (current_el() != 3) {
139                 static char version[ZYNQMP_VERSION_SIZE];
140
141                 strncat(version, "xczu", ZYNQMP_VERSION_SIZE);
142                 zynqmppl.name = strncat(version,
143                                         zynqmp_get_silicon_idcode_name(),
144                                         ZYNQMP_VERSION_SIZE);
145                 printf("Chip ID:\t%s\n", zynqmppl.name);
146                 fpga_init();
147                 fpga_add(fpga_xilinx, &zynqmppl);
148         }
149 #endif
150
151         return 0;
152 }
153
154 int board_early_init_r(void)
155 {
156         u32 val;
157
158         if (current_el() == 3) {
159                 val = readl(&crlapb_base->timestamp_ref_ctrl);
160                 val |= ZYNQMP_CRL_APB_TIMESTAMP_REF_CTRL_CLKACT;
161                 writel(val, &crlapb_base->timestamp_ref_ctrl);
162
163                 /* Program freq register in System counter */
164                 writel(zynqmp_get_system_timer_freq(),
165                        &iou_scntr_secure->base_frequency_id_register);
166                 /* And enable system counter */
167                 writel(ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_EN,
168                        &iou_scntr_secure->counter_control_register);
169         }
170         /* Program freq register in System counter and enable system counter */
171         writel(gd->cpu_clk, &iou_scntr->base_frequency_id_register);
172         writel(ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_HDBG |
173                ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_EN,
174                &iou_scntr->counter_control_register);
175
176         return 0;
177 }
178
179 int zynq_board_read_rom_ethaddr(unsigned char *ethaddr)
180 {
181 #if defined(CONFIG_ZYNQ_GEM_EEPROM_ADDR) && \
182     defined(CONFIG_ZYNQ_GEM_I2C_MAC_OFFSET) && \
183     defined(CONFIG_ZYNQ_EEPROM_BUS)
184         i2c_set_bus_num(CONFIG_ZYNQ_EEPROM_BUS);
185
186         if (eeprom_read(CONFIG_ZYNQ_GEM_EEPROM_ADDR,
187                         CONFIG_ZYNQ_GEM_I2C_MAC_OFFSET,
188                         ethaddr, 6))
189                 printf("I2C EEPROM MAC address read failed\n");
190 #endif
191
192         return 0;
193 }
194
195 #if !defined(CONFIG_SYS_SDRAM_BASE) && !defined(CONFIG_SYS_SDRAM_SIZE)
196 int dram_init_banksize(void)
197 {
198         fdtdec_setup_memory_banksize();
199
200         return 0;
201 }
202
203 int dram_init(void)
204 {
205         if (fdtdec_setup_memory_size() != 0)
206                 return -EINVAL;
207
208         return 0;
209 }
210 #else
211 int dram_init(void)
212 {
213         gd->ram_size = CONFIG_SYS_SDRAM_SIZE;
214
215         return 0;
216 }
217 #endif
218
219 void reset_cpu(ulong addr)
220 {
221 }
222
223 int board_late_init(void)
224 {
225         u32 reg = 0;
226         u8 bootmode;
227         const char *mode;
228         char *new_targets;
229
230         if (!(gd->flags & GD_FLG_ENV_DEFAULT)) {
231                 debug("Saved variables - Skipping\n");
232                 return 0;
233         }
234
235         reg = readl(&crlapb_base->boot_mode);
236         if (reg >> BOOT_MODE_ALT_SHIFT)
237                 reg >>= BOOT_MODE_ALT_SHIFT;
238
239         bootmode = reg & BOOT_MODES_MASK;
240
241         puts("Bootmode: ");
242         switch (bootmode) {
243         case USB_MODE:
244                 puts("USB_MODE\n");
245                 mode = "usb";
246                 break;
247         case JTAG_MODE:
248                 puts("JTAG_MODE\n");
249                 mode = "pxe dhcp";
250                 break;
251         case QSPI_MODE_24BIT:
252         case QSPI_MODE_32BIT:
253                 mode = "qspi0";
254                 puts("QSPI_MODE\n");
255                 break;
256         case EMMC_MODE:
257                 puts("EMMC_MODE\n");
258                 mode = "mmc0";
259                 break;
260         case SD_MODE:
261                 puts("SD_MODE\n");
262                 mode = "mmc0";
263                 break;
264         case SD1_LSHFT_MODE:
265                 puts("LVL_SHFT_");
266                 /* fall through */
267         case SD_MODE1:
268                 puts("SD_MODE1\n");
269 #if defined(CONFIG_ZYNQ_SDHCI0) && defined(CONFIG_ZYNQ_SDHCI1)
270                 mode = "mmc1";
271 #else
272                 mode = "mmc0";
273 #endif
274                 break;
275         case NAND_MODE:
276                 puts("NAND_MODE\n");
277                 mode = "nand0";
278                 break;
279         default:
280                 mode = "";
281                 printf("Invalid Boot Mode:0x%x\n", bootmode);
282                 break;
283         }
284
285         /*
286          * One terminating char + one byte for space between mode
287          * and default boot_targets
288          */
289         new_targets = calloc(1, strlen(mode) +
290                                 strlen(getenv("boot_targets")) + 2);
291
292         sprintf(new_targets, "%s %s", mode, getenv("boot_targets"));
293         setenv("boot_targets", new_targets);
294
295         return 0;
296 }
297
298 int checkboard(void)
299 {
300         puts("Board: Xilinx ZynqMP\n");
301         return 0;
302 }
303
304 #ifdef CONFIG_USB_DWC3
305 static struct dwc3_device dwc3_device_data0 = {
306         .maximum_speed = USB_SPEED_HIGH,
307         .base = ZYNQMP_USB0_XHCI_BASEADDR,
308         .dr_mode = USB_DR_MODE_PERIPHERAL,
309         .index = 0,
310 };
311
312 static struct dwc3_device dwc3_device_data1 = {
313         .maximum_speed = USB_SPEED_HIGH,
314         .base = ZYNQMP_USB1_XHCI_BASEADDR,
315         .dr_mode = USB_DR_MODE_PERIPHERAL,
316         .index = 1,
317 };
318
319 int usb_gadget_handle_interrupts(int index)
320 {
321         dwc3_uboot_handle_interrupt(index);
322         return 0;
323 }
324
325 int board_usb_init(int index, enum usb_init_type init)
326 {
327         debug("%s: index %x\n", __func__, index);
328
329 #if defined(CONFIG_USB_GADGET_DOWNLOAD)
330         g_dnl_set_serialnumber(CONFIG_SYS_CONFIG_NAME);
331 #endif
332
333         switch (index) {
334         case 0:
335                 return dwc3_uboot_init(&dwc3_device_data0);
336         case 1:
337                 return dwc3_uboot_init(&dwc3_device_data1);
338         };
339
340         return -1;
341 }
342
343 int board_usb_cleanup(int index, enum usb_init_type init)
344 {
345         dwc3_uboot_exit(index);
346         return 0;
347 }
348 #endif