220 lines
		
	
	
		
			5.3 KiB
		
	
	
	
		
			C
		
	
	
	
			
		
		
	
	
			220 lines
		
	
	
		
			5.3 KiB
		
	
	
	
		
			C
		
	
	
	
| // SPDX-License-Identifier: GPL-2.0+
 | |
| /*
 | |
|  * (C) Copyright 2016 Beniamino Galvani <b.galvani@gmail.com>
 | |
|  * (C) Copyright 2018 Neil Armstrong <narmstrong@baylibre.com>
 | |
|  */
 | |
| 
 | |
| #include <common.h>
 | |
| #include <init.h>
 | |
| #include <log.h>
 | |
| #include <net.h>
 | |
| #include <asm/arch/boot.h>
 | |
| #include <asm/arch/eth.h>
 | |
| #include <asm/arch/g12a.h>
 | |
| #include <asm/arch/mem.h>
 | |
| #include <asm/arch/meson-vpu.h>
 | |
| #include <asm/global_data.h>
 | |
| #include <asm/io.h>
 | |
| #include <asm/armv8/mmu.h>
 | |
| #include <linux/sizes.h>
 | |
| #include <usb.h>
 | |
| #include <linux/usb/otg.h>
 | |
| #include <asm/arch/usb.h>
 | |
| #include <usb/dwc2_udc.h>
 | |
| #include <phy.h>
 | |
| #include <clk.h>
 | |
| 
 | |
| DECLARE_GLOBAL_DATA_PTR;
 | |
| 
 | |
| int meson_get_boot_device(void)
 | |
| {
 | |
| 	return readl(G12A_AO_SEC_GP_CFG0) & G12A_AO_BOOT_DEVICE;
 | |
| }
 | |
| 
 | |
| /* Configure the reserved memory zones exported by the secure registers
 | |
|  * into EFI and DTB reserved memory entries.
 | |
|  */
 | |
| void meson_init_reserved_memory(void *fdt)
 | |
| {
 | |
| 	u64 bl31_size, bl31_start;
 | |
| 	u64 bl32_size, bl32_start;
 | |
| 	u32 reg;
 | |
| 
 | |
| 	/*
 | |
| 	 * Get ARM Trusted Firmware reserved memory zones in :
 | |
| 	 * - AO_SEC_GP_CFG3: bl32 & bl31 size in KiB, can be 0
 | |
| 	 * - AO_SEC_GP_CFG5: bl31 physical start address, can be NULL
 | |
| 	 * - AO_SEC_GP_CFG4: bl32 physical start address, can be NULL
 | |
| 	 */
 | |
| 	reg = readl(G12A_AO_SEC_GP_CFG3);
 | |
| 
 | |
| 	bl31_size = ((reg & G12A_AO_BL31_RSVMEM_SIZE_MASK)
 | |
| 			>> G12A_AO_BL31_RSVMEM_SIZE_SHIFT) * SZ_1K;
 | |
| 	bl32_size = (reg & G12A_AO_BL32_RSVMEM_SIZE_MASK) * SZ_1K;
 | |
| 
 | |
| 	bl31_start = readl(G12A_AO_SEC_GP_CFG5);
 | |
| 	bl32_start = readl(G12A_AO_SEC_GP_CFG4);
 | |
| 
 | |
| 	/* Add BL31 reserved zone */
 | |
| 	if (bl31_start && bl31_size)
 | |
| 		meson_board_add_reserved_memory(fdt, bl31_start, bl31_size);
 | |
| 
 | |
| 	/* Add BL32 reserved zone */
 | |
| 	if (bl32_start && bl32_size)
 | |
| 		meson_board_add_reserved_memory(fdt, bl32_start, bl32_size);
 | |
| 
 | |
| #if defined(CONFIG_VIDEO_MESON)
 | |
| 	meson_vpu_rsv_fb(fdt);
 | |
| #endif
 | |
| }
 | |
| 
 | |
| phys_size_t get_effective_memsize(void)
 | |
| {
 | |
| 	/* Size is reported in MiB, convert it in bytes */
 | |
| 	return min(((readl(G12A_AO_SEC_GP_CFG0) & G12A_AO_MEM_SIZE_MASK)
 | |
| 			>> G12A_AO_MEM_SIZE_SHIFT) * SZ_1M, 0xf5000000);
 | |
| }
 | |
| 
 | |
| static struct mm_region g12a_mem_map[] = {
 | |
| 	{
 | |
| 		.virt = 0x0UL,
 | |
| 		.phys = 0x0UL,
 | |
| 		.size = 0xf5000000UL,
 | |
| 		.attrs = PTE_BLOCK_MEMTYPE(MT_NORMAL) |
 | |
| 			 PTE_BLOCK_INNER_SHARE
 | |
| 	}, {
 | |
| 		.virt = 0xf5000000UL,
 | |
| 		.phys = 0xf5000000UL,
 | |
| 		.size = 0x0b000000UL,
 | |
| 		.attrs = PTE_BLOCK_MEMTYPE(MT_DEVICE_NGNRNE) |
 | |
| 			 PTE_BLOCK_NON_SHARE |
 | |
| 			 PTE_BLOCK_PXN | PTE_BLOCK_UXN
 | |
| 	}, {
 | |
| 		/* List terminator */
 | |
| 		0,
 | |
| 	}
 | |
| };
 | |
