[people/ms/u-boot.git] / board / xilinx / zynqmp / zynqmp.c

/*
 * (C) Copyright 2014 - 2015 Xilinx, Inc.
 * Michal Simek <michal.simek@xilinx.com>
 *
 * SPDX-License-Identifier:	GPL-2.0+
 */

#include <common.h>
#include <sata.h>
#include <ahci.h>
#include <scsi.h>
#include <malloc.h>
#include <asm/arch/clk.h>
#include <asm/arch/hardware.h>
#include <asm/arch/sys_proto.h>
#include <asm/io.h>
#include <usb.h>
#include <dwc3-uboot.h>
#include <zynqmppl.h>
#include <i2c.h>
#include <g_dnl.h>

DECLARE_GLOBAL_DATA_PTR;

#if defined(CONFIG_FPGA) && defined(CONFIG_FPGA_ZYNQMPPL) && \
    !defined(CONFIG_SPL_BUILD)
static xilinx_desc zynqmppl = XILINX_ZYNQMP_DESC;

static const struct {
	uint32_t id;
	char *name;
} zynqmp_devices[] = {
	{
		.id = 0x10,
		.name = "3eg",
	},
	{
		.id = 0x11,
		.name = "2eg",
	},
	{
		.id = 0x20,
		.name = "5ev",
	},
	{
		.id = 0x21,
		.name = "4ev",
	},
	{
		.id = 0x30,
		.name = "7ev",
	},
	{
		.id = 0x38,
		.name = "9eg",
	},
	{
		.id = 0x39,
		.name = "6eg",
	},
	{
		.id = 0x40,
		.name = "11eg",
	},
	{
		.id = 0x50,
		.name = "15eg",
	},
	{
		.id = 0x58,
		.name = "19eg",
	},
	{
		.id = 0x59,
		.name = "17eg",
	},
};

static int chip_id(void)
{
	struct pt_regs regs;
	regs.regs[0] = ZYNQMP_SIP_SVC_CSU_DMA_CHIPID;
	regs.regs[1] = 0;
	regs.regs[2] = 0;
	regs.regs[3] = 0;

	smc_call(&regs);

	/*
	 * SMC returns:
	 * regs[0][31:0]  = status of the operation
	 * regs[0][63:32] = CSU.IDCODE register
	 * regs[1][31:0]  = CSU.version register
	 */
	regs.regs[0] = upper_32_bits(regs.regs[0]);
	regs.regs[0] &= ZYNQMP_CSU_IDCODE_DEVICE_CODE_MASK |
			ZYNQMP_CSU_IDCODE_SVD_MASK;
	regs.regs[0] >>= ZYNQMP_CSU_IDCODE_SVD_SHIFT;

	return regs.regs[0];
}

static char *zynqmp_get_silicon_idcode_name(void)
{
	uint32_t i, id;

	id = chip_id();
	for (i = 0; i < ARRAY_SIZE(zynqmp_devices); i++) {
		if (zynqmp_devices[i].id == id)
			return zynqmp_devices[i].name;
	}
	return "unknown";
}
#endif

#define ZYNQMP_VERSION_SIZE	9

int board_init(void)
{
	printf("EL Level:\tEL%d\n", current_el());

#if defined(CONFIG_FPGA) && defined(CONFIG_FPGA_ZYNQMPPL) && \
    !defined(CONFIG_SPL_BUILD) || (defined(CONFIG_SPL_FPGA_SUPPORT) && \
    defined(CONFIG_SPL_BUILD))
	if (current_el() != 3) {
		static char version[ZYNQMP_VERSION_SIZE];

		strncat(version, "xczu", ZYNQMP_VERSION_SIZE);
		zynqmppl.name = strncat(version,
					zynqmp_get_silicon_idcode_name(),
					ZYNQMP_VERSION_SIZE);
		printf("Chip ID:\t%s\n", zynqmppl.name);
		fpga_init();
		fpga_add(fpga_xilinx, &zynqmppl);
	}
#endif

	return 0;
}

