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 <netdev.h>
  10 #include <ahci.h>
  11 #include <scsi.h>
  12 #include <asm/arch/clk.h>
  13 #include <asm/arch/hardware.h>
  14 #include <asm/arch/sys_proto.h>
  15 #include <asm/io.h>
  16 #include <usb.h>
  17 #include <dwc3-uboot.h>
  18
  19 DECLARE_GLOBAL_DATA_PTR;
  20
  21 int board_init(void)
  22 {
  23         printf("EL Level:\tEL%d\n", current_el());
  24
  25         return 0;
  26 }
  27
  28 int board_early_init_r(void)
  29 {
  30         u32 val;
  31
  32         if (current_el() == 3) {
  33                 val = readl(&crlapb_base->timestamp_ref_ctrl);
  34                 val |= ZYNQMP_CRL_APB_TIMESTAMP_REF_CTRL_CLKACT;
  35                 writel(val, &crlapb_base->timestamp_ref_ctrl);
  36
  37                 /* Program freq register in System counter */
  38                 writel(zynqmp_get_system_timer_freq(),
  39                        &iou_scntr_secure->base_frequency_id_register);
  40                 /* And enable system counter */
  41                 writel(ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_EN,
  42                        &iou_scntr_secure->counter_control_register);
  43         }
  44         /* Program freq register in System counter and enable system counter */
  45         writel(gd->cpu_clk, &iou_scntr->base_frequency_id_register);
  46         writel(ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_HDBG |
  47                ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_EN,
  48                &iou_scntr->counter_control_register);
  49
  50         return 0;
  51 }
  52
  53 int dram_init(void)
  54 {
  55         gd->ram_size = CONFIG_SYS_SDRAM_SIZE;
  56
  57         return 0;
  58 }
  59
  60 void reset_cpu(ulong addr)
  61 {
  62 }
  63
  64 #ifdef CONFIG_SCSI_AHCI_PLAT
  65 void scsi_init(void)
  66 {
  67         ahci_init((void __iomem *)ZYNQMP_SATA_BASEADDR);
  68         scsi_scan(1);
  69 }
  70 #endif
  71
  72 int board_late_init(void)
  73 {
  74         u32 reg = 0;
  75         u8 bootmode;
  76
  77         reg = readl(&crlapb_base->boot_mode);
  78         bootmode = reg & BOOT_MODES_MASK;
  79
  80         puts("Bootmode: ");
  81         switch (bootmode) {
  82         case JTAG_MODE:
  83                 puts("JTAG_MODE\n");
  84                 setenv("modeboot", "jtagboot");
  85                 break;
  86         case QSPI_MODE_24BIT:
  87         case QSPI_MODE_32BIT:
  88                 setenv("modeboot", "qspiboot");
  89                 puts("QSPI_MODE\n");
  90                 break;
  91         case EMMC_MODE:
  92                 puts("EMMC_MODE\n");
  93                 setenv("modeboot", "sdboot");
  94                 break;
  95         case SD_MODE:
  96                 puts("SD_MODE\n");
  97                 setenv("modeboot", "sdboot");
  98                 break;
  99         case SD_MODE1:
 100                 puts("SD_MODE1\n");
 101 #if defined(CONFIG_ZYNQ_SDHCI0) && defined(CONFIG_ZYNQ_SDHCI1)
 102                 setenv("sdbootdev", "1");
 103 #endif
 104                 setenv("modeboot", "sdboot");
 105                 break;
 106         case NAND_MODE:
 107                 puts("NAND_MODE\n");
 108                 setenv("modeboot", "nandboot");
 109                 break;
 110         default:
 111                 printf("Invalid Boot Mode:0x%x\n", bootmode);
 112                 break;
 113         }
 114
 115         return 0;
 116 }
 117
 118 int checkboard(void)
 119 {
 120         puts("Board: Xilinx ZynqMP\n");
 121         return 0;
 122 }
 123
 124 #ifdef CONFIG_USB_DWC3
 125 static struct dwc3_device dwc3_device_data = {
 126         .maximum_speed = USB_SPEED_HIGH,
 127         .base = ZYNQMP_USB0_XHCI_BASEADDR,
 128         .dr_mode = USB_DR_MODE_PERIPHERAL,
 129         .index = 0,
 130 };
 131
 132 int usb_gadget_handle_interrupts(void)
 133 {
 134         dwc3_uboot_handle_interrupt(0);
 135         return 0;
 136 }
 137
 138 int board_usb_init(int index, enum usb_init_type init)
 139 {
 140         return dwc3_uboot_init(&dwc3_device_data);
 141 }
 142
 143 int board_usb_cleanup(int index, enum usb_init_type init)
 144 {
 145         dwc3_uboot_exit(index);
 146         return 0;
 147 }
 148 #endif