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) || defined(CONFIG_ZYNQMP_PSU_INIT_ENABLED)
 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