int board_early_init_r(void)
{
	u32 val;

	if (current_el() == 3) {
		val = readl(&crlapb_base->timestamp_ref_ctrl);
		val |= ZYNQMP_CRL_APB_TIMESTAMP_REF_CTRL_CLKACT;
		writel(val, &crlapb_base->timestamp_ref_ctrl);

		/* Program freq register in System counter */
		writel(zynqmp_get_system_timer_freq(),
		       &iou_scntr_secure->base_frequency_id_register);
		/* And enable system counter */
		writel(ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_EN,
		       &iou_scntr_secure->counter_control_register);
	}
	/* Program freq register in System counter and enable system counter */
	writel(gd->cpu_clk, &iou_scntr->base_frequency_id_register);
	writel(ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_HDBG |
	       ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_EN,
	       &iou_scntr->counter_control_register);

	return 0;
}

int zynq_board_read_rom_ethaddr(unsigned char *ethaddr)
{
#if defined(CONFIG_ZYNQ_GEM_EEPROM_ADDR) && \
    defined(CONFIG_ZYNQ_GEM_I2C_MAC_OFFSET) && \
    defined(CONFIG_ZYNQ_EEPROM_BUS)
	i2c_set_bus_num(CONFIG_ZYNQ_EEPROM_BUS);

	if (eeprom_read(CONFIG_ZYNQ_GEM_EEPROM_ADDR,
			CONFIG_ZYNQ_GEM_I2C_MAC_OFFSET,
			ethaddr, 6))
		printf("I2C EEPROM MAC address read failed\n");
#endif

	return 0;
}

#if !defined(CONFIG_SYS_SDRAM_BASE) && !defined(CONFIG_SYS_SDRAM_SIZE)
int dram_init_banksize(void)
{
	fdtdec_setup_memory_banksize();

	return 0;
}

int dram_init(void)
{
	if (fdtdec_setup_memory_size() != 0)
		return -EINVAL;

	return 0;
}
#else
int dram_init(void)
{
	gd->ram_size = CONFIG_SYS_SDRAM_SIZE;

	return 0;
}
#endif

void reset_cpu(ulong addr)
{
}

int board_late_init(void)
{
	u32 reg = 0;
	u8 bootmode;
	const char *mode;
	char *new_targets;

	if (!(gd->flags & GD_FLG_ENV_DEFAULT)) {
		debug("Saved variables - Skipping\n");
		return 0;
	}

	reg = readl(&crlapb_base->boot_mode);
	if (reg >> BOOT_MODE_ALT_SHIFT)
		reg >>= BOOT_MODE_ALT_SHIFT;

	bootmode = reg & BOOT_MODES_MASK;

	puts("Bootmode: ");
	switch (bootmode) {
	case USB_MODE:
		puts("USB_MODE\n");
		mode = "usb";
		break;
	case JTAG_MODE:
		puts("JTAG_MODE\n");
		mode = "pxe dhcp";
		break;
	case QSPI_MODE_24BIT:
	case QSPI_MODE_32BIT:
		mode = "qspi0";
		puts("QSPI_MODE\n");
		break;
	case EMMC_MODE:
		puts("EMMC_MODE\n");
		mode = "mmc0";
		break;
	case SD_MODE:
		puts("SD_MODE\n");
		mode = "mmc0";
		break;
	case SD1_LSHFT_MODE:
		puts("LVL_SHFT_");
		/* fall through */
	case SD_MODE1:
		puts("SD_MODE1\n");
#if defined(CONFIG_ZYNQ_SDHCI0) && defined(CONFIG_ZYNQ_SDHCI1)
		mode = "mmc1";
#else
		mode = "mmc0";
#endif
		break;
	case NAND_MODE:
		puts("NAND_MODE\n");
		mode = "nand0";
		break;
	default:
		mode = "";
		printf("Invalid Boot Mode:0x%x\n", bootmode);
		break;
	}

	/*
	 * One terminating char + one byte for space between mode
	 * and default boot_targets
	 */
	new_targets = calloc(1, strlen(mode) +
				strlen(getenv("boot_targets")) + 2);

	sprintf(new_targets, "%s %s", mode, getenv("boot_targets"));
	setenv("boot_targets", new_targets);

	return 0;
}

