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 int timer_init(void)
  61 {
  62         return 0;
  63 }
  64
  65 void reset_cpu(ulong addr)
  66 {
  67 }
  68
  69 #ifdef CONFIG_SCSI_AHCI_PLAT
  70 void scsi_init(void)
  71 {
  72         ahci_init((void __iomem *)ZYNQMP_SATA_BASEADDR);
  73         scsi_scan(1);
  74 }
  75 #endif
  76
  77 int board_late_init(void)
  78 {
  79         u32 reg = 0;
  80         u8 bootmode;
  81
  82         reg = readl(&crlapb_base->boot_mode);
  83         bootmode = reg & BOOT_MODES_MASK;
  84
  85         puts("Bootmode: ");
  86         switch (bootmode) {
  87         case JTAG_MODE:
  88                 puts("JTAG_MODE\n");
  89                 setenv("modeboot", "jtagboot");
  90                 break;
  91         case QSPI_MODE_24BIT:
  92         case QSPI_MODE_32BIT:
  93                 setenv("modeboot", "qspiboot");
  94                 puts("QSPI_MODE\n");
  95                 break;
  96         case EMMC_MODE:
  97                 puts("EMMC_MODE\n");
  98                 setenv("modeboot", "sdboot");
  99                 break;
 100         case SD_MODE:
 101                 puts("SD_MODE\n");
 102                 setenv("modeboot", "sdboot");
 103                 break;
 104         case SD_MODE1:
 105                 puts("SD_MODE1\n");
 106 #if defined(CONFIG_ZYNQ_SDHCI0) && defined(CONFIG_ZYNQ_SDHCI1)
 107                 setenv("sdbootdev", "1");
 108 #endif
 109                 setenv("modeboot", "sdboot");
 110                 break;
 111         case NAND_MODE:
 112                 puts("NAND_MODE\n");
 113                 setenv("modeboot", "nandboot");
 114                 break;
 115         default:
 116                 printf("Invalid Boot Mode:0x%x\n", bootmode);
 117                 break;
 118         }
 119
 120         return 0;
 121 }
 122
 123 int checkboard(void)
 124 {
 125         puts("Board:\tXilinx ZynqMP\n");
 126         return 0;
 127 }
 128
 129 #ifdef CONFIG_USB_DWC3
 130 static struct dwc3_device dwc3_device_data = {
 131         .maximum_speed = USB_SPEED_HIGH,
 132         .base = ZYNQMP_USB0_XHCI_BASEADDR,
 133         .dr_mode = USB_DR_MODE_PERIPHERAL,
 134         .index = 0,
 135 };
 136
 137 int usb_gadget_handle_interrupts(void)
 138 {
 139         dwc3_uboot_handle_interrupt(0);
 140         return 0;
 141 }
 142
 143 int board_usb_init(int index, enum usb_init_type init)
 144 {
 145         return dwc3_uboot_init(&dwc3_device_data);
 146 }
 147
 148 int board_usb_cleanup(int index, enum usb_init_type init)
 149 {
 150         dwc3_uboot_exit(index);
 151         return 0;
 152 }
 153 #endif