17b3bd9a7SJ. German Rivera /* 242e81790SYogesh Gaur * Copyright (C) 2017 NXP Semiconductors 37b3bd9a7SJ. German Rivera * Copyright (C) 2014 Freescale Semiconductor 47b3bd9a7SJ. German Rivera * 57b3bd9a7SJ. German Rivera * SPDX-License-Identifier: GPL-2.0+ 67b3bd9a7SJ. German Rivera */ 721c69870SStuart Yoder #include <common.h> 87b3bd9a7SJ. German Rivera #include <errno.h> 984b8bf6dSMasahiro Yamada #include <linux/bug.h> 107b3bd9a7SJ. German Rivera #include <asm/io.h> 1121c69870SStuart Yoder #include <libfdt.h> 125707dfb0SBogdan Purcareata #include <net.h> 1321c69870SStuart Yoder #include <fdt_support.h> 147b3bd9a7SJ. German Rivera #include <fsl-mc/fsl_mc.h> 157b3bd9a7SJ. German Rivera #include <fsl-mc/fsl_mc_sys.h> 16a2a55e51SPrabhakar Kushwaha #include <fsl-mc/fsl_mc_private.h> 177b3bd9a7SJ. German Rivera #include <fsl-mc/fsl_dpmng.h> 18a2a55e51SPrabhakar Kushwaha #include <fsl-mc/fsl_dprc.h> 19a2a55e51SPrabhakar Kushwaha #include <fsl-mc/fsl_dpio.h> 20fb4a87a7SPrabhakar Kushwaha #include <fsl-mc/fsl_dpni.h> 21a2a55e51SPrabhakar Kushwaha #include <fsl-mc/fsl_qbman_portal.h> 22fb4a87a7SPrabhakar Kushwaha #include <fsl-mc/ldpaa_wriop.h> 237b3bd9a7SJ. German Rivera 24125e2bc1SJ. German Rivera #define MC_RAM_BASE_ADDR_ALIGNMENT (512UL * 1024 * 1024) 25125e2bc1SJ. German Rivera #define MC_RAM_BASE_ADDR_ALIGNMENT_MASK (~(MC_RAM_BASE_ADDR_ALIGNMENT - 1)) 26125e2bc1SJ. German Rivera #define MC_RAM_SIZE_ALIGNMENT (256UL * 1024 * 1024) 27125e2bc1SJ. German Rivera 28125e2bc1SJ. German Rivera #define MC_MEM_SIZE_ENV_VAR "mcmemsize" 29125e2bc1SJ. German Rivera #define MC_BOOT_TIMEOUT_ENV_VAR "mcboottimeout" 3033a8991aSBogdan Purcareata #define MC_BOOT_ENV_VAR "mcinitcmd" 31125e2bc1SJ. German Rivera 327b3bd9a7SJ. German Rivera DECLARE_GLOBAL_DATA_PTR; 33fb4a87a7SPrabhakar Kushwaha static int mc_boot_status = -1; 34fb4a87a7SPrabhakar Kushwaha static int mc_dpl_applied = -1; 35fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET 36fb4a87a7SPrabhakar Kushwaha static int mc_aiop_applied = -1; 37fb4a87a7SPrabhakar Kushwaha #endif 381730a17dSPrabhakar Kushwaha struct fsl_mc_io *root_mc_io = NULL; 391730a17dSPrabhakar Kushwaha struct fsl_mc_io *dflt_mc_io = NULL; /* child container */ 401730a17dSPrabhakar Kushwaha uint16_t root_dprc_handle = 0; 41a2a55e51SPrabhakar Kushwaha uint16_t dflt_dprc_handle = 0; 421730a17dSPrabhakar Kushwaha int child_dprc_id; 43a2a55e51SPrabhakar Kushwaha struct fsl_dpbp_obj *dflt_dpbp = NULL; 44a2a55e51SPrabhakar Kushwaha struct fsl_dpio_obj *dflt_dpio = NULL; 451730a17dSPrabhakar Kushwaha struct fsl_dpni_obj *dflt_dpni = NULL; 46b7b8410aSAlexander Graf static u64 mc_lazy_dpl_addr; 477b3bd9a7SJ. German Rivera 48125e2bc1SJ. German Rivera #ifdef DEBUG 49125e2bc1SJ. German Rivera void dump_ram_words(const char *title, void *addr) 50125e2bc1SJ. German Rivera { 51125e2bc1SJ. German Rivera int i; 52125e2bc1SJ. German Rivera uint32_t *words = addr; 53125e2bc1SJ. German Rivera 54125e2bc1SJ. German Rivera printf("Dumping beginning of %s (%p):\n", title, addr); 55125e2bc1SJ. German Rivera for (i = 0; i < 16; i++) 56125e2bc1SJ. German Rivera printf("%#x ", words[i]); 57125e2bc1SJ. German Rivera 58125e2bc1SJ. German Rivera printf("\n"); 59125e2bc1SJ. German Rivera } 60125e2bc1SJ. German Rivera 61125e2bc1SJ. German Rivera void dump_mc_ccsr_regs(struct mc_ccsr_registers __iomem *mc_ccsr_regs) 62125e2bc1SJ. German Rivera { 63125e2bc1SJ. German Rivera printf("MC CCSR registers:\n" 64125e2bc1SJ. German Rivera "reg_gcr1 %#x\n" 65125e2bc1SJ. German Rivera "reg_gsr %#x\n" 66125e2bc1SJ. German Rivera "reg_sicbalr %#x\n" 67125e2bc1SJ. German Rivera "reg_sicbahr %#x\n" 68125e2bc1SJ. German Rivera "reg_sicapr %#x\n" 69125e2bc1SJ. German Rivera "reg_mcfbalr %#x\n" 70125e2bc1SJ. German Rivera "reg_mcfbahr %#x\n" 71125e2bc1SJ. German Rivera "reg_mcfapr %#x\n" 72125e2bc1SJ. German Rivera "reg_psr %#x\n", 73125e2bc1SJ. German Rivera mc_ccsr_regs->reg_gcr1, 74125e2bc1SJ. German Rivera mc_ccsr_regs->reg_gsr, 75125e2bc1SJ. German Rivera mc_ccsr_regs->reg_sicbalr, 76125e2bc1SJ. German Rivera mc_ccsr_regs->reg_sicbahr, 77125e2bc1SJ. German Rivera mc_ccsr_regs->reg_sicapr, 78125e2bc1SJ. German Rivera mc_ccsr_regs->reg_mcfbalr, 79125e2bc1SJ. German Rivera mc_ccsr_regs->reg_mcfbahr, 80125e2bc1SJ. German Rivera mc_ccsr_regs->reg_mcfapr, 81125e2bc1SJ. German Rivera mc_ccsr_regs->reg_psr); 82125e2bc1SJ. German Rivera } 83125e2bc1SJ. German Rivera #else 84125e2bc1SJ. German Rivera 85125e2bc1SJ. German Rivera #define dump_ram_words(title, addr) 86125e2bc1SJ. German Rivera #define dump_mc_ccsr_regs(mc_ccsr_regs) 87125e2bc1SJ. German Rivera 88125e2bc1SJ. German Rivera #endif /* DEBUG */ 89125e2bc1SJ. German Rivera 90125e2bc1SJ. German Rivera #ifndef CONFIG_SYS_LS_MC_FW_IN_DDR 917b3bd9a7SJ. German Rivera /** 927b3bd9a7SJ. German Rivera * Copying MC firmware or DPL image to DDR 937b3bd9a7SJ. German Rivera */ 947b3bd9a7SJ. German Rivera static int mc_copy_image(const char *title, 957b3bd9a7SJ. German Rivera u64 image_addr, u32 image_size, u64 mc_ram_addr) 967b3bd9a7SJ. German Rivera { 977b3bd9a7SJ. German Rivera debug("%s copied to address %p\n", title, (void *)mc_ram_addr); 987b3bd9a7SJ. German Rivera memcpy((void *)mc_ram_addr, (void *)image_addr, image_size); 99125e2bc1SJ. German Rivera flush_dcache_range(mc_ram_addr, mc_ram_addr + image_size); 1007b3bd9a7SJ. German Rivera return 0; 1017b3bd9a7SJ. German Rivera } 1027b3bd9a7SJ. German Rivera 1037b3bd9a7SJ. German Rivera /** 1047b3bd9a7SJ. German Rivera * MC firmware FIT image parser checks if the image is in FIT 1057b3bd9a7SJ. German Rivera * format, verifies integrity of the image and calculates 1067b3bd9a7SJ. German Rivera * raw image address and size values. 1077b3bd9a7SJ. German Rivera * Returns 0 on success and a negative errno on error. 1087b3bd9a7SJ. German Rivera * task fail. 1097b3bd9a7SJ. German Rivera **/ 110fb4a87a7SPrabhakar Kushwaha int parse_mc_firmware_fit_image(u64 mc_fw_addr, 111fb4a87a7SPrabhakar Kushwaha const void **raw_image_addr, 1127b3bd9a7SJ. German Rivera size_t *raw_image_size) 1137b3bd9a7SJ. German Rivera { 1147b3bd9a7SJ. German Rivera int format; 1157b3bd9a7SJ. German Rivera void *fit_hdr; 1167b3bd9a7SJ. German Rivera int node_offset; 1177b3bd9a7SJ. German Rivera const void *data; 1187b3bd9a7SJ. German Rivera size_t size; 1197b3bd9a7SJ. German Rivera const char *uname = "firmware"; 1207b3bd9a7SJ. German Rivera 121fb4a87a7SPrabhakar Kushwaha fit_hdr = (void *)mc_fw_addr; 1227b3bd9a7SJ. German Rivera 1237b3bd9a7SJ. German Rivera /* Check if Image is in FIT format */ 1247b3bd9a7SJ. German Rivera format = genimg_get_format(fit_hdr); 1257b3bd9a7SJ. German Rivera 1267b3bd9a7SJ. German Rivera if (format != IMAGE_FORMAT_FIT) { 127fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: ERR: Bad firmware image (not a FIT image)\n"); 1287b3bd9a7SJ. German Rivera return -EINVAL; 1297b3bd9a7SJ. German Rivera } 1307b3bd9a7SJ. German Rivera 1317b3bd9a7SJ. German Rivera if (!fit_check_format(fit_hdr)) { 132fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: ERR: Bad firmware image (bad FIT header)\n"); 1337b3bd9a7SJ. German Rivera return -EINVAL; 1347b3bd9a7SJ. German Rivera } 1357b3bd9a7SJ. German Rivera 1367b3bd9a7SJ. German Rivera node_offset = fit_image_get_node(fit_hdr, uname); 1377b3bd9a7SJ. German Rivera 1387b3bd9a7SJ. German Rivera if (node_offset < 0) { 139fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: ERR: Bad firmware image (missing subimage)\n"); 1407b3bd9a7SJ. German Rivera return -ENOENT; 1417b3bd9a7SJ. German Rivera } 1427b3bd9a7SJ. German Rivera 1437b3bd9a7SJ. German Rivera /* Verify MC firmware image */ 1447b3bd9a7SJ. German Rivera if (!(fit_image_verify(fit_hdr, node_offset))) { 145fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: ERR: Bad firmware image (bad CRC)\n"); 1467b3bd9a7SJ. German Rivera return -EINVAL; 1477b3bd9a7SJ. German Rivera } 1487b3bd9a7SJ. German Rivera 1497b3bd9a7SJ. German Rivera /* Get address and size of raw image */ 1507b3bd9a7SJ. German Rivera fit_image_get_data(fit_hdr, node_offset, &data, &size); 1517b3bd9a7SJ. German Rivera 1527b3bd9a7SJ. German Rivera *raw_image_addr = data; 1537b3bd9a7SJ. German Rivera *raw_image_size = size; 1547b3bd9a7SJ. German Rivera 1557b3bd9a7SJ. German Rivera return 0; 1567b3bd9a7SJ. German Rivera } 157125e2bc1SJ. German Rivera #endif 158125e2bc1SJ. German Rivera 1591161dbccSBogdan Purcareata #define MC_DT_INCREASE_SIZE 64 1601161dbccSBogdan Purcareata 1611161dbccSBogdan Purcareata enum mc_fixup_type { 1621161dbccSBogdan Purcareata MC_FIXUP_DPL, 1631161dbccSBogdan Purcareata MC_FIXUP_DPC 1641161dbccSBogdan Purcareata }; 1651161dbccSBogdan Purcareata 1661161dbccSBogdan Purcareata static int mc_fixup_mac_addr(void *blob, int nodeoffset, 1671161dbccSBogdan Purcareata const char *propname, struct eth_device *eth_dev, 1681161dbccSBogdan Purcareata enum mc_fixup_type type) 1691161dbccSBogdan Purcareata { 1701161dbccSBogdan Purcareata int err = 0, len = 0, size, i; 1711161dbccSBogdan Purcareata unsigned char env_enetaddr[ARP_HLEN]; 1721161dbccSBogdan Purcareata unsigned int enetaddr_32[ARP_HLEN]; 1731161dbccSBogdan Purcareata void *val = NULL; 1741161dbccSBogdan Purcareata 1751161dbccSBogdan Purcareata switch (type) { 1761161dbccSBogdan Purcareata case MC_FIXUP_DPL: 1771161dbccSBogdan Purcareata /* DPL likes its addresses on 32 * ARP_HLEN bits */ 1781161dbccSBogdan Purcareata for (i = 0; i < ARP_HLEN; i++) 1791161dbccSBogdan Purcareata enetaddr_32[i] = cpu_to_fdt32(eth_dev->enetaddr[i]); 1801161dbccSBogdan Purcareata val = enetaddr_32; 1811161dbccSBogdan Purcareata len = sizeof(enetaddr_32); 1821161dbccSBogdan Purcareata break; 1831161dbccSBogdan Purcareata 1841161dbccSBogdan Purcareata case MC_FIXUP_DPC: 1851161dbccSBogdan Purcareata val = eth_dev->enetaddr; 1861161dbccSBogdan Purcareata len = ARP_HLEN; 1871161dbccSBogdan Purcareata break; 1881161dbccSBogdan Purcareata } 1891161dbccSBogdan Purcareata 1901161dbccSBogdan Purcareata /* MAC address property present */ 1911161dbccSBogdan Purcareata if (fdt_get_property(blob, nodeoffset, propname, NULL)) { 1921161dbccSBogdan Purcareata /* u-boot MAC addr randomly assigned - leave the present one */ 19335affd7aSSimon Glass if (!eth_env_get_enetaddr_by_index("eth", eth_dev->index, 1941161dbccSBogdan Purcareata env_enetaddr)) 1951161dbccSBogdan Purcareata return err; 1961161dbccSBogdan Purcareata } else { 1971161dbccSBogdan Purcareata size = MC_DT_INCREASE_SIZE + strlen(propname) + len; 1981161dbccSBogdan Purcareata /* make room for mac address property */ 1991161dbccSBogdan Purcareata err = fdt_increase_size(blob, size); 2001161dbccSBogdan Purcareata if (err) { 2011161dbccSBogdan Purcareata printf("fdt_increase_size: err=%s\n", 2021161dbccSBogdan Purcareata fdt_strerror(err)); 2031161dbccSBogdan Purcareata return err; 2041161dbccSBogdan Purcareata } 2051161dbccSBogdan Purcareata } 2061161dbccSBogdan Purcareata 2071161dbccSBogdan Purcareata err = fdt_setprop(blob, nodeoffset, propname, val, len); 2081161dbccSBogdan Purcareata if (err) { 2091161dbccSBogdan Purcareata printf("fdt_setprop: err=%s\n", fdt_strerror(err)); 2101161dbccSBogdan Purcareata return err; 2111161dbccSBogdan Purcareata } 2121161dbccSBogdan Purcareata 2131161dbccSBogdan Purcareata return err; 2141161dbccSBogdan Purcareata } 2151161dbccSBogdan Purcareata 2161161dbccSBogdan Purcareata #define is_dpni(s) (s != NULL ? !strncmp(s, "dpni@", 5) : 0) 2171161dbccSBogdan Purcareata 2181161dbccSBogdan Purcareata const char *dpl_get_connection_endpoint(void *blob, char *endpoint) 2191161dbccSBogdan Purcareata { 2201161dbccSBogdan Purcareata int connoffset = fdt_path_offset(blob, "/connections"), off; 2211161dbccSBogdan Purcareata const char *s1, *s2; 2221161dbccSBogdan Purcareata 2231161dbccSBogdan Purcareata for (off = fdt_first_subnode(blob, connoffset); 2241161dbccSBogdan Purcareata off >= 0; 2251161dbccSBogdan Purcareata off = fdt_next_subnode(blob, off)) { 2261161dbccSBogdan Purcareata s1 = fdt_stringlist_get(blob, off, "endpoint1", 0, NULL); 2271161dbccSBogdan Purcareata s2 = fdt_stringlist_get(blob, off, "endpoint2", 0, NULL); 2281161dbccSBogdan Purcareata 2291161dbccSBogdan Purcareata if (!s1 || !s2) 2301161dbccSBogdan Purcareata continue; 2311161dbccSBogdan Purcareata 2321161dbccSBogdan Purcareata if (strcmp(endpoint, s1) == 0) 2331161dbccSBogdan Purcareata return s2; 2341161dbccSBogdan Purcareata 2351161dbccSBogdan Purcareata if (strcmp(endpoint, s2) == 0) 2361161dbccSBogdan Purcareata return s1; 2371161dbccSBogdan Purcareata } 2381161dbccSBogdan Purcareata 2391161dbccSBogdan Purcareata return NULL; 2401161dbccSBogdan Purcareata } 2411161dbccSBogdan Purcareata 2421161dbccSBogdan Purcareata static int mc_fixup_dpl_mac_addr(void *blob, int dpmac_id, 2435707dfb0SBogdan Purcareata struct eth_device *eth_dev) 2445707dfb0SBogdan Purcareata { 2451161dbccSBogdan Purcareata int objoff = fdt_path_offset(blob, "/objects"); 2461161dbccSBogdan Purcareata int dpmacoff = -1, dpnioff = -1; 2471161dbccSBogdan Purcareata const char *endpoint; 2485707dfb0SBogdan Purcareata char mac_name[10]; 2491161dbccSBogdan Purcareata int err; 2501161dbccSBogdan Purcareata 2511161dbccSBogdan Purcareata sprintf(mac_name, "dpmac@%d", dpmac_id); 2521161dbccSBogdan Purcareata dpmacoff = fdt_subnode_offset(blob, objoff, mac_name); 2531161dbccSBogdan Purcareata if (dpmacoff < 0) 2541161dbccSBogdan Purcareata /* dpmac not defined in DPL, so skip it. */ 2551161dbccSBogdan Purcareata return 0; 2561161dbccSBogdan Purcareata 2571161dbccSBogdan Purcareata err = mc_fixup_mac_addr(blob, dpmacoff, "mac_addr", eth_dev, 2581161dbccSBogdan Purcareata MC_FIXUP_DPL); 2591161dbccSBogdan Purcareata if (err) { 2601161dbccSBogdan Purcareata printf("Error fixing up dpmac mac_addr in DPL\n"); 2611161dbccSBogdan Purcareata return err; 2621161dbccSBogdan Purcareata } 2631161dbccSBogdan Purcareata 2641161dbccSBogdan Purcareata /* now we need to figure out if there is any 2651161dbccSBogdan Purcareata * DPNI connected to this MAC, so we walk the 2661161dbccSBogdan Purcareata * connection list 2671161dbccSBogdan Purcareata */ 2681161dbccSBogdan Purcareata endpoint = dpl_get_connection_endpoint(blob, mac_name); 2691161dbccSBogdan Purcareata if (!is_dpni(endpoint)) 2701161dbccSBogdan Purcareata return 0; 2711161dbccSBogdan Purcareata 2721161dbccSBogdan Purcareata /* let's see if we can fixup the DPNI as well */ 2731161dbccSBogdan Purcareata dpnioff = fdt_subnode_offset(blob, objoff, endpoint); 2741161dbccSBogdan Purcareata if (dpnioff < 0) 2751161dbccSBogdan Purcareata /* DPNI not defined in DPL in the objects area */ 2761161dbccSBogdan Purcareata return 0; 2771161dbccSBogdan Purcareata 2781161dbccSBogdan Purcareata return mc_fixup_mac_addr(blob, dpnioff, "mac_addr", eth_dev, 2791161dbccSBogdan Purcareata MC_FIXUP_DPL); 2801161dbccSBogdan Purcareata } 2811161dbccSBogdan Purcareata 2821161dbccSBogdan Purcareata static int mc_fixup_dpc_mac_addr(void *blob, int dpmac_id, 2831161dbccSBogdan Purcareata struct eth_device *eth_dev) 2841161dbccSBogdan Purcareata { 2851161dbccSBogdan Purcareata int nodeoffset = fdt_path_offset(blob, "/board_info/ports"), noff; 2861161dbccSBogdan Purcareata int err = 0; 2871161dbccSBogdan Purcareata char mac_name[10]; 2881161dbccSBogdan Purcareata const char link_type_mode[] = "MAC_LINK_TYPE_FIXED"; 2895707dfb0SBogdan Purcareata 2905707dfb0SBogdan Purcareata sprintf(mac_name, "mac@%d", dpmac_id); 2915707dfb0SBogdan Purcareata 2925707dfb0SBogdan Purcareata /* node not found - create it */ 2931161dbccSBogdan Purcareata noff = fdt_subnode_offset(blob, nodeoffset, (const char *)mac_name); 2941161dbccSBogdan Purcareata if (noff < 0) { 2955707dfb0SBogdan Purcareata err = fdt_increase_size(blob, 200); 2965707dfb0SBogdan Purcareata if (err) { 2975707dfb0SBogdan Purcareata printf("fdt_increase_size: err=%s\n", 2985707dfb0SBogdan Purcareata fdt_strerror(err)); 2995707dfb0SBogdan Purcareata return err; 3005707dfb0SBogdan Purcareata } 3015707dfb0SBogdan Purcareata 3021161dbccSBogdan Purcareata noff = fdt_add_subnode(blob, nodeoffset, mac_name); 3031161dbccSBogdan Purcareata if (noff < 0) { 3041161dbccSBogdan Purcareata printf("fdt_add_subnode: err=%s\n", 3051161dbccSBogdan Purcareata fdt_strerror(err)); 3061161dbccSBogdan Purcareata return err; 3071161dbccSBogdan Purcareata } 3085707dfb0SBogdan Purcareata 3095707dfb0SBogdan Purcareata /* add default property of fixed link */ 3101161dbccSBogdan Purcareata err = fdt_appendprop_string(blob, noff, 3115707dfb0SBogdan Purcareata "link_type", link_type_mode); 3125707dfb0SBogdan Purcareata if (err) { 3135707dfb0SBogdan Purcareata printf("fdt_appendprop_string: err=%s\n", 3145707dfb0SBogdan Purcareata fdt_strerror(err)); 3155707dfb0SBogdan Purcareata return err; 3165707dfb0SBogdan Purcareata } 3175707dfb0SBogdan Purcareata } 3185707dfb0SBogdan Purcareata 3191161dbccSBogdan Purcareata return mc_fixup_mac_addr(blob, noff, "port_mac_address", eth_dev, 3201161dbccSBogdan Purcareata MC_FIXUP_DPC); 3215707dfb0SBogdan Purcareata } 3225707dfb0SBogdan Purcareata 3231161dbccSBogdan Purcareata static int mc_fixup_mac_addrs(void *blob, enum mc_fixup_type type) 3241161dbccSBogdan Purcareata { 3251161dbccSBogdan Purcareata int i, err = 0, ret = 0; 3261161dbccSBogdan Purcareata char ethname[10]; 3271161dbccSBogdan Purcareata struct eth_device *eth_dev; 3281161dbccSBogdan Purcareata 3291161dbccSBogdan Purcareata for (i = WRIOP1_DPMAC1; i < NUM_WRIOP_PORTS; i++) { 3301161dbccSBogdan Purcareata /* port not enabled */ 3311161dbccSBogdan Purcareata if ((wriop_is_enabled_dpmac(i) != 1) || 3321161dbccSBogdan Purcareata (wriop_get_phy_address(i) == -1)) 3331161dbccSBogdan Purcareata continue; 3341161dbccSBogdan Purcareata 3351161dbccSBogdan Purcareata sprintf(ethname, "DPMAC%d@%s", i, 3361161dbccSBogdan Purcareata phy_interface_strings[wriop_get_enet_if(i)]); 3371161dbccSBogdan Purcareata 3381161dbccSBogdan Purcareata eth_dev = eth_get_dev_by_name(ethname); 3391161dbccSBogdan Purcareata if (eth_dev == NULL) 3401161dbccSBogdan Purcareata continue; 3411161dbccSBogdan Purcareata 3421161dbccSBogdan Purcareata switch (type) { 3431161dbccSBogdan Purcareata case MC_FIXUP_DPL: 3441161dbccSBogdan Purcareata err = mc_fixup_dpl_mac_addr(blob, i, eth_dev); 3451161dbccSBogdan Purcareata break; 3461161dbccSBogdan Purcareata case MC_FIXUP_DPC: 3471161dbccSBogdan Purcareata err = mc_fixup_dpc_mac_addr(blob, i, eth_dev); 3481161dbccSBogdan Purcareata break; 3491161dbccSBogdan Purcareata default: 3501161dbccSBogdan Purcareata break; 3515707dfb0SBogdan Purcareata } 3525707dfb0SBogdan Purcareata 3531161dbccSBogdan Purcareata if (err) 3541161dbccSBogdan Purcareata printf("fsl-mc: ERROR fixing mac address for %s\n", 3551161dbccSBogdan Purcareata ethname); 3561161dbccSBogdan Purcareata ret |= err; 3575707dfb0SBogdan Purcareata } 3585707dfb0SBogdan Purcareata 3591161dbccSBogdan Purcareata return ret; 3605707dfb0SBogdan Purcareata } 3615707dfb0SBogdan Purcareata 36221c69870SStuart Yoder static int mc_fixup_dpc(u64 dpc_addr) 36321c69870SStuart Yoder { 36421c69870SStuart Yoder void *blob = (void *)dpc_addr; 3655707dfb0SBogdan Purcareata int nodeoffset, err = 0; 36621c69870SStuart Yoder 36721c69870SStuart Yoder /* delete any existing ICID pools */ 36821c69870SStuart Yoder nodeoffset = fdt_path_offset(blob, "/resources/icid_pools"); 36921c69870SStuart Yoder if (fdt_del_node(blob, nodeoffset) < 0) 37021c69870SStuart Yoder printf("\nfsl-mc: WARNING: could not delete ICID pool\n"); 37121c69870SStuart Yoder 37221c69870SStuart Yoder /* add a new pool */ 37321c69870SStuart Yoder nodeoffset = fdt_path_offset(blob, "/resources"); 37421c69870SStuart Yoder if (nodeoffset < 0) { 37521c69870SStuart Yoder printf("\nfsl-mc: ERROR: DPC is missing /resources\n"); 37621c69870SStuart Yoder return -EINVAL; 37721c69870SStuart Yoder } 37821c69870SStuart Yoder nodeoffset = fdt_add_subnode(blob, nodeoffset, "icid_pools"); 37921c69870SStuart Yoder nodeoffset = fdt_add_subnode(blob, nodeoffset, "icid_pool@0"); 38021c69870SStuart Yoder do_fixup_by_path_u32(blob, "/resources/icid_pools/icid_pool@0", 38121c69870SStuart Yoder "base_icid", FSL_DPAA2_STREAM_ID_START, 1); 38221c69870SStuart Yoder do_fixup_by_path_u32(blob, "/resources/icid_pools/icid_pool@0", 38321c69870SStuart Yoder "num", 38421c69870SStuart Yoder FSL_DPAA2_STREAM_ID_END - 38521c69870SStuart Yoder FSL_DPAA2_STREAM_ID_START + 1, 1); 38621c69870SStuart Yoder 3875707dfb0SBogdan Purcareata /* fixup MAC addresses for dpmac ports */ 3885707dfb0SBogdan Purcareata nodeoffset = fdt_path_offset(blob, "/board_info/ports"); 3895707dfb0SBogdan Purcareata if (nodeoffset < 0) 3901161dbccSBogdan Purcareata return 0; 3915707dfb0SBogdan Purcareata 3921161dbccSBogdan Purcareata err = mc_fixup_mac_addrs(blob, MC_FIXUP_DPC); 39321c69870SStuart Yoder flush_dcache_range(dpc_addr, dpc_addr + fdt_totalsize(blob)); 39421c69870SStuart Yoder 3955707dfb0SBogdan Purcareata return err; 39621c69870SStuart Yoder } 39721c69870SStuart Yoder 398fb4a87a7SPrabhakar Kushwaha static int load_mc_dpc(u64 mc_ram_addr, size_t mc_ram_size, u64 mc_dpc_addr) 399125e2bc1SJ. German Rivera { 400125e2bc1SJ. German Rivera u64 mc_dpc_offset; 401125e2bc1SJ. German Rivera #ifndef CONFIG_SYS_LS_MC_DPC_IN_DDR 402125e2bc1SJ. German Rivera int error; 403125e2bc1SJ. German Rivera void *dpc_fdt_hdr; 404125e2bc1SJ. German Rivera int dpc_size; 405125e2bc1SJ. German Rivera #endif 406125e2bc1SJ. German Rivera 407125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET 408125e2bc1SJ. German Rivera BUILD_BUG_ON((CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET & 0x3) != 0 || 409125e2bc1SJ. German Rivera CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET > 0xffffffff); 410125e2bc1SJ. German Rivera 411125e2bc1SJ. German Rivera mc_dpc_offset = CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET; 412125e2bc1SJ. German Rivera #else 413125e2bc1SJ. German Rivera #error "CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET not defined" 414125e2bc1SJ. German Rivera #endif 415125e2bc1SJ. German Rivera 416125e2bc1SJ. German Rivera /* 417125e2bc1SJ. German Rivera * Load the MC DPC blob in the MC private DRAM block: 418125e2bc1SJ. German Rivera */ 419125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_DPC_IN_DDR 420125e2bc1SJ. German Rivera printf("MC DPC is preloaded to %#llx\n", mc_ram_addr + mc_dpc_offset); 421125e2bc1SJ. German Rivera #else 422125e2bc1SJ. German Rivera /* 423125e2bc1SJ. German Rivera * Get address and size of the DPC blob stored in flash: 424125e2bc1SJ. German Rivera */ 425fb4a87a7SPrabhakar Kushwaha dpc_fdt_hdr = (void *)mc_dpc_addr; 426125e2bc1SJ. German Rivera 427125e2bc1SJ. German Rivera error = fdt_check_header(dpc_fdt_hdr); 428125e2bc1SJ. German Rivera if (error != 0) { 429125e2bc1SJ. German Rivera /* 430125e2bc1SJ. German Rivera * Don't return with error here, since the MC firmware can 431125e2bc1SJ. German Rivera * still boot without a DPC 432125e2bc1SJ. German Rivera */ 433cc088c3aSJ. German Rivera printf("\nfsl-mc: WARNING: No DPC image found"); 434125e2bc1SJ. German Rivera return 0; 435125e2bc1SJ. German Rivera } 436125e2bc1SJ. German Rivera 437125e2bc1SJ. German Rivera dpc_size = fdt_totalsize(dpc_fdt_hdr); 438125e2bc1SJ. German Rivera if (dpc_size > CONFIG_SYS_LS_MC_DPC_MAX_LENGTH) { 439cc088c3aSJ. German Rivera printf("\nfsl-mc: ERROR: Bad DPC image (too large: %d)\n", 440125e2bc1SJ. German Rivera dpc_size); 441125e2bc1SJ. German Rivera return -EINVAL; 442125e2bc1SJ. German Rivera } 443125e2bc1SJ. German Rivera 444125e2bc1SJ. German Rivera mc_copy_image("MC DPC blob", 445125e2bc1SJ. German Rivera (u64)dpc_fdt_hdr, dpc_size, mc_ram_addr + mc_dpc_offset); 446125e2bc1SJ. German Rivera #endif /* not defined CONFIG_SYS_LS_MC_DPC_IN_DDR */ 447125e2bc1SJ. German Rivera 44821c69870SStuart Yoder if (mc_fixup_dpc(mc_ram_addr + mc_dpc_offset)) 44921c69870SStuart Yoder return -EINVAL; 45021c69870SStuart Yoder 451125e2bc1SJ. German Rivera dump_ram_words("DPC", (void *)(mc_ram_addr + mc_dpc_offset)); 452125e2bc1SJ. German Rivera return 0; 453125e2bc1SJ. German Rivera } 454125e2bc1SJ. German Rivera 4551161dbccSBogdan Purcareata 4561161dbccSBogdan Purcareata static int mc_fixup_dpl(u64 dpl_addr) 4571161dbccSBogdan Purcareata { 4581161dbccSBogdan Purcareata void *blob = (void *)dpl_addr; 4591161dbccSBogdan Purcareata u32 ver = fdt_getprop_u32_default(blob, "/", "dpl-version", 0); 4601161dbccSBogdan Purcareata int err = 0; 4611161dbccSBogdan Purcareata 4621161dbccSBogdan Purcareata /* The DPL fixup for mac addresses is only relevant 4631161dbccSBogdan Purcareata * for old-style DPLs 4641161dbccSBogdan Purcareata */ 4651161dbccSBogdan Purcareata if (ver >= 10) 4661161dbccSBogdan Purcareata return 0; 4671161dbccSBogdan Purcareata 4681161dbccSBogdan Purcareata err = mc_fixup_mac_addrs(blob, MC_FIXUP_DPL); 4691161dbccSBogdan Purcareata flush_dcache_range(dpl_addr, dpl_addr + fdt_totalsize(blob)); 4701161dbccSBogdan Purcareata 4711161dbccSBogdan Purcareata return err; 4721161dbccSBogdan Purcareata } 4731161dbccSBogdan Purcareata 474fb4a87a7SPrabhakar Kushwaha static int load_mc_dpl(u64 mc_ram_addr, size_t mc_ram_size, u64 mc_dpl_addr) 475125e2bc1SJ. German Rivera { 476125e2bc1SJ. German Rivera u64 mc_dpl_offset; 477125e2bc1SJ. German Rivera #ifndef CONFIG_SYS_LS_MC_DPL_IN_DDR 478125e2bc1SJ. German Rivera int error; 479125e2bc1SJ. German Rivera void *dpl_fdt_hdr; 480125e2bc1SJ. German Rivera int dpl_size; 481125e2bc1SJ. German Rivera #endif 482125e2bc1SJ. German Rivera 483125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET 484125e2bc1SJ. German Rivera BUILD_BUG_ON((CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET & 0x3) != 0 || 485125e2bc1SJ. German Rivera CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET > 0xffffffff); 486125e2bc1SJ. German Rivera 487125e2bc1SJ. German Rivera mc_dpl_offset = CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET; 488125e2bc1SJ. German Rivera #else 489125e2bc1SJ. German Rivera #error "CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET not defined" 490125e2bc1SJ. German Rivera #endif 491125e2bc1SJ. German Rivera 492125e2bc1SJ. German Rivera /* 493125e2bc1SJ. German Rivera * Load the MC DPL blob in the MC private DRAM block: 494125e2bc1SJ. German Rivera */ 495125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_DPL_IN_DDR 496125e2bc1SJ. German Rivera printf("MC DPL is preloaded to %#llx\n", mc_ram_addr + mc_dpl_offset); 497125e2bc1SJ. German Rivera #else 498125e2bc1SJ. German Rivera /* 499125e2bc1SJ. German Rivera * Get address and size of the DPL blob stored in flash: 500125e2bc1SJ. German Rivera */ 501fb4a87a7SPrabhakar Kushwaha dpl_fdt_hdr = (void *)mc_dpl_addr; 502125e2bc1SJ. German Rivera 503125e2bc1SJ. German Rivera error = fdt_check_header(dpl_fdt_hdr); 504125e2bc1SJ. German Rivera if (error != 0) { 505cc088c3aSJ. German Rivera printf("\nfsl-mc: ERROR: Bad DPL image (bad header)\n"); 506125e2bc1SJ. German Rivera return error; 507125e2bc1SJ. German Rivera } 508125e2bc1SJ. German Rivera 509125e2bc1SJ. German Rivera dpl_size = fdt_totalsize(dpl_fdt_hdr); 510125e2bc1SJ. German Rivera if (dpl_size > CONFIG_SYS_LS_MC_DPL_MAX_LENGTH) { 511cc088c3aSJ. German Rivera printf("\nfsl-mc: ERROR: Bad DPL image (too large: %d)\n", 512125e2bc1SJ. German Rivera dpl_size); 513125e2bc1SJ. German Rivera return -EINVAL; 514125e2bc1SJ. German Rivera } 515125e2bc1SJ. German Rivera 516125e2bc1SJ. German Rivera mc_copy_image("MC DPL blob", 517125e2bc1SJ. German Rivera (u64)dpl_fdt_hdr, dpl_size, mc_ram_addr + mc_dpl_offset); 518125e2bc1SJ. German Rivera #endif /* not defined CONFIG_SYS_LS_MC_DPL_IN_DDR */ 519125e2bc1SJ. German Rivera 5201161dbccSBogdan Purcareata if (mc_fixup_dpl(mc_ram_addr + mc_dpl_offset)) 5211161dbccSBogdan Purcareata return -EINVAL; 522125e2bc1SJ. German Rivera dump_ram_words("DPL", (void *)(mc_ram_addr + mc_dpl_offset)); 523125e2bc1SJ. German Rivera return 0; 524125e2bc1SJ. German Rivera } 525125e2bc1SJ. German Rivera 526125e2bc1SJ. German Rivera /** 527125e2bc1SJ. German Rivera * Return the MC boot timeout value in milliseconds 528125e2bc1SJ. German Rivera */ 529125e2bc1SJ. German Rivera static unsigned long get_mc_boot_timeout_ms(void) 530125e2bc1SJ. German Rivera { 531125e2bc1SJ. German Rivera unsigned long timeout_ms = CONFIG_SYS_LS_MC_BOOT_TIMEOUT_MS; 532125e2bc1SJ. German Rivera 53300caae6dSSimon Glass char *timeout_ms_env_var = env_get(MC_BOOT_TIMEOUT_ENV_VAR); 534125e2bc1SJ. German Rivera 535125e2bc1SJ. German Rivera if (timeout_ms_env_var) { 536125e2bc1SJ. German Rivera timeout_ms = simple_strtoul(timeout_ms_env_var, NULL, 10); 537125e2bc1SJ. German Rivera if (timeout_ms == 0) { 538125e2bc1SJ. German Rivera printf("fsl-mc: WARNING: Invalid value for \'" 539125e2bc1SJ. German Rivera MC_BOOT_TIMEOUT_ENV_VAR 540125e2bc1SJ. German Rivera "\' environment variable: %lu\n", 541125e2bc1SJ. German Rivera timeout_ms); 542125e2bc1SJ. German Rivera 543125e2bc1SJ. German Rivera timeout_ms = CONFIG_SYS_LS_MC_BOOT_TIMEOUT_MS; 544125e2bc1SJ. German Rivera } 545125e2bc1SJ. German Rivera } 546125e2bc1SJ. German Rivera 547125e2bc1SJ. German Rivera return timeout_ms; 548125e2bc1SJ. German Rivera } 549125e2bc1SJ. German Rivera 550fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET 5513c1d218aSYork Sun 5523c1d218aSYork Sun __weak bool soc_has_aiop(void) 5533c1d218aSYork Sun { 5543c1d218aSYork Sun return false; 5553c1d218aSYork Sun } 5563c1d218aSYork Sun 557fb4a87a7SPrabhakar Kushwaha static int load_mc_aiop_img(u64 aiop_fw_addr) 558c1000c12SJ. German Rivera { 559fb4a87a7SPrabhakar Kushwaha u64 mc_ram_addr = mc_get_dram_addr(); 560fb4a87a7SPrabhakar Kushwaha #ifndef CONFIG_SYS_LS_MC_DPC_IN_DDR 561c1000c12SJ. German Rivera void *aiop_img; 562fb4a87a7SPrabhakar Kushwaha #endif 563c1000c12SJ. German Rivera 5643c1d218aSYork Sun /* Check if AIOP is available */ 5653c1d218aSYork Sun if (!soc_has_aiop()) 5663c1d218aSYork Sun return -ENODEV; 567c1000c12SJ. German Rivera /* 568c1000c12SJ. German Rivera * Load the MC AIOP image in the MC private DRAM block: 569c1000c12SJ. German Rivera */ 570c1000c12SJ. German Rivera 571fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DPC_IN_DDR 572fb4a87a7SPrabhakar Kushwaha printf("MC AIOP is preloaded to %#llx\n", mc_ram_addr + 573fb4a87a7SPrabhakar Kushwaha CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET); 574fb4a87a7SPrabhakar Kushwaha #else 575fb4a87a7SPrabhakar Kushwaha aiop_img = (void *)aiop_fw_addr; 576c1000c12SJ. German Rivera mc_copy_image("MC AIOP image", 577c1000c12SJ. German Rivera (u64)aiop_img, CONFIG_SYS_LS_MC_AIOP_IMG_MAX_LENGTH, 578c1000c12SJ. German Rivera mc_ram_addr + CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET); 579fb4a87a7SPrabhakar Kushwaha #endif 580fb4a87a7SPrabhakar Kushwaha mc_aiop_applied = 0; 581c1000c12SJ. German Rivera 582c1000c12SJ. German Rivera return 0; 583c1000c12SJ. German Rivera } 584c1000c12SJ. German Rivera #endif 585fb4a87a7SPrabhakar Kushwaha 586125e2bc1SJ. German Rivera static int wait_for_mc(bool booting_mc, u32 *final_reg_gsr) 587125e2bc1SJ. German Rivera { 588125e2bc1SJ. German Rivera u32 reg_gsr; 589125e2bc1SJ. German Rivera u32 mc_fw_boot_status; 590125e2bc1SJ. German Rivera unsigned long timeout_ms = get_mc_boot_timeout_ms(); 591125e2bc1SJ. German Rivera struct mc_ccsr_registers __iomem *mc_ccsr_regs = MC_CCSR_BASE_ADDR; 592125e2bc1SJ. German Rivera 593125e2bc1SJ. German Rivera dmb(); 594125e2bc1SJ. German Rivera assert(timeout_ms > 0); 595125e2bc1SJ. German Rivera for (;;) { 596125e2bc1SJ. German Rivera udelay(1000); /* throttle polling */ 597125e2bc1SJ. German Rivera reg_gsr = in_le32(&mc_ccsr_regs->reg_gsr); 598125e2bc1SJ. German Rivera mc_fw_boot_status = (reg_gsr & GSR_FS_MASK); 599125e2bc1SJ. German Rivera if (mc_fw_boot_status & 0x1) 600125e2bc1SJ. German Rivera break; 601125e2bc1SJ. German Rivera 602125e2bc1SJ. German Rivera timeout_ms--; 603125e2bc1SJ. German Rivera if (timeout_ms == 0) 604125e2bc1SJ. German Rivera break; 605125e2bc1SJ. German Rivera } 606125e2bc1SJ. German Rivera 607125e2bc1SJ. German Rivera if (timeout_ms == 0) { 608cc088c3aSJ. German Rivera printf("ERROR: timeout\n"); 609125e2bc1SJ. German Rivera 610125e2bc1SJ. German Rivera /* TODO: Get an error status from an MC CCSR register */ 611125e2bc1SJ. German Rivera return -ETIMEDOUT; 612125e2bc1SJ. German Rivera } 613125e2bc1SJ. German Rivera 614125e2bc1SJ. German Rivera if (mc_fw_boot_status != 0x1) { 615125e2bc1SJ. German Rivera /* 616125e2bc1SJ. German Rivera * TODO: Identify critical errors from the GSR register's FS 617125e2bc1SJ. German Rivera * field and for those errors, set error to -ENODEV or other 618125e2bc1SJ. German Rivera * appropriate errno, so that the status property is set to 619125e2bc1SJ. German Rivera * failure in the fsl,dprc device tree node. 620125e2bc1SJ. German Rivera */ 621cc088c3aSJ. German Rivera printf("WARNING: Firmware returned an error (GSR: %#x)\n", 622125e2bc1SJ. German Rivera reg_gsr); 623125e2bc1SJ. German Rivera } else { 624cc088c3aSJ. German Rivera printf("SUCCESS\n"); 625125e2bc1SJ. German Rivera } 626cc088c3aSJ. German Rivera 627125e2bc1SJ. German Rivera 628125e2bc1SJ. German Rivera *final_reg_gsr = reg_gsr; 629125e2bc1SJ. German Rivera return 0; 630125e2bc1SJ. German Rivera } 6317b3bd9a7SJ. German Rivera 632fb4a87a7SPrabhakar Kushwaha int mc_init(u64 mc_fw_addr, u64 mc_dpc_addr) 6337b3bd9a7SJ. German Rivera { 6347b3bd9a7SJ. German Rivera int error = 0; 635a2a55e51SPrabhakar Kushwaha int portal_id = 0; 6367b3bd9a7SJ. German Rivera struct mc_ccsr_registers __iomem *mc_ccsr_regs = MC_CCSR_BASE_ADDR; 637fb4a87a7SPrabhakar Kushwaha u64 mc_ram_addr = mc_get_dram_addr(); 6387b3bd9a7SJ. German Rivera u32 reg_gsr; 639125e2bc1SJ. German Rivera u32 reg_mcfbalr; 640125e2bc1SJ. German Rivera #ifndef CONFIG_SYS_LS_MC_FW_IN_DDR 6417b3bd9a7SJ. German Rivera const void *raw_image_addr; 6427b3bd9a7SJ. German Rivera size_t raw_image_size = 0; 643125e2bc1SJ. German Rivera #endif 6447b3bd9a7SJ. German Rivera struct mc_version mc_ver_info; 645125e2bc1SJ. German Rivera u8 mc_ram_num_256mb_blocks; 646125e2bc1SJ. German Rivera size_t mc_ram_size = mc_get_dram_block_size(); 6477b3bd9a7SJ. German Rivera 648437858b6SYork Sun mc_ram_num_256mb_blocks = mc_ram_size / MC_RAM_SIZE_ALIGNMENT; 649437858b6SYork Sun if (mc_ram_num_256mb_blocks < 1 || mc_ram_num_256mb_blocks > 0xff) { 650437858b6SYork Sun error = -EINVAL; 651437858b6SYork Sun printf("fsl-mc: ERROR: invalid MC private RAM size (%lu)\n", 652437858b6SYork Sun mc_ram_size); 653125e2bc1SJ. German Rivera goto out; 654437858b6SYork Sun } 655125e2bc1SJ. German Rivera 6567b3bd9a7SJ. German Rivera /* 6577b3bd9a7SJ. German Rivera * Management Complex cores should be held at reset out of POR. 658a187559eSBin Meng * U-Boot should be the first software to touch MC. To be safe, 6597b3bd9a7SJ. German Rivera * we reset all cores again by setting GCR1 to 0. It doesn't do 6607b3bd9a7SJ. German Rivera * anything if they are held at reset. After we setup the firmware 6617b3bd9a7SJ. German Rivera * we kick off MC by deasserting the reset bit for core 0, and 6627b3bd9a7SJ. German Rivera * deasserting the reset bits for Command Portal Managers. 6637b3bd9a7SJ. German Rivera * The stop bits are not touched here. They are used to stop the 6647b3bd9a7SJ. German Rivera * cores when they are active. Setting stop bits doesn't stop the 6657b3bd9a7SJ. German Rivera * cores from fetching instructions when they are released from 6667b3bd9a7SJ. German Rivera * reset. 6677b3bd9a7SJ. German Rivera */ 6687b3bd9a7SJ. German Rivera out_le32(&mc_ccsr_regs->reg_gcr1, 0); 6697b3bd9a7SJ. German Rivera dmb(); 6707b3bd9a7SJ. German Rivera 671125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_FW_IN_DDR 672125e2bc1SJ. German Rivera printf("MC firmware is preloaded to %#llx\n", mc_ram_addr); 673125e2bc1SJ. German Rivera #else 674fb4a87a7SPrabhakar Kushwaha error = parse_mc_firmware_fit_image(mc_fw_addr, &raw_image_addr, 675fb4a87a7SPrabhakar Kushwaha &raw_image_size); 6767b3bd9a7SJ. German Rivera if (error != 0) 6777b3bd9a7SJ. German Rivera goto out; 6787b3bd9a7SJ. German Rivera /* 6797b3bd9a7SJ. German Rivera * Load the MC FW at the beginning of the MC private DRAM block: 6807b3bd9a7SJ. German Rivera */ 6817b3bd9a7SJ. German Rivera mc_copy_image("MC Firmware", 6827b3bd9a7SJ. German Rivera (u64)raw_image_addr, raw_image_size, mc_ram_addr); 6837b3bd9a7SJ. German Rivera #endif 684125e2bc1SJ. German Rivera dump_ram_words("firmware", (void *)mc_ram_addr); 6857b3bd9a7SJ. German Rivera 686fb4a87a7SPrabhakar Kushwaha error = load_mc_dpc(mc_ram_addr, mc_ram_size, mc_dpc_addr); 687125e2bc1SJ. German Rivera if (error != 0) 6887b3bd9a7SJ. German Rivera goto out; 6897b3bd9a7SJ. German Rivera 6907b3bd9a7SJ. German Rivera debug("mc_ccsr_regs %p\n", mc_ccsr_regs); 691125e2bc1SJ. German Rivera dump_mc_ccsr_regs(mc_ccsr_regs); 6927b3bd9a7SJ. German Rivera 6937b3bd9a7SJ. German Rivera /* 694125e2bc1SJ. German Rivera * Tell MC what is the address range of the DRAM block assigned to it: 6957b3bd9a7SJ. German Rivera */ 696437858b6SYork Sun reg_mcfbalr = (u32)mc_ram_addr | 697125e2bc1SJ. German Rivera (mc_ram_num_256mb_blocks - 1); 698125e2bc1SJ. German Rivera out_le32(&mc_ccsr_regs->reg_mcfbalr, reg_mcfbalr); 699125e2bc1SJ. German Rivera out_le32(&mc_ccsr_regs->reg_mcfbahr, 700437858b6SYork Sun (u32)(mc_ram_addr >> 32)); 70139da644eSStuart Yoder out_le32(&mc_ccsr_regs->reg_mcfapr, FSL_BYPASS_AMQ); 7027b3bd9a7SJ. German Rivera 7037b3bd9a7SJ. German Rivera /* 704125e2bc1SJ. German Rivera * Tell the MC that we want delayed DPL deployment. 7057b3bd9a7SJ. German Rivera */ 706125e2bc1SJ. German Rivera out_le32(&mc_ccsr_regs->reg_gsr, 0xDD00); 7077b3bd9a7SJ. German Rivera 708cc088c3aSJ. German Rivera printf("\nfsl-mc: Booting Management Complex ... "); 7097b3bd9a7SJ. German Rivera 7107b3bd9a7SJ. German Rivera /* 7117b3bd9a7SJ. German Rivera * Deassert reset and release MC core 0 to run 7127b3bd9a7SJ. German Rivera */ 7137b3bd9a7SJ. German Rivera out_le32(&mc_ccsr_regs->reg_gcr1, GCR1_P1_DE_RST | GCR1_M_ALL_DE_RST); 714125e2bc1SJ. German Rivera error = wait_for_mc(true, ®_gsr); 715125e2bc1SJ. German Rivera if (error != 0) 7167b3bd9a7SJ. German Rivera goto out; 7177b3bd9a7SJ. German Rivera 7187b3bd9a7SJ. German Rivera /* 7197b3bd9a7SJ. German Rivera * TODO: need to obtain the portal_id for the root container from the 7207b3bd9a7SJ. German Rivera * DPL 7217b3bd9a7SJ. German Rivera */ 7227b3bd9a7SJ. German Rivera portal_id = 0; 7237b3bd9a7SJ. German Rivera 7247b3bd9a7SJ. German Rivera /* 725a2a55e51SPrabhakar Kushwaha * Initialize the global default MC portal 726a2a55e51SPrabhakar Kushwaha * And check that the MC firmware is responding portal commands: 7277b3bd9a7SJ. German Rivera */ 728a572fb6bSPrabhakar Kushwaha root_mc_io = (struct fsl_mc_io *)calloc(sizeof(struct fsl_mc_io), 1); 7291730a17dSPrabhakar Kushwaha if (!root_mc_io) { 730a572fb6bSPrabhakar Kushwaha printf(" No memory: calloc() failed\n"); 731a2a55e51SPrabhakar Kushwaha return -ENOMEM; 732a2a55e51SPrabhakar Kushwaha } 7337b3bd9a7SJ. German Rivera 7341730a17dSPrabhakar Kushwaha root_mc_io->mmio_regs = SOC_MC_PORTAL_ADDR(portal_id); 735a2a55e51SPrabhakar Kushwaha debug("Checking access to MC portal of root DPRC container (portal_id %d, portal physical addr %p)\n", 7361730a17dSPrabhakar Kushwaha portal_id, root_mc_io->mmio_regs); 737a2a55e51SPrabhakar Kushwaha 7381730a17dSPrabhakar Kushwaha error = mc_get_version(root_mc_io, MC_CMD_NO_FLAGS, &mc_ver_info); 7397b3bd9a7SJ. German Rivera if (error != 0) { 7407b3bd9a7SJ. German Rivera printf("fsl-mc: ERROR: Firmware version check failed (error: %d)\n", 7417b3bd9a7SJ. German Rivera error); 7427b3bd9a7SJ. German Rivera goto out; 7437b3bd9a7SJ. German Rivera } 7447b3bd9a7SJ. German Rivera 7457b3bd9a7SJ. German Rivera printf("fsl-mc: Management Complex booted (version: %d.%d.%d, boot status: %#x)\n", 7467b3bd9a7SJ. German Rivera mc_ver_info.major, mc_ver_info.minor, mc_ver_info.revision, 747125e2bc1SJ. German Rivera reg_gsr & GSR_FS_MASK); 748125e2bc1SJ. German Rivera 7497b3bd9a7SJ. German Rivera out: 7507b3bd9a7SJ. German Rivera if (error != 0) 7512b7c4a19SPrabhakar Kushwaha mc_boot_status = error; 7527b3bd9a7SJ. German Rivera else 7537b3bd9a7SJ. German Rivera mc_boot_status = 0; 7547b3bd9a7SJ. German Rivera 7557b3bd9a7SJ. German Rivera return error; 7567b3bd9a7SJ. German Rivera } 7577b3bd9a7SJ. German Rivera 758fb4a87a7SPrabhakar Kushwaha int mc_apply_dpl(u64 mc_dpl_addr) 759fb4a87a7SPrabhakar Kushwaha { 760fb4a87a7SPrabhakar Kushwaha struct mc_ccsr_registers __iomem *mc_ccsr_regs = MC_CCSR_BASE_ADDR; 761fb4a87a7SPrabhakar Kushwaha int error = 0; 762fb4a87a7SPrabhakar Kushwaha u32 reg_gsr; 763fb4a87a7SPrabhakar Kushwaha u64 mc_ram_addr = mc_get_dram_addr(); 764fb4a87a7SPrabhakar Kushwaha size_t mc_ram_size = mc_get_dram_block_size(); 765fb4a87a7SPrabhakar Kushwaha 766b7b8410aSAlexander Graf if (!mc_dpl_addr) 767b7b8410aSAlexander Graf return -1; 768b7b8410aSAlexander Graf 769fb4a87a7SPrabhakar Kushwaha error = load_mc_dpl(mc_ram_addr, mc_ram_size, mc_dpl_addr); 770fb4a87a7SPrabhakar Kushwaha if (error != 0) 771fb4a87a7SPrabhakar Kushwaha return error; 772fb4a87a7SPrabhakar Kushwaha 773fb4a87a7SPrabhakar Kushwaha /* 774fb4a87a7SPrabhakar Kushwaha * Tell the MC to deploy the DPL: 775fb4a87a7SPrabhakar Kushwaha */ 776fb4a87a7SPrabhakar Kushwaha out_le32(&mc_ccsr_regs->reg_gsr, 0x0); 777fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: Deploying data path layout ... "); 778fb4a87a7SPrabhakar Kushwaha error = wait_for_mc(false, ®_gsr); 779fb4a87a7SPrabhakar Kushwaha 780fb4a87a7SPrabhakar Kushwaha if (!error) 781fb4a87a7SPrabhakar Kushwaha mc_dpl_applied = 0; 782fb4a87a7SPrabhakar Kushwaha 783fb4a87a7SPrabhakar Kushwaha return error; 784fb4a87a7SPrabhakar Kushwaha } 785fb4a87a7SPrabhakar Kushwaha 7867b3bd9a7SJ. German Rivera int get_mc_boot_status(void) 7877b3bd9a7SJ. German Rivera { 7887b3bd9a7SJ. German Rivera return mc_boot_status; 7897b3bd9a7SJ. German Rivera } 7907b3bd9a7SJ. German Rivera 791fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET 792fb4a87a7SPrabhakar Kushwaha int get_aiop_apply_status(void) 793fb4a87a7SPrabhakar Kushwaha { 794fb4a87a7SPrabhakar Kushwaha return mc_aiop_applied; 795fb4a87a7SPrabhakar Kushwaha } 796fb4a87a7SPrabhakar Kushwaha #endif 797fb4a87a7SPrabhakar Kushwaha 798fb4a87a7SPrabhakar Kushwaha int get_dpl_apply_status(void) 799fb4a87a7SPrabhakar Kushwaha { 800fb4a87a7SPrabhakar Kushwaha return mc_dpl_applied; 801fb4a87a7SPrabhakar Kushwaha } 802fb4a87a7SPrabhakar Kushwaha 803033c538eSPriyanka Jain /* 804fb4a87a7SPrabhakar Kushwaha * Return the MC address of private DRAM block. 805033c538eSPriyanka Jain * As per MC design document, MC initial base address 806033c538eSPriyanka Jain * should be least significant 512MB address of MC private 807033c538eSPriyanka Jain * memory, i.e. address should point to end address masked 808033c538eSPriyanka Jain * with 512MB offset in private DRAM block. 809fb4a87a7SPrabhakar Kushwaha */ 810fb4a87a7SPrabhakar Kushwaha u64 mc_get_dram_addr(void) 811fb4a87a7SPrabhakar Kushwaha { 812033c538eSPriyanka Jain size_t mc_ram_size = mc_get_dram_block_size(); 813033c538eSPriyanka Jain 814033c538eSPriyanka Jain return (gd->arch.resv_ram + mc_ram_size - 1) & 815033c538eSPriyanka Jain MC_RAM_BASE_ADDR_ALIGNMENT_MASK; 816fb4a87a7SPrabhakar Kushwaha } 817fb4a87a7SPrabhakar Kushwaha 8187b3bd9a7SJ. German Rivera /** 8197b3bd9a7SJ. German Rivera * Return the actual size of the MC private DRAM block. 8207b3bd9a7SJ. German Rivera */ 8217b3bd9a7SJ. German Rivera unsigned long mc_get_dram_block_size(void) 8227b3bd9a7SJ. German Rivera { 823125e2bc1SJ. German Rivera unsigned long dram_block_size = CONFIG_SYS_LS_MC_DRAM_BLOCK_MIN_SIZE; 824125e2bc1SJ. German Rivera 82500caae6dSSimon Glass char *dram_block_size_env_var = env_get(MC_MEM_SIZE_ENV_VAR); 826125e2bc1SJ. German Rivera 827125e2bc1SJ. German Rivera if (dram_block_size_env_var) { 828125e2bc1SJ. German Rivera dram_block_size = simple_strtoul(dram_block_size_env_var, NULL, 829f53e12d8SPrabhakar Kushwaha 16); 830125e2bc1SJ. German Rivera 831125e2bc1SJ. German Rivera if (dram_block_size < CONFIG_SYS_LS_MC_DRAM_BLOCK_MIN_SIZE) { 832125e2bc1SJ. German Rivera printf("fsl-mc: WARNING: Invalid value for \'" 833125e2bc1SJ. German Rivera MC_MEM_SIZE_ENV_VAR 834125e2bc1SJ. German Rivera "\' environment variable: %lu\n", 835125e2bc1SJ. German Rivera dram_block_size); 836125e2bc1SJ. German Rivera 837125e2bc1SJ. German Rivera dram_block_size = CONFIG_SYS_LS_MC_DRAM_BLOCK_MIN_SIZE; 838125e2bc1SJ. German Rivera } 839125e2bc1SJ. German Rivera } 840125e2bc1SJ. German Rivera 841125e2bc1SJ. German Rivera return dram_block_size; 8427b3bd9a7SJ. German Rivera } 843a2a55e51SPrabhakar Kushwaha 8441730a17dSPrabhakar Kushwaha int fsl_mc_ldpaa_init(bd_t *bis) 8451730a17dSPrabhakar Kushwaha { 846c919ab9eSPrabhakar Kushwaha int i; 847c919ab9eSPrabhakar Kushwaha 848c919ab9eSPrabhakar Kushwaha for (i = WRIOP1_DPMAC1; i < NUM_WRIOP_PORTS; i++) 849c919ab9eSPrabhakar Kushwaha if ((wriop_is_enabled_dpmac(i) == 1) && 850c919ab9eSPrabhakar Kushwaha (wriop_get_phy_address(i) != -1)) 851c919ab9eSPrabhakar Kushwaha ldpaa_eth_init(i, wriop_get_enet_if(i)); 8521730a17dSPrabhakar Kushwaha return 0; 8531730a17dSPrabhakar Kushwaha } 8541730a17dSPrabhakar Kushwaha 8559a696f56SPrabhakar Kushwaha static int dprc_version_check(struct fsl_mc_io *mc_io, uint16_t handle) 8569a696f56SPrabhakar Kushwaha { 8579a696f56SPrabhakar Kushwaha int error; 8582557c5a9SYogesh Gaur uint16_t major_ver, minor_ver; 8599a696f56SPrabhakar Kushwaha 8602557c5a9SYogesh Gaur error = dprc_get_api_version(mc_io, 0, 8612557c5a9SYogesh Gaur &major_ver, 8622557c5a9SYogesh Gaur &minor_ver); 8632557c5a9SYogesh Gaur if (error < 0) { 8642557c5a9SYogesh Gaur printf("dprc_get_api_version() failed: %d\n", error); 8652557c5a9SYogesh Gaur return error; 8662557c5a9SYogesh Gaur } 8672557c5a9SYogesh Gaur 8682557c5a9SYogesh Gaur if (major_ver < DPRC_VER_MAJOR || (major_ver == DPRC_VER_MAJOR && 8692557c5a9SYogesh Gaur minor_ver < DPRC_VER_MINOR)) { 8709a696f56SPrabhakar Kushwaha printf("DPRC version mismatch found %u.%u,", 8712557c5a9SYogesh Gaur major_ver, minor_ver); 8729a696f56SPrabhakar Kushwaha printf("supported version is %u.%u\n", 8739a696f56SPrabhakar Kushwaha DPRC_VER_MAJOR, DPRC_VER_MINOR); 8749a696f56SPrabhakar Kushwaha } 8752557c5a9SYogesh Gaur 8769a696f56SPrabhakar Kushwaha return error; 8779a696f56SPrabhakar Kushwaha } 8789a696f56SPrabhakar Kushwaha 8791730a17dSPrabhakar Kushwaha static int dpio_init(void) 880a2a55e51SPrabhakar Kushwaha { 881a2a55e51SPrabhakar Kushwaha struct qbman_swp_desc p_des; 882a2a55e51SPrabhakar Kushwaha struct dpio_attr attr; 8831730a17dSPrabhakar Kushwaha struct dpio_cfg dpio_cfg; 884a2a55e51SPrabhakar Kushwaha int err = 0; 8852557c5a9SYogesh Gaur uint16_t major_ver, minor_ver; 886a2a55e51SPrabhakar Kushwaha 887a572fb6bSPrabhakar Kushwaha dflt_dpio = (struct fsl_dpio_obj *)calloc( 888a572fb6bSPrabhakar Kushwaha sizeof(struct fsl_dpio_obj), 1); 889a2a55e51SPrabhakar Kushwaha if (!dflt_dpio) { 890a572fb6bSPrabhakar Kushwaha printf("No memory: calloc() failed\n"); 8911730a17dSPrabhakar Kushwaha err = -ENOMEM; 892a572fb6bSPrabhakar Kushwaha goto err_calloc; 893a2a55e51SPrabhakar Kushwaha } 8941730a17dSPrabhakar Kushwaha dpio_cfg.channel_mode = DPIO_LOCAL_CHANNEL; 8951730a17dSPrabhakar Kushwaha dpio_cfg.num_priorities = 8; 896a2a55e51SPrabhakar Kushwaha 8972557c5a9SYogesh Gaur err = dpio_create(dflt_mc_io, 8982557c5a9SYogesh Gaur dflt_dprc_handle, 8992557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 9002557c5a9SYogesh Gaur &dpio_cfg, 9012557c5a9SYogesh Gaur &dflt_dpio->dpio_id); 9021730a17dSPrabhakar Kushwaha if (err < 0) { 9031730a17dSPrabhakar Kushwaha printf("dpio_create() failed: %d\n", err); 9041730a17dSPrabhakar Kushwaha err = -ENODEV; 9051730a17dSPrabhakar Kushwaha goto err_create; 906a2a55e51SPrabhakar Kushwaha } 907a2a55e51SPrabhakar Kushwaha 9082557c5a9SYogesh Gaur err = dpio_get_api_version(dflt_mc_io, 0, 9092557c5a9SYogesh Gaur &major_ver, 9102557c5a9SYogesh Gaur &minor_ver); 9112557c5a9SYogesh Gaur if (err < 0) { 9122557c5a9SYogesh Gaur printf("dpio_get_api_version() failed: %d\n", err); 9132557c5a9SYogesh Gaur goto err_get_api_ver; 9142557c5a9SYogesh Gaur } 9152557c5a9SYogesh Gaur 9162557c5a9SYogesh Gaur if (major_ver < DPIO_VER_MAJOR || (major_ver == DPIO_VER_MAJOR && 9172557c5a9SYogesh Gaur minor_ver < DPIO_VER_MINOR)) { 9182557c5a9SYogesh Gaur printf("DPRC version mismatch found %u.%u,", 9192557c5a9SYogesh Gaur major_ver, 9202557c5a9SYogesh Gaur minor_ver); 9212557c5a9SYogesh Gaur } 9222557c5a9SYogesh Gaur 9232557c5a9SYogesh Gaur err = dpio_open(dflt_mc_io, 9242557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 9252557c5a9SYogesh Gaur dflt_dpio->dpio_id, 9262557c5a9SYogesh Gaur &dflt_dpio->dpio_handle); 9272557c5a9SYogesh Gaur if (err) { 9282557c5a9SYogesh Gaur printf("dpio_open() failed\n"); 9292557c5a9SYogesh Gaur goto err_open; 9302557c5a9SYogesh Gaur } 9312557c5a9SYogesh Gaur 9321730a17dSPrabhakar Kushwaha memset(&attr, 0, sizeof(struct dpio_attr)); 93387457d11SPrabhakar Kushwaha err = dpio_get_attributes(dflt_mc_io, MC_CMD_NO_FLAGS, 9341730a17dSPrabhakar Kushwaha dflt_dpio->dpio_handle, &attr); 9351730a17dSPrabhakar Kushwaha if (err < 0) { 9361730a17dSPrabhakar Kushwaha printf("dpio_get_attributes() failed: %d\n", err); 937a2a55e51SPrabhakar Kushwaha goto err_get_attr; 938a2a55e51SPrabhakar Kushwaha } 939a2a55e51SPrabhakar Kushwaha 9402557c5a9SYogesh Gaur if (dflt_dpio->dpio_id != attr.id) { 9412557c5a9SYogesh Gaur printf("dnpi object id and attribute id are not same\n"); 9422557c5a9SYogesh Gaur goto err_attr_not_same; 9439a696f56SPrabhakar Kushwaha } 9449a696f56SPrabhakar Kushwaha 9451730a17dSPrabhakar Kushwaha #ifdef DEBUG 9461730a17dSPrabhakar Kushwaha printf("Init: DPIO id=0x%d\n", dflt_dpio->dpio_id); 9471730a17dSPrabhakar Kushwaha #endif 9481730a17dSPrabhakar Kushwaha err = dpio_enable(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle); 9491730a17dSPrabhakar Kushwaha if (err < 0) { 950a2a55e51SPrabhakar Kushwaha printf("dpio_enable() failed %d\n", err); 951a2a55e51SPrabhakar Kushwaha goto err_get_enable; 952a2a55e51SPrabhakar Kushwaha } 9531f1c25c7SPrabhakar Kushwaha debug("ce_offset=0x%llx, ci_offset=0x%llx, portalid=%d, prios=%d\n", 9541f1c25c7SPrabhakar Kushwaha attr.qbman_portal_ce_offset, 9551f1c25c7SPrabhakar Kushwaha attr.qbman_portal_ci_offset, 956a2a55e51SPrabhakar Kushwaha attr.qbman_portal_id, 957a2a55e51SPrabhakar Kushwaha attr.num_priorities); 958a2a55e51SPrabhakar Kushwaha 9591f1c25c7SPrabhakar Kushwaha p_des.cena_bar = (void *)(SOC_QBMAN_PORTALS_BASE_ADDR 9601f1c25c7SPrabhakar Kushwaha + attr.qbman_portal_ce_offset); 9611f1c25c7SPrabhakar Kushwaha p_des.cinh_bar = (void *)(SOC_QBMAN_PORTALS_BASE_ADDR 9621f1c25c7SPrabhakar Kushwaha + attr.qbman_portal_ci_offset); 963a2a55e51SPrabhakar Kushwaha 964a2a55e51SPrabhakar Kushwaha dflt_dpio->sw_portal = qbman_swp_init(&p_des); 965a2a55e51SPrabhakar Kushwaha if (dflt_dpio->sw_portal == NULL) { 966a2a55e51SPrabhakar Kushwaha printf("qbman_swp_init() failed\n"); 967a2a55e51SPrabhakar Kushwaha goto err_get_swp_init; 968a2a55e51SPrabhakar Kushwaha } 969a2a55e51SPrabhakar Kushwaha return 0; 970a2a55e51SPrabhakar Kushwaha 971a2a55e51SPrabhakar Kushwaha err_get_swp_init: 9721730a17dSPrabhakar Kushwaha dpio_disable(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle); 973a2a55e51SPrabhakar Kushwaha err_get_enable: 9741730a17dSPrabhakar Kushwaha err_get_attr: 9752557c5a9SYogesh Gaur err_attr_not_same: 9761730a17dSPrabhakar Kushwaha dpio_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle); 9772557c5a9SYogesh Gaur err_open: 9782557c5a9SYogesh Gaur err_get_api_ver: 9792557c5a9SYogesh Gaur dpio_destroy(dflt_mc_io, 9802557c5a9SYogesh Gaur dflt_dprc_handle, 9812557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 9822557c5a9SYogesh Gaur dflt_dpio->dpio_id); 9831730a17dSPrabhakar Kushwaha err_create: 984cd7b3fbcSPrabhakar Kushwaha free(dflt_dpio); 985a572fb6bSPrabhakar Kushwaha err_calloc: 986a2a55e51SPrabhakar Kushwaha return err; 987a2a55e51SPrabhakar Kushwaha } 988a2a55e51SPrabhakar Kushwaha 9891730a17dSPrabhakar Kushwaha static int dpio_exit(void) 990a2a55e51SPrabhakar Kushwaha { 9911730a17dSPrabhakar Kushwaha int err; 9921730a17dSPrabhakar Kushwaha 9931730a17dSPrabhakar Kushwaha err = dpio_disable(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle); 9941730a17dSPrabhakar Kushwaha if (err < 0) { 9951730a17dSPrabhakar Kushwaha printf("dpio_disable() failed: %d\n", err); 9961730a17dSPrabhakar Kushwaha goto err; 9971730a17dSPrabhakar Kushwaha } 9981730a17dSPrabhakar Kushwaha 9992557c5a9SYogesh Gaur dpio_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle); 10002557c5a9SYogesh Gaur if (err < 0) { 10012557c5a9SYogesh Gaur printf("dpio_close() failed: %d\n", err); 10022557c5a9SYogesh Gaur goto err; 10032557c5a9SYogesh Gaur } 10042557c5a9SYogesh Gaur 10052557c5a9SYogesh Gaur err = dpio_destroy(dflt_mc_io, 10062557c5a9SYogesh Gaur dflt_dprc_handle, 10072557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 10082557c5a9SYogesh Gaur dflt_dpio->dpio_id); 10091730a17dSPrabhakar Kushwaha if (err < 0) { 10101730a17dSPrabhakar Kushwaha printf("dpio_destroy() failed: %d\n", err); 10111730a17dSPrabhakar Kushwaha goto err; 10121730a17dSPrabhakar Kushwaha } 10131730a17dSPrabhakar Kushwaha 10141730a17dSPrabhakar Kushwaha #ifdef DEBUG 10151730a17dSPrabhakar Kushwaha printf("Exit: DPIO id=0x%d\n", dflt_dpio->dpio_id); 10161730a17dSPrabhakar Kushwaha #endif 10171730a17dSPrabhakar Kushwaha 10181730a17dSPrabhakar Kushwaha if (dflt_dpio) 10191730a17dSPrabhakar Kushwaha free(dflt_dpio); 10201730a17dSPrabhakar Kushwaha 10211730a17dSPrabhakar Kushwaha return 0; 10221730a17dSPrabhakar Kushwaha err: 10231730a17dSPrabhakar Kushwaha return err; 10241730a17dSPrabhakar Kushwaha } 10251730a17dSPrabhakar Kushwaha 10261730a17dSPrabhakar Kushwaha static int dprc_init(void) 10271730a17dSPrabhakar Kushwaha { 10281730a17dSPrabhakar Kushwaha int err, child_portal_id, container_id; 10291730a17dSPrabhakar Kushwaha struct dprc_cfg cfg; 10301730a17dSPrabhakar Kushwaha uint64_t mc_portal_offset; 10311730a17dSPrabhakar Kushwaha 10321730a17dSPrabhakar Kushwaha /* Open root container */ 10331730a17dSPrabhakar Kushwaha err = dprc_get_container_id(root_mc_io, MC_CMD_NO_FLAGS, &container_id); 10341730a17dSPrabhakar Kushwaha if (err < 0) { 10351730a17dSPrabhakar Kushwaha printf("dprc_get_container_id(): Root failed: %d\n", err); 10361730a17dSPrabhakar Kushwaha goto err_root_container_id; 10371730a17dSPrabhakar Kushwaha } 10381730a17dSPrabhakar Kushwaha 10391730a17dSPrabhakar Kushwaha #ifdef DEBUG 10401730a17dSPrabhakar Kushwaha printf("Root container id = %d\n", container_id); 10411730a17dSPrabhakar Kushwaha #endif 10421730a17dSPrabhakar Kushwaha err = dprc_open(root_mc_io, MC_CMD_NO_FLAGS, container_id, 10431730a17dSPrabhakar Kushwaha &root_dprc_handle); 10441730a17dSPrabhakar Kushwaha if (err < 0) { 10451730a17dSPrabhakar Kushwaha printf("dprc_open(): Root Container failed: %d\n", err); 10461730a17dSPrabhakar Kushwaha goto err_root_open; 10471730a17dSPrabhakar Kushwaha } 10481730a17dSPrabhakar Kushwaha 10491730a17dSPrabhakar Kushwaha if (!root_dprc_handle) { 10501730a17dSPrabhakar Kushwaha printf("dprc_open(): Root Container Handle is not valid\n"); 10511730a17dSPrabhakar Kushwaha goto err_root_open; 10521730a17dSPrabhakar Kushwaha } 10531730a17dSPrabhakar Kushwaha 10549a696f56SPrabhakar Kushwaha err = dprc_version_check(root_mc_io, root_dprc_handle); 10559a696f56SPrabhakar Kushwaha if (err < 0) { 10569a696f56SPrabhakar Kushwaha printf("dprc_version_check() failed: %d\n", err); 10579a696f56SPrabhakar Kushwaha goto err_root_open; 10589a696f56SPrabhakar Kushwaha } 10599a696f56SPrabhakar Kushwaha 10605373b204SPrabhakar Kushwaha memset(&cfg, 0, sizeof(struct dprc_cfg)); 10611730a17dSPrabhakar Kushwaha cfg.options = DPRC_CFG_OPT_TOPOLOGY_CHANGES_ALLOWED | 10621730a17dSPrabhakar Kushwaha DPRC_CFG_OPT_OBJ_CREATE_ALLOWED | 10631730a17dSPrabhakar Kushwaha DPRC_CFG_OPT_ALLOC_ALLOWED; 10641730a17dSPrabhakar Kushwaha cfg.icid = DPRC_GET_ICID_FROM_POOL; 1065335b1936SPrabhakar Kushwaha cfg.portal_id = DPRC_GET_PORTAL_ID_FROM_POOL; 10661730a17dSPrabhakar Kushwaha err = dprc_create_container(root_mc_io, MC_CMD_NO_FLAGS, 10671730a17dSPrabhakar Kushwaha root_dprc_handle, 10681730a17dSPrabhakar Kushwaha &cfg, 10691730a17dSPrabhakar Kushwaha &child_dprc_id, 10701730a17dSPrabhakar Kushwaha &mc_portal_offset); 10711730a17dSPrabhakar Kushwaha if (err < 0) { 10721730a17dSPrabhakar Kushwaha printf("dprc_create_container() failed: %d\n", err); 10731730a17dSPrabhakar Kushwaha goto err_create; 10741730a17dSPrabhakar Kushwaha } 10751730a17dSPrabhakar Kushwaha 1076a572fb6bSPrabhakar Kushwaha dflt_mc_io = (struct fsl_mc_io *)calloc(sizeof(struct fsl_mc_io), 1); 10771730a17dSPrabhakar Kushwaha if (!dflt_mc_io) { 10781730a17dSPrabhakar Kushwaha err = -ENOMEM; 1079a572fb6bSPrabhakar Kushwaha printf(" No memory: calloc() failed\n"); 1080a572fb6bSPrabhakar Kushwaha goto err_calloc; 10811730a17dSPrabhakar Kushwaha } 10821730a17dSPrabhakar Kushwaha 10831730a17dSPrabhakar Kushwaha child_portal_id = MC_PORTAL_OFFSET_TO_PORTAL_ID(mc_portal_offset); 10841730a17dSPrabhakar Kushwaha dflt_mc_io->mmio_regs = SOC_MC_PORTAL_ADDR(child_portal_id); 10852557c5a9SYogesh Gaur 10861730a17dSPrabhakar Kushwaha #ifdef DEBUG 10871730a17dSPrabhakar Kushwaha printf("MC portal of child DPRC container: %d, physical addr %p)\n", 10881730a17dSPrabhakar Kushwaha child_dprc_id, dflt_mc_io->mmio_regs); 10891730a17dSPrabhakar Kushwaha #endif 10901730a17dSPrabhakar Kushwaha 10911730a17dSPrabhakar Kushwaha err = dprc_open(dflt_mc_io, MC_CMD_NO_FLAGS, child_dprc_id, 10921730a17dSPrabhakar Kushwaha &dflt_dprc_handle); 10931730a17dSPrabhakar Kushwaha if (err < 0) { 10941730a17dSPrabhakar Kushwaha printf("dprc_open(): Child container failed: %d\n", err); 10951730a17dSPrabhakar Kushwaha goto err_child_open; 10961730a17dSPrabhakar Kushwaha } 10971730a17dSPrabhakar Kushwaha 10981730a17dSPrabhakar Kushwaha if (!dflt_dprc_handle) { 10991730a17dSPrabhakar Kushwaha printf("dprc_open(): Child container Handle is not valid\n"); 11001730a17dSPrabhakar Kushwaha goto err_child_open; 11011730a17dSPrabhakar Kushwaha } 11021730a17dSPrabhakar Kushwaha 11031730a17dSPrabhakar Kushwaha return 0; 11041730a17dSPrabhakar Kushwaha err_child_open: 11051730a17dSPrabhakar Kushwaha free(dflt_mc_io); 1106a572fb6bSPrabhakar Kushwaha err_calloc: 11071730a17dSPrabhakar Kushwaha dprc_destroy_container(root_mc_io, MC_CMD_NO_FLAGS, 11081730a17dSPrabhakar Kushwaha root_dprc_handle, child_dprc_id); 11091730a17dSPrabhakar Kushwaha err_create: 11101730a17dSPrabhakar Kushwaha dprc_close(root_mc_io, MC_CMD_NO_FLAGS, root_dprc_handle); 11111730a17dSPrabhakar Kushwaha err_root_open: 11121730a17dSPrabhakar Kushwaha err_root_container_id: 11131730a17dSPrabhakar Kushwaha return err; 11141730a17dSPrabhakar Kushwaha } 11151730a17dSPrabhakar Kushwaha 11161730a17dSPrabhakar Kushwaha static int dprc_exit(void) 11171730a17dSPrabhakar Kushwaha { 11181730a17dSPrabhakar Kushwaha int err; 11191730a17dSPrabhakar Kushwaha 11201730a17dSPrabhakar Kushwaha err = dprc_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dprc_handle); 11211730a17dSPrabhakar Kushwaha if (err < 0) { 11221730a17dSPrabhakar Kushwaha printf("dprc_close(): Child failed: %d\n", err); 11231730a17dSPrabhakar Kushwaha goto err; 11241730a17dSPrabhakar Kushwaha } 11251730a17dSPrabhakar Kushwaha 11261730a17dSPrabhakar Kushwaha err = dprc_destroy_container(root_mc_io, MC_CMD_NO_FLAGS, 11271730a17dSPrabhakar Kushwaha root_dprc_handle, child_dprc_id); 11281730a17dSPrabhakar Kushwaha if (err < 0) { 11291730a17dSPrabhakar Kushwaha printf("dprc_destroy_container() failed: %d\n", err); 11301730a17dSPrabhakar Kushwaha goto err; 11311730a17dSPrabhakar Kushwaha } 11321730a17dSPrabhakar Kushwaha 11331730a17dSPrabhakar Kushwaha err = dprc_close(root_mc_io, MC_CMD_NO_FLAGS, root_dprc_handle); 11341730a17dSPrabhakar Kushwaha if (err < 0) { 11351730a17dSPrabhakar Kushwaha printf("dprc_close(): Root failed: %d\n", err); 11361730a17dSPrabhakar Kushwaha goto err; 11371730a17dSPrabhakar Kushwaha } 11381730a17dSPrabhakar Kushwaha 11391730a17dSPrabhakar Kushwaha if (dflt_mc_io) 11401730a17dSPrabhakar Kushwaha free(dflt_mc_io); 11411730a17dSPrabhakar Kushwaha 11421730a17dSPrabhakar Kushwaha if (root_mc_io) 11431730a17dSPrabhakar Kushwaha free(root_mc_io); 11441730a17dSPrabhakar Kushwaha 11451730a17dSPrabhakar Kushwaha return 0; 11461730a17dSPrabhakar Kushwaha 11471730a17dSPrabhakar Kushwaha err: 11481730a17dSPrabhakar Kushwaha return err; 11491730a17dSPrabhakar Kushwaha } 11501730a17dSPrabhakar Kushwaha 11511730a17dSPrabhakar Kushwaha static int dpbp_init(void) 11521730a17dSPrabhakar Kushwaha { 11531730a17dSPrabhakar Kushwaha int err; 11541730a17dSPrabhakar Kushwaha struct dpbp_attr dpbp_attr; 11551730a17dSPrabhakar Kushwaha struct dpbp_cfg dpbp_cfg; 11562557c5a9SYogesh Gaur uint16_t major_ver, minor_ver; 11571730a17dSPrabhakar Kushwaha 1158a572fb6bSPrabhakar Kushwaha dflt_dpbp = (struct fsl_dpbp_obj *)calloc( 1159a572fb6bSPrabhakar Kushwaha sizeof(struct fsl_dpbp_obj), 1); 1160a2a55e51SPrabhakar Kushwaha if (!dflt_dpbp) { 1161a572fb6bSPrabhakar Kushwaha printf("No memory: calloc() failed\n"); 11621730a17dSPrabhakar Kushwaha err = -ENOMEM; 1163a572fb6bSPrabhakar Kushwaha goto err_calloc; 1164a2a55e51SPrabhakar Kushwaha } 11651730a17dSPrabhakar Kushwaha 11661730a17dSPrabhakar Kushwaha dpbp_cfg.options = 512; 11671730a17dSPrabhakar Kushwaha 11682557c5a9SYogesh Gaur err = dpbp_create(dflt_mc_io, 11692557c5a9SYogesh Gaur dflt_dprc_handle, 11702557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 11712557c5a9SYogesh Gaur &dpbp_cfg, 11722557c5a9SYogesh Gaur &dflt_dpbp->dpbp_id); 11731730a17dSPrabhakar Kushwaha 11741730a17dSPrabhakar Kushwaha if (err < 0) { 11751730a17dSPrabhakar Kushwaha err = -ENODEV; 11761730a17dSPrabhakar Kushwaha printf("dpbp_create() failed: %d\n", err); 11771730a17dSPrabhakar Kushwaha goto err_create; 11781730a17dSPrabhakar Kushwaha } 11791730a17dSPrabhakar Kushwaha 11802557c5a9SYogesh Gaur err = dpbp_get_api_version(dflt_mc_io, 0, 11812557c5a9SYogesh Gaur &major_ver, 11822557c5a9SYogesh Gaur &minor_ver); 11832557c5a9SYogesh Gaur if (err < 0) { 11842557c5a9SYogesh Gaur printf("dpbp_get_api_version() failed: %d\n", err); 11852557c5a9SYogesh Gaur goto err_get_api_ver; 11862557c5a9SYogesh Gaur } 11872557c5a9SYogesh Gaur 11882557c5a9SYogesh Gaur if (major_ver < DPBP_VER_MAJOR || (major_ver == DPBP_VER_MAJOR && 11892557c5a9SYogesh Gaur minor_ver < DPBP_VER_MINOR)) { 11902557c5a9SYogesh Gaur printf("DPBP version mismatch found %u.%u,", 11912557c5a9SYogesh Gaur major_ver, minor_ver); 11922557c5a9SYogesh Gaur printf("supported version is %u.%u\n", 11932557c5a9SYogesh Gaur DPBP_VER_MAJOR, DPBP_VER_MINOR); 11942557c5a9SYogesh Gaur } 11952557c5a9SYogesh Gaur 11962557c5a9SYogesh Gaur err = dpbp_open(dflt_mc_io, 11972557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 11982557c5a9SYogesh Gaur dflt_dpbp->dpbp_id, 11992557c5a9SYogesh Gaur &dflt_dpbp->dpbp_handle); 12002557c5a9SYogesh Gaur if (err) { 12012557c5a9SYogesh Gaur printf("dpbp_open() failed\n"); 12022557c5a9SYogesh Gaur goto err_open; 12032557c5a9SYogesh Gaur } 12042557c5a9SYogesh Gaur 12051730a17dSPrabhakar Kushwaha memset(&dpbp_attr, 0, sizeof(struct dpbp_attr)); 12061730a17dSPrabhakar Kushwaha err = dpbp_get_attributes(dflt_mc_io, MC_CMD_NO_FLAGS, 12071730a17dSPrabhakar Kushwaha dflt_dpbp->dpbp_handle, 12081730a17dSPrabhakar Kushwaha &dpbp_attr); 12091730a17dSPrabhakar Kushwaha if (err < 0) { 12101730a17dSPrabhakar Kushwaha printf("dpbp_get_attributes() failed: %d\n", err); 12111730a17dSPrabhakar Kushwaha goto err_get_attr; 12121730a17dSPrabhakar Kushwaha } 12131730a17dSPrabhakar Kushwaha 12142557c5a9SYogesh Gaur if (dflt_dpbp->dpbp_id != dpbp_attr.id) { 12152557c5a9SYogesh Gaur printf("dpbp object id and attribute id are not same\n"); 12162557c5a9SYogesh Gaur goto err_attr_not_same; 12179a696f56SPrabhakar Kushwaha } 12189a696f56SPrabhakar Kushwaha 12191730a17dSPrabhakar Kushwaha #ifdef DEBUG 12202557c5a9SYogesh Gaur printf("Init: DPBP id=0x%x\n", dflt_dpbp->dpbp_attr.id); 12211730a17dSPrabhakar Kushwaha #endif 12221730a17dSPrabhakar Kushwaha 12231730a17dSPrabhakar Kushwaha err = dpbp_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpbp->dpbp_handle); 12241730a17dSPrabhakar Kushwaha if (err < 0) { 12251730a17dSPrabhakar Kushwaha printf("dpbp_close() failed: %d\n", err); 12261730a17dSPrabhakar Kushwaha goto err_close; 12271730a17dSPrabhakar Kushwaha } 1228a2a55e51SPrabhakar Kushwaha 1229a2a55e51SPrabhakar Kushwaha return 0; 12301730a17dSPrabhakar Kushwaha 12311730a17dSPrabhakar Kushwaha err_get_attr: 12322557c5a9SYogesh Gaur err_attr_not_same: 12331730a17dSPrabhakar Kushwaha dpbp_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpbp->dpbp_handle); 12342557c5a9SYogesh Gaur dpbp_destroy(dflt_mc_io, 12352557c5a9SYogesh Gaur dflt_dprc_handle, 12362557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 12372557c5a9SYogesh Gaur dflt_dpbp->dpbp_id); 12382557c5a9SYogesh Gaur err_get_api_ver: 12392557c5a9SYogesh Gaur err_close: 12402557c5a9SYogesh Gaur err_open: 12411730a17dSPrabhakar Kushwaha err_create: 12422557c5a9SYogesh Gaur free(dflt_dpbp); 1243a572fb6bSPrabhakar Kushwaha err_calloc: 12441730a17dSPrabhakar Kushwaha return err; 1245a2a55e51SPrabhakar Kushwaha } 1246a2a55e51SPrabhakar Kushwaha 12471730a17dSPrabhakar Kushwaha static int dpbp_exit(void) 1248a2a55e51SPrabhakar Kushwaha { 12491730a17dSPrabhakar Kushwaha int err; 12501730a17dSPrabhakar Kushwaha 12512557c5a9SYogesh Gaur err = dpbp_destroy(dflt_mc_io, dflt_dprc_handle, MC_CMD_NO_FLAGS, 12522557c5a9SYogesh Gaur dflt_dpbp->dpbp_id); 12531730a17dSPrabhakar Kushwaha if (err < 0) { 12541730a17dSPrabhakar Kushwaha printf("dpbp_destroy() failed: %d\n", err); 12551730a17dSPrabhakar Kushwaha goto err; 12561730a17dSPrabhakar Kushwaha } 12571730a17dSPrabhakar Kushwaha 12581730a17dSPrabhakar Kushwaha #ifdef DEBUG 12591730a17dSPrabhakar Kushwaha printf("Exit: DPBP id=0x%d\n", dflt_dpbp->dpbp_attr.id); 12601730a17dSPrabhakar Kushwaha #endif 12611730a17dSPrabhakar Kushwaha 12621730a17dSPrabhakar Kushwaha if (dflt_dpbp) 12631730a17dSPrabhakar Kushwaha free(dflt_dpbp); 12641730a17dSPrabhakar Kushwaha return 0; 12651730a17dSPrabhakar Kushwaha 12661730a17dSPrabhakar Kushwaha err: 12671730a17dSPrabhakar Kushwaha return err; 12681730a17dSPrabhakar Kushwaha } 12691730a17dSPrabhakar Kushwaha 12701730a17dSPrabhakar Kushwaha static int dpni_init(void) 12711730a17dSPrabhakar Kushwaha { 12721730a17dSPrabhakar Kushwaha int err; 12732557c5a9SYogesh Gaur uint8_t cfg_buf[256] = {0}; 12741730a17dSPrabhakar Kushwaha struct dpni_cfg dpni_cfg; 12752557c5a9SYogesh Gaur uint16_t major_ver, minor_ver; 12761730a17dSPrabhakar Kushwaha 1277a572fb6bSPrabhakar Kushwaha dflt_dpni = (struct fsl_dpni_obj *)calloc( 1278a572fb6bSPrabhakar Kushwaha sizeof(struct fsl_dpni_obj), 1); 12791730a17dSPrabhakar Kushwaha if (!dflt_dpni) { 1280a572fb6bSPrabhakar Kushwaha printf("No memory: calloc() failed\n"); 12811730a17dSPrabhakar Kushwaha err = -ENOMEM; 1282a572fb6bSPrabhakar Kushwaha goto err_calloc; 12831730a17dSPrabhakar Kushwaha } 12841730a17dSPrabhakar Kushwaha 12852557c5a9SYogesh Gaur memset(&dpni_cfg, 0, sizeof(dpni_cfg)); 12862557c5a9SYogesh Gaur err = dpni_prepare_cfg(&dpni_cfg, &cfg_buf[0]); 1287879a59acSPrabhakar Kushwaha if (err < 0) { 1288879a59acSPrabhakar Kushwaha err = -ENODEV; 12892557c5a9SYogesh Gaur printf("dpni_prepare_cfg() failed: %d\n", err); 12902557c5a9SYogesh Gaur goto err_prepare_cfg; 1291879a59acSPrabhakar Kushwaha } 1292879a59acSPrabhakar Kushwaha 12932557c5a9SYogesh Gaur err = dpni_create(dflt_mc_io, 12942557c5a9SYogesh Gaur dflt_dprc_handle, 12952557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 12962557c5a9SYogesh Gaur &dpni_cfg, 12972557c5a9SYogesh Gaur &dflt_dpni->dpni_id); 12981730a17dSPrabhakar Kushwaha if (err < 0) { 12991730a17dSPrabhakar Kushwaha err = -ENODEV; 13002557c5a9SYogesh Gaur printf("dpni create() failed: %d\n", err); 13011730a17dSPrabhakar Kushwaha goto err_create; 13021730a17dSPrabhakar Kushwaha } 13031730a17dSPrabhakar Kushwaha 13042557c5a9SYogesh Gaur err = dpni_get_api_version(dflt_mc_io, 0, 13052557c5a9SYogesh Gaur &major_ver, 13062557c5a9SYogesh Gaur &minor_ver); 13071730a17dSPrabhakar Kushwaha if (err < 0) { 13082557c5a9SYogesh Gaur printf("dpni_get_api_version() failed: %d\n", err); 13092557c5a9SYogesh Gaur goto err_get_version; 13101730a17dSPrabhakar Kushwaha } 13111730a17dSPrabhakar Kushwaha 13122557c5a9SYogesh Gaur if (major_ver < DPNI_VER_MAJOR || (major_ver == DPNI_VER_MAJOR && 13132557c5a9SYogesh Gaur minor_ver < DPNI_VER_MINOR)) { 13149a696f56SPrabhakar Kushwaha printf("DPNI version mismatch found %u.%u,", 13152557c5a9SYogesh Gaur major_ver, minor_ver); 13169a696f56SPrabhakar Kushwaha printf("supported version is %u.%u\n", 13179a696f56SPrabhakar Kushwaha DPNI_VER_MAJOR, DPNI_VER_MINOR); 13189a696f56SPrabhakar Kushwaha } 13199a696f56SPrabhakar Kushwaha 13202557c5a9SYogesh Gaur err = dpni_open(dflt_mc_io, 13212557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 13222557c5a9SYogesh Gaur dflt_dpni->dpni_id, 13232557c5a9SYogesh Gaur &dflt_dpni->dpni_handle); 13242557c5a9SYogesh Gaur if (err) { 13252557c5a9SYogesh Gaur printf("dpni_open() failed\n"); 13262557c5a9SYogesh Gaur goto err_open; 13272557c5a9SYogesh Gaur } 13282557c5a9SYogesh Gaur 13291730a17dSPrabhakar Kushwaha #ifdef DEBUG 13301730a17dSPrabhakar Kushwaha printf("Init: DPNI id=0x%d\n", dflt_dpni->dpni_id); 13311730a17dSPrabhakar Kushwaha #endif 13321730a17dSPrabhakar Kushwaha err = dpni_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpni->dpni_handle); 13331730a17dSPrabhakar Kushwaha if (err < 0) { 13341730a17dSPrabhakar Kushwaha printf("dpni_close() failed: %d\n", err); 13351730a17dSPrabhakar Kushwaha goto err_close; 13361730a17dSPrabhakar Kushwaha } 1337a2a55e51SPrabhakar Kushwaha 1338fb4a87a7SPrabhakar Kushwaha return 0; 13391730a17dSPrabhakar Kushwaha 13401730a17dSPrabhakar Kushwaha err_close: 13411730a17dSPrabhakar Kushwaha dpni_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpni->dpni_handle); 13422557c5a9SYogesh Gaur err_open: 13432557c5a9SYogesh Gaur err_get_version: 13442557c5a9SYogesh Gaur dpni_destroy(dflt_mc_io, 13452557c5a9SYogesh Gaur dflt_dprc_handle, 13462557c5a9SYogesh Gaur MC_CMD_NO_FLAGS, 13472557c5a9SYogesh Gaur dflt_dpni->dpni_id); 13481730a17dSPrabhakar Kushwaha err_create: 13492557c5a9SYogesh Gaur err_prepare_cfg: 1350879a59acSPrabhakar Kushwaha free(dflt_dpni); 1351a572fb6bSPrabhakar Kushwaha err_calloc: 13521730a17dSPrabhakar Kushwaha return err; 1353a2a55e51SPrabhakar Kushwaha } 1354a2a55e51SPrabhakar Kushwaha 13551730a17dSPrabhakar Kushwaha static int dpni_exit(void) 1356a2a55e51SPrabhakar Kushwaha { 13571730a17dSPrabhakar Kushwaha int err; 13581730a17dSPrabhakar Kushwaha 13592557c5a9SYogesh Gaur err = dpni_destroy(dflt_mc_io, dflt_dprc_handle, MC_CMD_NO_FLAGS, 13602557c5a9SYogesh Gaur dflt_dpni->dpni_id); 13611730a17dSPrabhakar Kushwaha if (err < 0) { 13621730a17dSPrabhakar Kushwaha printf("dpni_destroy() failed: %d\n", err); 13631730a17dSPrabhakar Kushwaha goto err; 13641730a17dSPrabhakar Kushwaha } 13651730a17dSPrabhakar Kushwaha 13661730a17dSPrabhakar Kushwaha #ifdef DEBUG 13671730a17dSPrabhakar Kushwaha printf("Exit: DPNI id=0x%d\n", dflt_dpni->dpni_id); 13681730a17dSPrabhakar Kushwaha #endif 13691730a17dSPrabhakar Kushwaha 13701730a17dSPrabhakar Kushwaha if (dflt_dpni) 13711730a17dSPrabhakar Kushwaha free(dflt_dpni); 13721730a17dSPrabhakar Kushwaha return 0; 13731730a17dSPrabhakar Kushwaha 13741730a17dSPrabhakar Kushwaha err: 13751730a17dSPrabhakar Kushwaha return err; 13761730a17dSPrabhakar Kushwaha } 13771730a17dSPrabhakar Kushwaha 13781730a17dSPrabhakar Kushwaha static int mc_init_object(void) 13791730a17dSPrabhakar Kushwaha { 13801730a17dSPrabhakar Kushwaha int err = 0; 13811730a17dSPrabhakar Kushwaha 13821730a17dSPrabhakar Kushwaha err = dprc_init(); 13831730a17dSPrabhakar Kushwaha if (err < 0) { 13841730a17dSPrabhakar Kushwaha printf("dprc_init() failed: %d\n", err); 13851730a17dSPrabhakar Kushwaha goto err; 13861730a17dSPrabhakar Kushwaha } 13871730a17dSPrabhakar Kushwaha 13881730a17dSPrabhakar Kushwaha err = dpbp_init(); 13891730a17dSPrabhakar Kushwaha if (err < 0) { 13901730a17dSPrabhakar Kushwaha printf("dpbp_init() failed: %d\n", err); 13911730a17dSPrabhakar Kushwaha goto err; 13921730a17dSPrabhakar Kushwaha } 13931730a17dSPrabhakar Kushwaha 13941730a17dSPrabhakar Kushwaha err = dpio_init(); 13951730a17dSPrabhakar Kushwaha if (err < 0) { 13961730a17dSPrabhakar Kushwaha printf("dpio_init() failed: %d\n", err); 13971730a17dSPrabhakar Kushwaha goto err; 13981730a17dSPrabhakar Kushwaha } 13991730a17dSPrabhakar Kushwaha 14001730a17dSPrabhakar Kushwaha err = dpni_init(); 14011730a17dSPrabhakar Kushwaha if (err < 0) { 14021730a17dSPrabhakar Kushwaha printf("dpni_init() failed: %d\n", err); 14031730a17dSPrabhakar Kushwaha goto err; 14041730a17dSPrabhakar Kushwaha } 14051730a17dSPrabhakar Kushwaha 14061730a17dSPrabhakar Kushwaha return 0; 14071730a17dSPrabhakar Kushwaha err: 14081730a17dSPrabhakar Kushwaha return err; 14091730a17dSPrabhakar Kushwaha } 14101730a17dSPrabhakar Kushwaha 14111730a17dSPrabhakar Kushwaha int fsl_mc_ldpaa_exit(bd_t *bd) 14121730a17dSPrabhakar Kushwaha { 14131730a17dSPrabhakar Kushwaha int err = 0; 141442e81790SYogesh Gaur bool is_dpl_apply_status = false; 141506651b94SSantan Kumar bool mc_boot_status = false; 14161730a17dSPrabhakar Kushwaha 1417b7b8410aSAlexander Graf if (bd && mc_lazy_dpl_addr && !fsl_mc_ldpaa_exit(NULL)) { 1418*f9747a5aSYogesh Gaur err = mc_apply_dpl(mc_lazy_dpl_addr); 1419*f9747a5aSYogesh Gaur if (!err) 1420*f9747a5aSYogesh Gaur fdt_fixup_board_enet(working_fdt); 1421b7b8410aSAlexander Graf mc_lazy_dpl_addr = 0; 1422b7b8410aSAlexander Graf } 1423b7b8410aSAlexander Graf 142406651b94SSantan Kumar if (!get_mc_boot_status()) 142506651b94SSantan Kumar mc_boot_status = true; 142606651b94SSantan Kumar 14276dedceddSPrabhakar Kushwaha /* MC is not loaded intentionally, So return success. */ 142806651b94SSantan Kumar if (bd && !mc_boot_status) 14291730a17dSPrabhakar Kushwaha return 0; 14301730a17dSPrabhakar Kushwaha 143142e81790SYogesh Gaur /* If DPL is deployed, set is_dpl_apply_status as TRUE. */ 143242e81790SYogesh Gaur if (!get_dpl_apply_status()) 143342e81790SYogesh Gaur is_dpl_apply_status = true; 14341730a17dSPrabhakar Kushwaha 143542e81790SYogesh Gaur /* 143642e81790SYogesh Gaur * For case MC is loaded but DPL is not deployed, return success and 143742e81790SYogesh Gaur * print message on console. Else FDT fix-up code execution hanged. 143842e81790SYogesh Gaur */ 143906651b94SSantan Kumar if (bd && mc_boot_status && !is_dpl_apply_status) { 144042e81790SYogesh Gaur printf("fsl-mc: DPL not deployed, DPAA2 ethernet not work\n"); 144173fa206aSYogesh Gaur goto mc_obj_cleanup; 144242e81790SYogesh Gaur } 14431730a17dSPrabhakar Kushwaha 144406651b94SSantan Kumar if (bd && mc_boot_status && is_dpl_apply_status) 144506651b94SSantan Kumar return 0; 144606651b94SSantan Kumar 144773fa206aSYogesh Gaur mc_obj_cleanup: 14481730a17dSPrabhakar Kushwaha err = dpbp_exit(); 14491730a17dSPrabhakar Kushwaha if (err < 0) { 1450a2a4dc56SPrabhakar Kushwaha printf("dpbp_exit() failed: %d\n", err); 14511730a17dSPrabhakar Kushwaha goto err; 14521730a17dSPrabhakar Kushwaha } 14531730a17dSPrabhakar Kushwaha 14541730a17dSPrabhakar Kushwaha err = dpio_exit(); 14551730a17dSPrabhakar Kushwaha if (err < 0) { 14561730a17dSPrabhakar Kushwaha printf("dpio_exit() failed: %d\n", err); 14571730a17dSPrabhakar Kushwaha goto err; 14581730a17dSPrabhakar Kushwaha } 14591730a17dSPrabhakar Kushwaha 14601730a17dSPrabhakar Kushwaha err = dpni_exit(); 14611730a17dSPrabhakar Kushwaha if (err < 0) { 14621730a17dSPrabhakar Kushwaha printf("dpni_exit() failed: %d\n", err); 14631730a17dSPrabhakar Kushwaha goto err; 14641730a17dSPrabhakar Kushwaha } 14651730a17dSPrabhakar Kushwaha 14661730a17dSPrabhakar Kushwaha err = dprc_exit(); 14671730a17dSPrabhakar Kushwaha if (err < 0) { 14681730a17dSPrabhakar Kushwaha printf("dprc_exit() failed: %d\n", err); 14691730a17dSPrabhakar Kushwaha goto err; 14701730a17dSPrabhakar Kushwaha } 14711730a17dSPrabhakar Kushwaha 14721730a17dSPrabhakar Kushwaha return 0; 14731730a17dSPrabhakar Kushwaha err: 14741730a17dSPrabhakar Kushwaha return err; 1475fb4a87a7SPrabhakar Kushwaha } 1476fb4a87a7SPrabhakar Kushwaha 1477fb4a87a7SPrabhakar Kushwaha static int do_fsl_mc(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[]) 1478fb4a87a7SPrabhakar Kushwaha { 1479fb4a87a7SPrabhakar Kushwaha int err = 0; 1480fb4a87a7SPrabhakar Kushwaha if (argc < 3) 1481fb4a87a7SPrabhakar Kushwaha goto usage; 1482fb4a87a7SPrabhakar Kushwaha 1483fb4a87a7SPrabhakar Kushwaha switch (argv[1][0]) { 1484fb4a87a7SPrabhakar Kushwaha case 's': { 1485fb4a87a7SPrabhakar Kushwaha char sub_cmd; 148644937214SPrabhakar Kushwaha u64 mc_fw_addr, mc_dpc_addr; 148744937214SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET 148844937214SPrabhakar Kushwaha u64 aiop_fw_addr; 148944937214SPrabhakar Kushwaha #endif 1490fb4a87a7SPrabhakar Kushwaha 1491fb4a87a7SPrabhakar Kushwaha sub_cmd = argv[2][0]; 14922557c5a9SYogesh Gaur 1493fb4a87a7SPrabhakar Kushwaha switch (sub_cmd) { 1494fb4a87a7SPrabhakar Kushwaha case 'm': 1495fb4a87a7SPrabhakar Kushwaha if (argc < 5) 1496fb4a87a7SPrabhakar Kushwaha goto usage; 1497a2a55e51SPrabhakar Kushwaha 1498125e2bc1SJ. German Rivera if (get_mc_boot_status() == 0) { 1499fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: MC is already booted"); 1500fb4a87a7SPrabhakar Kushwaha printf("\n"); 1501fb4a87a7SPrabhakar Kushwaha return err; 1502a2a55e51SPrabhakar Kushwaha } 1503fb4a87a7SPrabhakar Kushwaha mc_fw_addr = simple_strtoull(argv[3], NULL, 16); 1504fb4a87a7SPrabhakar Kushwaha mc_dpc_addr = simple_strtoull(argv[4], NULL, 1505fb4a87a7SPrabhakar Kushwaha 16); 15061730a17dSPrabhakar Kushwaha 15071730a17dSPrabhakar Kushwaha if (!mc_init(mc_fw_addr, mc_dpc_addr)) 15081730a17dSPrabhakar Kushwaha err = mc_init_object(); 1509fb4a87a7SPrabhakar Kushwaha break; 1510fb4a87a7SPrabhakar Kushwaha 1511fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET 1512fb4a87a7SPrabhakar Kushwaha case 'a': 1513fb4a87a7SPrabhakar Kushwaha if (argc < 4) 1514fb4a87a7SPrabhakar Kushwaha goto usage; 1515fb4a87a7SPrabhakar Kushwaha if (get_aiop_apply_status() == 0) { 1516fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: AIOP FW is already"); 1517fb4a87a7SPrabhakar Kushwaha printf(" applied\n"); 1518fb4a87a7SPrabhakar Kushwaha return err; 1519a2a55e51SPrabhakar Kushwaha } 1520a2a55e51SPrabhakar Kushwaha 1521fb4a87a7SPrabhakar Kushwaha aiop_fw_addr = simple_strtoull(argv[3], NULL, 1522fb4a87a7SPrabhakar Kushwaha 16); 1523fb4a87a7SPrabhakar Kushwaha 15243c1d218aSYork Sun /* if SoC doesn't have AIOP, err = -ENODEV */ 1525fb4a87a7SPrabhakar Kushwaha err = load_mc_aiop_img(aiop_fw_addr); 1526fb4a87a7SPrabhakar Kushwaha if (!err) 1527fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: AIOP FW applied\n"); 1528fb4a87a7SPrabhakar Kushwaha break; 1529fb4a87a7SPrabhakar Kushwaha #endif 1530fb4a87a7SPrabhakar Kushwaha default: 1531fb4a87a7SPrabhakar Kushwaha printf("Invalid option: %s\n", argv[2]); 1532fb4a87a7SPrabhakar Kushwaha goto usage; 1533fb4a87a7SPrabhakar Kushwaha 1534fb4a87a7SPrabhakar Kushwaha break; 1535fb4a87a7SPrabhakar Kushwaha } 1536fb4a87a7SPrabhakar Kushwaha } 1537fb4a87a7SPrabhakar Kushwaha break; 1538fb4a87a7SPrabhakar Kushwaha 1539b7b8410aSAlexander Graf case 'l': 1540fb4a87a7SPrabhakar Kushwaha case 'a': { 1541fb4a87a7SPrabhakar Kushwaha u64 mc_dpl_addr; 1542fb4a87a7SPrabhakar Kushwaha 1543fb4a87a7SPrabhakar Kushwaha if (argc < 4) 1544fb4a87a7SPrabhakar Kushwaha goto usage; 1545fb4a87a7SPrabhakar Kushwaha 1546fb4a87a7SPrabhakar Kushwaha if (get_dpl_apply_status() == 0) { 1547fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: DPL already applied\n"); 1548fb4a87a7SPrabhakar Kushwaha return err; 1549125e2bc1SJ. German Rivera } 1550125e2bc1SJ. German Rivera 1551fb4a87a7SPrabhakar Kushwaha mc_dpl_addr = simple_strtoull(argv[3], NULL, 1552fb4a87a7SPrabhakar Kushwaha 16); 15531730a17dSPrabhakar Kushwaha 1554fb4a87a7SPrabhakar Kushwaha if (get_mc_boot_status() != 0) { 1555fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: Deploying data path layout .."); 1556fb4a87a7SPrabhakar Kushwaha printf("ERROR (MC is not booted)\n"); 1557fb4a87a7SPrabhakar Kushwaha return -ENODEV; 1558a2a55e51SPrabhakar Kushwaha } 15591730a17dSPrabhakar Kushwaha 1560b7b8410aSAlexander Graf if (argv[1][0] == 'l') { 1561b7b8410aSAlexander Graf /* 1562b7b8410aSAlexander Graf * We will do the actual dpaa exit and dpl apply 1563b7b8410aSAlexander Graf * later from announce_and_cleanup(). 1564b7b8410aSAlexander Graf */ 1565b7b8410aSAlexander Graf mc_lazy_dpl_addr = mc_dpl_addr; 1566b7b8410aSAlexander Graf } else { 1567b7b8410aSAlexander Graf /* The user wants it applied now */ 15681730a17dSPrabhakar Kushwaha if (!fsl_mc_ldpaa_exit(NULL)) 1569fb4a87a7SPrabhakar Kushwaha err = mc_apply_dpl(mc_dpl_addr); 1570b7b8410aSAlexander Graf } 1571fb4a87a7SPrabhakar Kushwaha break; 1572fb4a87a7SPrabhakar Kushwaha } 1573fb4a87a7SPrabhakar Kushwaha default: 1574fb4a87a7SPrabhakar Kushwaha printf("Invalid option: %s\n", argv[1]); 1575fb4a87a7SPrabhakar Kushwaha goto usage; 1576fb4a87a7SPrabhakar Kushwaha break; 1577fb4a87a7SPrabhakar Kushwaha } 1578fb4a87a7SPrabhakar Kushwaha return err; 1579fb4a87a7SPrabhakar Kushwaha usage: 1580fb4a87a7SPrabhakar Kushwaha return CMD_RET_USAGE; 1581fb4a87a7SPrabhakar Kushwaha } 1582fb4a87a7SPrabhakar Kushwaha 1583fb4a87a7SPrabhakar Kushwaha U_BOOT_CMD( 1584fb4a87a7SPrabhakar Kushwaha fsl_mc, CONFIG_SYS_MAXARGS, 1, do_fsl_mc, 1585fb4a87a7SPrabhakar Kushwaha "DPAA2 command to manage Management Complex (MC)", 1586fb4a87a7SPrabhakar Kushwaha "start mc [FW_addr] [DPC_addr] - Start Management Complex\n" 1587fb4a87a7SPrabhakar Kushwaha "fsl_mc apply DPL [DPL_addr] - Apply DPL file\n" 1588b7b8410aSAlexander Graf "fsl_mc lazyapply DPL [DPL_addr] - Apply DPL file on exit\n" 1589fb4a87a7SPrabhakar Kushwaha "fsl_mc start aiop [FW_addr] - Start AIOP\n" 1590fb4a87a7SPrabhakar Kushwaha ); 159133a8991aSBogdan Purcareata 159233a8991aSBogdan Purcareata void mc_env_boot(void) 159333a8991aSBogdan Purcareata { 159433a8991aSBogdan Purcareata #if defined(CONFIG_FSL_MC_ENET) 159533a8991aSBogdan Purcareata char *mc_boot_env_var; 159633a8991aSBogdan Purcareata /* The MC may only be initialized in the reset PHY function 159733a8991aSBogdan Purcareata * because otherwise U-Boot has not yet set up all the MAC 159833a8991aSBogdan Purcareata * address info properly. Without MAC addresses, the MC code 159933a8991aSBogdan Purcareata * can not properly initialize the DPC. 160033a8991aSBogdan Purcareata */ 160100caae6dSSimon Glass mc_boot_env_var = env_get(MC_BOOT_ENV_VAR); 160233a8991aSBogdan Purcareata if (mc_boot_env_var) 160333a8991aSBogdan Purcareata run_command_list(mc_boot_env_var, -1, 0); 160433a8991aSBogdan Purcareata #endif /* CONFIG_FSL_MC_ENET */ 160533a8991aSBogdan Purcareata } 1606