int checkboard(void)
{
	puts("Board: Xilinx ZynqMP\n");
	return 0;
}

#ifdef CONFIG_USB_DWC3
static struct dwc3_device dwc3_device_data0 = {
	.maximum_speed = USB_SPEED_HIGH,
	.base = ZYNQMP_USB0_XHCI_BASEADDR,
	.dr_mode = USB_DR_MODE_PERIPHERAL,
	.index = 0,
};

static struct dwc3_device dwc3_device_data1 = {
	.maximum_speed = USB_SPEED_HIGH,
	.base = ZYNQMP_USB1_XHCI_BASEADDR,
	.dr_mode = USB_DR_MODE_PERIPHERAL,
	.index = 1,
};

int usb_gadget_handle_interrupts(int index)
{
	dwc3_uboot_handle_interrupt(index);
	return 0;
}

int board_usb_init(int index, enum usb_init_type init)
{
	debug("%s: index %x\n", __func__, index);

#if defined(CONFIG_USB_GADGET_DOWNLOAD)
	g_dnl_set_serialnumber(CONFIG_SYS_CONFIG_NAME);
#endif

	switch (index) {
	case 0:
		return dwc3_uboot_init(&dwc3_device_data0);
	case 1:
		return dwc3_uboot_init(&dwc3_device_data1);
	};

	return -1;
}

int board_usb_cleanup(int index, enum usb_init_type init)
{
	dwc3_uboot_exit(index);
	return 0;
}
#endif
Commit	Line	Data
84c7204b MS	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>
679b994a	9	#include <sata.h>
6fe6f135 MS	10	#include <ahci.h>
6fe6f135 MS	11	#include <scsi.h>
b72894f1	12	#include <malloc.h>
0785dfd8	13	#include <asm/arch/clk.h>
84c7204b MS	14	#include <asm/arch/hardware.h>
	15	#include <asm/arch/sys_proto.h>
	16	#include <asm/io.h>
16fa00a7 SDPP	17	#include <usb.h>
16fa00a7 SDPP	18	#include <dwc3-uboot.h>
47e60cbd	19	#include <zynqmppl.h>
6919b4bf	20	#include <i2c.h>
9feff385	21	#include <g_dnl.h>
84c7204b MS	22
	23	DECLARE_GLOBAL_DATA_PTR;
	24
47e60cbd MS	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
0cba6abb SB	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
47e60cbd MS	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	#define ZYNQMP_VERSION_SIZE 9
	117
84c7204b MS	118	int board_init(void)
84c7204b MS	119	{
a0736efb MS	120	printf("EL Level:\tEL%d\n", current_el());
a0736efb MS	121
47e60cbd MS	122	#if defined(CONFIG_FPGA) && defined(CONFIG_FPGA_ZYNQMPPL) && \
	123	!defined(CONFIG_SPL_BUILD) \|\| (defined(CONFIG_SPL_FPGA_SUPPORT) && \
	124	defined(CONFIG_SPL_BUILD))
	125	if (current_el() != 3) {
	126	static char version[ZYNQMP_VERSION_SIZE];
	127
	128	strncat(version, "xczu", ZYNQMP_VERSION_SIZE);
	129	zynqmppl.name = strncat(version,
	130	zynqmp_get_silicon_idcode_name(),
	131	ZYNQMP_VERSION_SIZE);
	132	printf("Chip ID:\t%s\n", zynqmppl.name);
	133	fpga_init();
	134	fpga_add(fpga_xilinx, &zynqmppl);
	135	}
	136	#endif
	137
84c7204b MS	138	return 0;
	139	}
	140
	141	int board_early_init_r(void)
	142	{
	143	u32 val;
	144
0785dfd8 MS	145	if (current_el() == 3) {
	146	val = readl(&crlapb_base->timestamp_ref_ctrl);
	147	val \|= ZYNQMP_CRL_APB_TIMESTAMP_REF_CTRL_CLKACT;
	148	writel(val, &crlapb_base->timestamp_ref_ctrl);
84c7204b	149
0785dfd8 MS	150	/* Program freq register in System counter */
	151	writel(zynqmp_get_system_timer_freq(),
	152	&iou_scntr_secure->base_frequency_id_register);
	153	/* And enable system counter */
	154	writel(ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_EN,
	155	&iou_scntr_secure->counter_control_register);
	156	}
84c7204b MS	157	/* Program freq register in System counter and enable system counter */
	158	writel(gd->cpu_clk, &iou_scntr->base_frequency_id_register);
	159	writel(ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_HDBG \|
	160	ZYNQMP_IOU_SCNTR_COUNTER_CONTROL_REGISTER_EN,
	161	&iou_scntr->counter_control_register);
	162
	163	return 0;
	164	}
	165