| 
 | |
| struct mm_region *mem_map = g12a_mem_map;
 | |
| 
 | |
| #if CONFIG_IS_ENABLED(USB_DWC3_MESON_G12A) && \
 | |
| 	CONFIG_IS_ENABLED(USB_GADGET_DWC2_OTG)
 | |
| static struct dwc2_plat_otg_data meson_g12a_dwc2_data;
 | |
| 
 | |
| int board_usb_init(int index, enum usb_init_type init)
 | |
| {
 | |
| 	struct fdtdec_phandle_args args;
 | |
| 	const void *blob = gd->fdt_blob;
 | |
| 	int node, dwc2_node;
 | |
| 	struct udevice *dev, *clk_dev;
 | |
| 	struct clk clk;
 | |
| 	int ret;
 | |
| 
 | |
| 	/* find the usb glue node */
 | |
| 	node = fdt_node_offset_by_compatible(blob, -1,
 | |
| 					     "amlogic,meson-g12a-usb-ctrl");
 | |
| 	if (node < 0) {
 | |
| 		debug("Not found usb-control node\n");
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	if (!fdtdec_get_is_enabled(blob, node)) {
 | |
| 		debug("usb is disabled in the device tree\n");
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	ret = uclass_get_device_by_of_offset(UCLASS_SIMPLE_BUS, node, &dev);
 | |
| 	if (ret) {
 | |
| 		debug("Not found usb-control device\n");
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	/* find the dwc2 node */
 | |
| 	dwc2_node = fdt_node_offset_by_compatible(blob, node,
 | |
| 						  "amlogic,meson-g12a-usb");
 | |
| 	if (dwc2_node < 0) {
 | |
| 		debug("Not found dwc2 node\n");
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	if (!fdtdec_get_is_enabled(blob, dwc2_node)) {
 | |
| 		debug("dwc2 is disabled in the device tree\n");
 | |
| 		return -ENODEV;
 | |
| 	}
 | |
| 
 | |
| 	meson_g12a_dwc2_data.regs_otg = fdtdec_get_addr(blob, dwc2_node, "reg");
 | |
| 	if (meson_g12a_dwc2_data.regs_otg == FDT_ADDR_T_NONE) {
 | |
| 		debug("usbotg: can't get base address\n");
 | |
| 		return -ENODATA;
 | |
| 	}
 | |
| 
 | |
| 	/* Enable clock */
 | |
| 	ret = fdtdec_parse_phandle_with_args(blob, dwc2_node, "clocks",
 | |
| 					     "#clock-cells", 0, 0, &args);
 | |
| 	if (ret) {
 | |
| 		debug("usbotg has no clocks defined in the device tree\n");
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	ret = uclass_get_device_by_of_offset(UCLASS_CLK, args.node, &clk_dev);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	if (args.args_count != 1) {
 | |
| 		debug("Can't find clock ID in the device tree\n");
 | |
| 		return -ENODATA;
 | |
| 	}
 | |
| 
 | |
| 	clk.dev = clk_dev;
 | |
| 	clk.id = args.args[0];
 | |
| 
 | |
| 	ret = clk_enable(&clk);
 | |
| 	if (ret) {
 | |
| 		debug("Failed to enable usbotg clock\n");
 | |
| 		return ret;
 | |
| 	}
 | |
| 
 | |
| 	meson_g12a_dwc2_data.rx_fifo_sz = fdtdec_get_int(blob, dwc2_node,
 | |
| 						     "g-rx-fifo-size", 0);
 | |
| 	meson_g12a_dwc2_data.np_tx_fifo_sz = fdtdec_get_int(blob, dwc2_node,
 | |
| 							"g-np-tx-fifo-size", 0);
 | |
| 	meson_g12a_dwc2_data.tx_fifo_sz = fdtdec_get_int(blob, dwc2_node,
 | |
| 						     "g-tx-fifo-size", 0);
 | |
| 
 | |
| 	/* Switch to peripheral mode */
 | |
| 	ret = dwc3_meson_g12a_force_mode(dev, USB_DR_MODE_PERIPHERAL);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	return dwc2_udc_probe(&meson_g12a_dwc2_data);
 | |
| }
 | |
| 
 | |
| int board_usb_cleanup(int index, enum usb_init_type init)
 | |
| {
 | |
| 	const void *blob = gd->fdt_blob;
 | |
| 	struct udevice *dev;
 | |
| 	int node;
 | |
| 	int ret;
 | |
| 
 | |
| 	/* find the usb glue node */
 | |
| 	node = fdt_node_offset_by_compatible(blob, -1,
 | |
| 					     "amlogic,meson-g12a-usb-ctrl");
 | |
| 	if (node < 0)
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	if (!fdtdec_get_is_enabled(blob, node))
 | |
| 		return -ENODEV;
 | |
| 
 | |
| 	ret = uclass_get_device_by_of_offset(UCLASS_SIMPLE_BUS, node, &dev);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	/* Switch to OTG mode */
 | |
| 	ret = dwc3_meson_g12a_force_mode(dev, USB_DR_MODE_HOST);
 | |
| 	if (ret)
 | |
| 		return ret;
 | |
| 
 | |
| 	return 0;
 | |
| }
 | |
| #endif
 |