6919b4bf MS	166	int zynq_board_read_rom_ethaddr(unsigned char *ethaddr)
	167	{
	168	#if defined(CONFIG_ZYNQ_GEM_EEPROM_ADDR) && \
	169	defined(CONFIG_ZYNQ_GEM_I2C_MAC_OFFSET) && \
	170	defined(CONFIG_ZYNQ_EEPROM_BUS)
	171	i2c_set_bus_num(CONFIG_ZYNQ_EEPROM_BUS);
	172
	173	if (eeprom_read(CONFIG_ZYNQ_GEM_EEPROM_ADDR,
	174	CONFIG_ZYNQ_GEM_I2C_MAC_OFFSET,
	175	ethaddr, 6))
	176	printf("I2C EEPROM MAC address read failed\n");
	177	#endif
	178
	179	return 0;
	180	}
	181
8d59d7f6	182	#if !defined(CONFIG_SYS_SDRAM_BASE) && !defined(CONFIG_SYS_SDRAM_SIZE)
76b00aca	183	int dram_init_banksize(void)
361a8799	184	{
950f86ca	185	fdtdec_setup_memory_banksize();
76b00aca SG	186
76b00aca SG	187	return 0;
8a5db0ab	188	}
8d59d7f6	189
361a8799	190	int dram_init(void)
8a5db0ab	191	{
950f86ca NR	192	if (fdtdec_setup_memory_size() != 0)
950f86ca NR	193	return -EINVAL;
8a5db0ab	194
361a8799	195	return 0;
8d59d7f6 MS	196	}
8d59d7f6 MS	197	#else
84c7204b MS	198	int dram_init(void)
	199	{
	200	gd->ram_size = CONFIG_SYS_SDRAM_SIZE;
	201
	202	return 0;
	203	}
8d59d7f6	204	#endif
84c7204b	205
84c7204b MS	206	void reset_cpu(ulong addr)
	207	{
	208	}
	209
84c7204b MS	210	int board_late_init(void)
	211	{
	212	u32 reg = 0;
	213	u8 bootmode;
b72894f1 MS	214	const char *mode;
	215	char *new_targets;
	216
	217	if (!(gd->flags & GD_FLG_ENV_DEFAULT)) {
	218	debug("Saved variables - Skipping\n");
	219	return 0;
	220	}
84c7204b MS	221
84c7204b MS	222	reg = readl(&crlapb_base->boot_mode);
47359a03 MS	223	if (reg >> BOOT_MODE_ALT_SHIFT)
	224	reg >>= BOOT_MODE_ALT_SHIFT;
	225
84c7204b MS	226	bootmode = reg & BOOT_MODES_MASK;
84c7204b MS	227
fb90917c	228	puts("Bootmode: ");
84c7204b	229	switch (bootmode) {
d58fc12e MS	230	case USB_MODE:
	231	puts("USB_MODE\n");
	232	mode = "usb";
	233	break;
0a5bcc8c	234	case JTAG_MODE:
fb90917c	235	puts("JTAG_MODE\n");
b72894f1	236	mode = "pxe dhcp";
0a5bcc8c SDPP	237	break;
	238	case QSPI_MODE_24BIT:
	239	case QSPI_MODE_32BIT:
b72894f1	240	mode = "qspi0";
fb90917c	241	puts("QSPI_MODE\n");
0a5bcc8c	242	break;
39c56f55	243	case EMMC_MODE:
78678fee	244	puts("EMMC_MODE\n");
b72894f1	245	mode = "mmc0";
78678fee MS	246	break;
78678fee MS	247	case SD_MODE:
fb90917c	248	puts("SD_MODE\n");
b72894f1	249	mode = "mmc0";
84c7204b	250	break;
e1992276 SDPP	251	case SD1_LSHFT_MODE:
	252	puts("LVL_SHFT_");
	253	/* fall through */
af813acd	254	case SD_MODE1:
fb90917c	255	puts("SD_MODE1\n");
2d9925bc	256	#if defined(CONFIG_ZYNQ_SDHCI0) && defined(CONFIG_ZYNQ_SDHCI1)
b72894f1 MS	257	mode = "mmc1";
	258	#else
	259	mode = "mmc0";
2d9925bc	260	#endif
af813acd MS	261	break;
af813acd MS	262	case NAND_MODE:
fb90917c	263	puts("NAND_MODE\n");
b72894f1	264	mode = "nand0";
af813acd	265	break;
84c7204b	266	default:
b72894f1	267	mode = "";
84c7204b MS	268	printf("Invalid Boot Mode:0x%x\n", bootmode);
	269	break;
	270	}
	271
b72894f1 MS	272	/*
	273	* One terminating char + one byte for space between mode
	274	* and default boot_targets
	275	*/
	276	new_targets = calloc(1, strlen(mode) +
	277	strlen(getenv("boot_targets")) + 2);
	278
	279	sprintf(new_targets, "%s %s", mode, getenv("boot_targets"));
	280	setenv("boot_targets", new_targets);
	281
84c7204b MS	282	return 0;
84c7204b MS	283	}
84696ff5 SDPP	284
	285	int checkboard(void)
	286	{
5af08556	287	puts("Board: Xilinx ZynqMP\n");
84696ff5 SDPP	288	return 0;
84696ff5 SDPP	289	}
16fa00a7 SDPP	290
16fa00a7 SDPP	291	#ifdef CONFIG_USB_DWC3
275bd6d1	292	static struct dwc3_device dwc3_device_data0 = {
16fa00a7 SDPP	293	.maximum_speed = USB_SPEED_HIGH,
	294	.base = ZYNQMP_USB0_XHCI_BASEADDR,
	295	.dr_mode = USB_DR_MODE_PERIPHERAL,
	296	.index = 0,
	297	};
	298
275bd6d1 MS	299	static struct dwc3_device dwc3_device_data1 = {
	300	.maximum_speed = USB_SPEED_HIGH,
	301	.base = ZYNQMP_USB1_XHCI_BASEADDR,
	302	.dr_mode = USB_DR_MODE_PERIPHERAL,
	303	.index = 1,
	304	};
	305
9feff385	306	int usb_gadget_handle_interrupts(int index)
16fa00a7	307	{
9feff385	308	dwc3_uboot_handle_interrupt(index);
16fa00a7 SDPP	309	return 0;
	310	}
	311
	312	int board_usb_init(int index, enum usb_init_type init)
	313	{
275bd6d1 MS	314	debug("%s: index %x\n", __func__, index);
275bd6d1 MS	315
8ecd50c8 MS	316	#if defined(CONFIG_USB_GADGET_DOWNLOAD)
	317	g_dnl_set_serialnumber(CONFIG_SYS_CONFIG_NAME);
	318	#endif
	319
275bd6d1 MS	320	switch (index) {
	321	case 0:
	322	return dwc3_uboot_init(&dwc3_device_data0);
	323	case 1:
	324	return dwc3_uboot_init(&dwc3_device_data1);
	325	};
	326
	327	return -1;
16fa00a7 SDPP	328	}
	329
	330	int board_usb_cleanup(int index, enum usb_init_type init)
	331	{
	332	dwc3_uboot_exit(index);
	333	return 0;
	334	}
	335	#endif