183d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+
27b3bd9a7SJ. German Rivera /*
3a6f2a6eaSYogesh Gaur * Copyright 2014 Freescale Semiconductor, Inc.
4a6f2a6eaSYogesh Gaur * Copyright 2017 NXP
587519a9eSPrabhakar Kushwaha * Copyright 2017-2018 NXP
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>
11b08c8c48SMasahiro Yamada #include <linux/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"
31*43ad41e6SMeenakshi Aggarwal #define MC_DRAM_BLOCK_DEFAULT_SIZE (512UL * 1024 * 1024)
32125e2bc1SJ. German Rivera
337b3bd9a7SJ. German Rivera DECLARE_GLOBAL_DATA_PTR;
3487519a9eSPrabhakar Kushwaha static int mc_memset_resv_ram;
35fb4a87a7SPrabhakar Kushwaha static int mc_boot_status = -1;
36fb4a87a7SPrabhakar Kushwaha static int mc_dpl_applied = -1;
37fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET
38fb4a87a7SPrabhakar Kushwaha static int mc_aiop_applied = -1;
39fb4a87a7SPrabhakar Kushwaha #endif
401730a17dSPrabhakar Kushwaha struct fsl_mc_io *root_mc_io = NULL;
411730a17dSPrabhakar Kushwaha struct fsl_mc_io *dflt_mc_io = NULL; /* child container */
421730a17dSPrabhakar Kushwaha uint16_t root_dprc_handle = 0;
43a2a55e51SPrabhakar Kushwaha uint16_t dflt_dprc_handle = 0;
441730a17dSPrabhakar Kushwaha int child_dprc_id;
45a2a55e51SPrabhakar Kushwaha struct fsl_dpbp_obj *dflt_dpbp = NULL;
46a2a55e51SPrabhakar Kushwaha struct fsl_dpio_obj *dflt_dpio = NULL;
471730a17dSPrabhakar Kushwaha struct fsl_dpni_obj *dflt_dpni = NULL;
48b7b8410aSAlexander Graf static u64 mc_lazy_dpl_addr;
497b3bd9a7SJ. German Rivera
50125e2bc1SJ. German Rivera #ifdef DEBUG
dump_ram_words(const char * title,void * addr)51125e2bc1SJ. German Rivera void dump_ram_words(const char *title, void *addr)
52125e2bc1SJ. German Rivera {
53125e2bc1SJ. German Rivera int i;
54125e2bc1SJ. German Rivera uint32_t *words = addr;
55125e2bc1SJ. German Rivera
56125e2bc1SJ. German Rivera printf("Dumping beginning of %s (%p):\n", title, addr);
57125e2bc1SJ. German Rivera for (i = 0; i < 16; i++)
58125e2bc1SJ. German Rivera printf("%#x ", words[i]);
59125e2bc1SJ. German Rivera
60125e2bc1SJ. German Rivera printf("\n");
61125e2bc1SJ. German Rivera }
62125e2bc1SJ. German Rivera
dump_mc_ccsr_regs(struct mc_ccsr_registers __iomem * mc_ccsr_regs)63125e2bc1SJ. German Rivera void dump_mc_ccsr_regs(struct mc_ccsr_registers __iomem *mc_ccsr_regs)
64125e2bc1SJ. German Rivera {
65125e2bc1SJ. German Rivera printf("MC CCSR registers:\n"
66125e2bc1SJ. German Rivera "reg_gcr1 %#x\n"
67125e2bc1SJ. German Rivera "reg_gsr %#x\n"
68125e2bc1SJ. German Rivera "reg_sicbalr %#x\n"
69125e2bc1SJ. German Rivera "reg_sicbahr %#x\n"
70125e2bc1SJ. German Rivera "reg_sicapr %#x\n"
71125e2bc1SJ. German Rivera "reg_mcfbalr %#x\n"
72125e2bc1SJ. German Rivera "reg_mcfbahr %#x\n"
73125e2bc1SJ. German Rivera "reg_mcfapr %#x\n"
74125e2bc1SJ. German Rivera "reg_psr %#x\n",
75125e2bc1SJ. German Rivera mc_ccsr_regs->reg_gcr1,
76125e2bc1SJ. German Rivera mc_ccsr_regs->reg_gsr,
77125e2bc1SJ. German Rivera mc_ccsr_regs->reg_sicbalr,
78125e2bc1SJ. German Rivera mc_ccsr_regs->reg_sicbahr,
79125e2bc1SJ. German Rivera mc_ccsr_regs->reg_sicapr,
80125e2bc1SJ. German Rivera mc_ccsr_regs->reg_mcfbalr,
81125e2bc1SJ. German Rivera mc_ccsr_regs->reg_mcfbahr,
82125e2bc1SJ. German Rivera mc_ccsr_regs->reg_mcfapr,
83125e2bc1SJ. German Rivera mc_ccsr_regs->reg_psr);
84125e2bc1SJ. German Rivera }
85125e2bc1SJ. German Rivera #else
86125e2bc1SJ. German Rivera
87125e2bc1SJ. German Rivera #define dump_ram_words(title, addr)
88125e2bc1SJ. German Rivera #define dump_mc_ccsr_regs(mc_ccsr_regs)
89125e2bc1SJ. German Rivera
90125e2bc1SJ. German Rivera #endif /* DEBUG */
91125e2bc1SJ. German Rivera
92125e2bc1SJ. German Rivera #ifndef CONFIG_SYS_LS_MC_FW_IN_DDR
937b3bd9a7SJ. German Rivera /**
947b3bd9a7SJ. German Rivera * Copying MC firmware or DPL image to DDR
957b3bd9a7SJ. German Rivera */
mc_copy_image(const char * title,u64 image_addr,u32 image_size,u64 mc_ram_addr)967b3bd9a7SJ. German Rivera static int mc_copy_image(const char *title,
977b3bd9a7SJ. German Rivera u64 image_addr, u32 image_size, u64 mc_ram_addr)
987b3bd9a7SJ. German Rivera {
997b3bd9a7SJ. German Rivera debug("%s copied to address %p\n", title, (void *)mc_ram_addr);
1007b3bd9a7SJ. German Rivera memcpy((void *)mc_ram_addr, (void *)image_addr, image_size);
101125e2bc1SJ. German Rivera flush_dcache_range(mc_ram_addr, mc_ram_addr + image_size);
1027b3bd9a7SJ. German Rivera return 0;
1037b3bd9a7SJ. German Rivera }
1047b3bd9a7SJ. German Rivera
1057b3bd9a7SJ. German Rivera /**
1067b3bd9a7SJ. German Rivera * MC firmware FIT image parser checks if the image is in FIT
1077b3bd9a7SJ. German Rivera * format, verifies integrity of the image and calculates
1087b3bd9a7SJ. German Rivera * raw image address and size values.
1097b3bd9a7SJ. German Rivera * Returns 0 on success and a negative errno on error.
1107b3bd9a7SJ. German Rivera * task fail.
1117b3bd9a7SJ. German Rivera **/
parse_mc_firmware_fit_image(u64 mc_fw_addr,const void ** raw_image_addr,size_t * raw_image_size)112fb4a87a7SPrabhakar Kushwaha int parse_mc_firmware_fit_image(u64 mc_fw_addr,
113fb4a87a7SPrabhakar Kushwaha const void **raw_image_addr,
1147b3bd9a7SJ. German Rivera size_t *raw_image_size)
1157b3bd9a7SJ. German Rivera {
1167b3bd9a7SJ. German Rivera int format;
1177b3bd9a7SJ. German Rivera void *fit_hdr;
1187b3bd9a7SJ. German Rivera int node_offset;
1197b3bd9a7SJ. German Rivera const void *data;
1207b3bd9a7SJ. German Rivera size_t size;
1217b3bd9a7SJ. German Rivera const char *uname = "firmware";
1227b3bd9a7SJ. German Rivera
123fb4a87a7SPrabhakar Kushwaha fit_hdr = (void *)mc_fw_addr;
1247b3bd9a7SJ. German Rivera
1257b3bd9a7SJ. German Rivera /* Check if Image is in FIT format */
1267b3bd9a7SJ. German Rivera format = genimg_get_format(fit_hdr);
1277b3bd9a7SJ. German Rivera
1287b3bd9a7SJ. German Rivera if (format != IMAGE_FORMAT_FIT) {
129fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: ERR: Bad firmware image (not a FIT image)\n");
1307b3bd9a7SJ. German Rivera return -EINVAL;
1317b3bd9a7SJ. German Rivera }
1327b3bd9a7SJ. German Rivera
1337b3bd9a7SJ. German Rivera if (!fit_check_format(fit_hdr)) {
134fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: ERR: Bad firmware image (bad FIT header)\n");
1357b3bd9a7SJ. German Rivera return -EINVAL;
1367b3bd9a7SJ. German Rivera }
1377b3bd9a7SJ. German Rivera
1387b3bd9a7SJ. German Rivera node_offset = fit_image_get_node(fit_hdr, uname);
1397b3bd9a7SJ. German Rivera
1407b3bd9a7SJ. German Rivera if (node_offset < 0) {
141fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: ERR: Bad firmware image (missing subimage)\n");
1427b3bd9a7SJ. German Rivera return -ENOENT;
1437b3bd9a7SJ. German Rivera }
1447b3bd9a7SJ. German Rivera
1457b3bd9a7SJ. German Rivera /* Verify MC firmware image */
1467b3bd9a7SJ. German Rivera if (!(fit_image_verify(fit_hdr, node_offset))) {
147fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: ERR: Bad firmware image (bad CRC)\n");
1487b3bd9a7SJ. German Rivera return -EINVAL;
1497b3bd9a7SJ. German Rivera }
1507b3bd9a7SJ. German Rivera
1517b3bd9a7SJ. German Rivera /* Get address and size of raw image */
1527b3bd9a7SJ. German Rivera fit_image_get_data(fit_hdr, node_offset, &data, &size);
1537b3bd9a7SJ. German Rivera
1547b3bd9a7SJ. German Rivera *raw_image_addr = data;
1557b3bd9a7SJ. German Rivera *raw_image_size = size;
1567b3bd9a7SJ. German Rivera
1577b3bd9a7SJ. German Rivera return 0;
1587b3bd9a7SJ. German Rivera }
159125e2bc1SJ. German Rivera #endif
160125e2bc1SJ. German Rivera
1611161dbccSBogdan Purcareata #define MC_DT_INCREASE_SIZE 64
1621161dbccSBogdan Purcareata
1631161dbccSBogdan Purcareata enum mc_fixup_type {
1641161dbccSBogdan Purcareata MC_FIXUP_DPL,
1651161dbccSBogdan Purcareata MC_FIXUP_DPC
1661161dbccSBogdan Purcareata };
1671161dbccSBogdan Purcareata
mc_fixup_mac_addr(void * blob,int nodeoffset,const char * propname,struct eth_device * eth_dev,enum mc_fixup_type type)1681161dbccSBogdan Purcareata static int mc_fixup_mac_addr(void *blob, int nodeoffset,
1691161dbccSBogdan Purcareata const char *propname, struct eth_device *eth_dev,
1701161dbccSBogdan Purcareata enum mc_fixup_type type)
1711161dbccSBogdan Purcareata {
1721161dbccSBogdan Purcareata int err = 0, len = 0, size, i;
1731161dbccSBogdan Purcareata unsigned char env_enetaddr[ARP_HLEN];
1741161dbccSBogdan Purcareata unsigned int enetaddr_32[ARP_HLEN];
1751161dbccSBogdan Purcareata void *val = NULL;
1761161dbccSBogdan Purcareata
1771161dbccSBogdan Purcareata switch (type) {
1781161dbccSBogdan Purcareata case MC_FIXUP_DPL:
1791161dbccSBogdan Purcareata /* DPL likes its addresses on 32 * ARP_HLEN bits */
1801161dbccSBogdan Purcareata for (i = 0; i < ARP_HLEN; i++)
1811161dbccSBogdan Purcareata enetaddr_32[i] = cpu_to_fdt32(eth_dev->enetaddr[i]);
1821161dbccSBogdan Purcareata val = enetaddr_32;
1831161dbccSBogdan Purcareata len = sizeof(enetaddr_32);
1841161dbccSBogdan Purcareata break;
1851161dbccSBogdan Purcareata
1861161dbccSBogdan Purcareata case MC_FIXUP_DPC:
1871161dbccSBogdan Purcareata val = eth_dev->enetaddr;
1881161dbccSBogdan Purcareata len = ARP_HLEN;
1891161dbccSBogdan Purcareata break;
1901161dbccSBogdan Purcareata }
1911161dbccSBogdan Purcareata
1921161dbccSBogdan Purcareata /* MAC address property present */
1931161dbccSBogdan Purcareata if (fdt_get_property(blob, nodeoffset, propname, NULL)) {
1941161dbccSBogdan Purcareata /* u-boot MAC addr randomly assigned - leave the present one */
19535affd7aSSimon Glass if (!eth_env_get_enetaddr_by_index("eth", eth_dev->index,
1961161dbccSBogdan Purcareata env_enetaddr))
1971161dbccSBogdan Purcareata return err;
1981161dbccSBogdan Purcareata } else {
1991161dbccSBogdan Purcareata size = MC_DT_INCREASE_SIZE + strlen(propname) + len;
2001161dbccSBogdan Purcareata /* make room for mac address property */
2011161dbccSBogdan Purcareata err = fdt_increase_size(blob, size);
2021161dbccSBogdan Purcareata if (err) {
2031161dbccSBogdan Purcareata printf("fdt_increase_size: err=%s\n",
2041161dbccSBogdan Purcareata fdt_strerror(err));
2051161dbccSBogdan Purcareata return err;
2061161dbccSBogdan Purcareata }
2071161dbccSBogdan Purcareata }
2081161dbccSBogdan Purcareata
2091161dbccSBogdan Purcareata err = fdt_setprop(blob, nodeoffset, propname, val, len);
2101161dbccSBogdan Purcareata if (err) {
2111161dbccSBogdan Purcareata printf("fdt_setprop: err=%s\n", fdt_strerror(err));
2121161dbccSBogdan Purcareata return err;
2131161dbccSBogdan Purcareata }
2141161dbccSBogdan Purcareata
2151161dbccSBogdan Purcareata return err;
2161161dbccSBogdan Purcareata }
2171161dbccSBogdan Purcareata
2181161dbccSBogdan Purcareata #define is_dpni(s) (s != NULL ? !strncmp(s, "dpni@", 5) : 0)
2191161dbccSBogdan Purcareata
dpl_get_connection_endpoint(void * blob,char * endpoint)2201161dbccSBogdan Purcareata const char *dpl_get_connection_endpoint(void *blob, char *endpoint)
2211161dbccSBogdan Purcareata {
2221161dbccSBogdan Purcareata int connoffset = fdt_path_offset(blob, "/connections"), off;
2231161dbccSBogdan Purcareata const char *s1, *s2;
2241161dbccSBogdan Purcareata
2251161dbccSBogdan Purcareata for (off = fdt_first_subnode(blob, connoffset);
2261161dbccSBogdan Purcareata off >= 0;
2271161dbccSBogdan Purcareata off = fdt_next_subnode(blob, off)) {
2281161dbccSBogdan Purcareata s1 = fdt_stringlist_get(blob, off, "endpoint1", 0, NULL);
2291161dbccSBogdan Purcareata s2 = fdt_stringlist_get(blob, off, "endpoint2", 0, NULL);
2301161dbccSBogdan Purcareata
2311161dbccSBogdan Purcareata if (!s1 || !s2)
2321161dbccSBogdan Purcareata continue;
2331161dbccSBogdan Purcareata
2341161dbccSBogdan Purcareata if (strcmp(endpoint, s1) == 0)
2351161dbccSBogdan Purcareata return s2;
2361161dbccSBogdan Purcareata
2371161dbccSBogdan Purcareata if (strcmp(endpoint, s2) == 0)
2381161dbccSBogdan Purcareata return s1;
2391161dbccSBogdan Purcareata }
2401161dbccSBogdan Purcareata
2411161dbccSBogdan Purcareata return NULL;
2421161dbccSBogdan Purcareata }
2431161dbccSBogdan Purcareata
mc_fixup_dpl_mac_addr(void * blob,int dpmac_id,struct eth_device * eth_dev)2441161dbccSBogdan Purcareata static int mc_fixup_dpl_mac_addr(void *blob, int dpmac_id,
2455707dfb0SBogdan Purcareata struct eth_device *eth_dev)
2465707dfb0SBogdan Purcareata {
2471161dbccSBogdan Purcareata int objoff = fdt_path_offset(blob, "/objects");
2481161dbccSBogdan Purcareata int dpmacoff = -1, dpnioff = -1;
2491161dbccSBogdan Purcareata const char *endpoint;
2505707dfb0SBogdan Purcareata char mac_name[10];
2511161dbccSBogdan Purcareata int err;
2521161dbccSBogdan Purcareata
2531161dbccSBogdan Purcareata sprintf(mac_name, "dpmac@%d", dpmac_id);
2541161dbccSBogdan Purcareata dpmacoff = fdt_subnode_offset(blob, objoff, mac_name);
2551161dbccSBogdan Purcareata if (dpmacoff < 0)
2561161dbccSBogdan Purcareata /* dpmac not defined in DPL, so skip it. */
2571161dbccSBogdan Purcareata return 0;
2581161dbccSBogdan Purcareata
2591161dbccSBogdan Purcareata err = mc_fixup_mac_addr(blob, dpmacoff, "mac_addr", eth_dev,
2601161dbccSBogdan Purcareata MC_FIXUP_DPL);
2611161dbccSBogdan Purcareata if (err) {
2621161dbccSBogdan Purcareata printf("Error fixing up dpmac mac_addr in DPL\n");
2631161dbccSBogdan Purcareata return err;
2641161dbccSBogdan Purcareata }
2651161dbccSBogdan Purcareata
2661161dbccSBogdan Purcareata /* now we need to figure out if there is any
2671161dbccSBogdan Purcareata * DPNI connected to this MAC, so we walk the
2681161dbccSBogdan Purcareata * connection list
2691161dbccSBogdan Purcareata */
2701161dbccSBogdan Purcareata endpoint = dpl_get_connection_endpoint(blob, mac_name);
2711161dbccSBogdan Purcareata if (!is_dpni(endpoint))
2721161dbccSBogdan Purcareata return 0;
2731161dbccSBogdan Purcareata
2741161dbccSBogdan Purcareata /* let's see if we can fixup the DPNI as well */
2751161dbccSBogdan Purcareata dpnioff = fdt_subnode_offset(blob, objoff, endpoint);
2761161dbccSBogdan Purcareata if (dpnioff < 0)
2771161dbccSBogdan Purcareata /* DPNI not defined in DPL in the objects area */
2781161dbccSBogdan Purcareata return 0;
2791161dbccSBogdan Purcareata
2801161dbccSBogdan Purcareata return mc_fixup_mac_addr(blob, dpnioff, "mac_addr", eth_dev,
2811161dbccSBogdan Purcareata MC_FIXUP_DPL);
2821161dbccSBogdan Purcareata }
2831161dbccSBogdan Purcareata
fdt_fsl_mc_fixup_iommu_map_entry(void * blob)284a78df40cSNipun Gupta void fdt_fsl_mc_fixup_iommu_map_entry(void *blob)
285a78df40cSNipun Gupta {
286a78df40cSNipun Gupta u32 *prop;
287a78df40cSNipun Gupta u32 iommu_map[4];
288a78df40cSNipun Gupta int offset;
289a78df40cSNipun Gupta int lenp;
290a78df40cSNipun Gupta
291a78df40cSNipun Gupta /* find fsl-mc node */
292a78df40cSNipun Gupta offset = fdt_path_offset(blob, "/soc/fsl-mc");
293a78df40cSNipun Gupta if (offset < 0)
294a78df40cSNipun Gupta offset = fdt_path_offset(blob, "/fsl-mc");
295a78df40cSNipun Gupta if (offset < 0) {
296a78df40cSNipun Gupta printf("%s: fsl-mc: ERR: fsl-mc node not found in DT, err %d\n",
297a78df40cSNipun Gupta __func__, offset);
298a78df40cSNipun Gupta return;
299a78df40cSNipun Gupta }
300a78df40cSNipun Gupta
301a78df40cSNipun Gupta prop = fdt_getprop_w(blob, offset, "iommu-map", &lenp);
302a78df40cSNipun Gupta if (!prop) {
303a78df40cSNipun Gupta debug("%s: fsl-mc: ERR: missing iommu-map in fsl-mc bus node\n",
304a78df40cSNipun Gupta __func__);
305a78df40cSNipun Gupta return;
306a78df40cSNipun Gupta }
307a78df40cSNipun Gupta
308a78df40cSNipun Gupta iommu_map[0] = cpu_to_fdt32(FSL_DPAA2_STREAM_ID_START);
309a78df40cSNipun Gupta iommu_map[1] = *++prop;
310a78df40cSNipun Gupta iommu_map[2] = cpu_to_fdt32(FSL_DPAA2_STREAM_ID_START);
311a78df40cSNipun Gupta iommu_map[3] = cpu_to_fdt32(FSL_DPAA2_STREAM_ID_END -
312a78df40cSNipun Gupta FSL_DPAA2_STREAM_ID_START + 1);
313a78df40cSNipun Gupta
314a78df40cSNipun Gupta fdt_setprop_inplace(blob, offset, "iommu-map",
315a78df40cSNipun Gupta iommu_map, sizeof(iommu_map));
316a78df40cSNipun Gupta }
317a78df40cSNipun Gupta
mc_fixup_dpc_mac_addr(void * blob,int dpmac_id,struct eth_device * eth_dev)3181161dbccSBogdan Purcareata static int mc_fixup_dpc_mac_addr(void *blob, int dpmac_id,
3191161dbccSBogdan Purcareata struct eth_device *eth_dev)
3201161dbccSBogdan Purcareata {
3211161dbccSBogdan Purcareata int nodeoffset = fdt_path_offset(blob, "/board_info/ports"), noff;
3221161dbccSBogdan Purcareata int err = 0;
3231161dbccSBogdan Purcareata char mac_name[10];
3241161dbccSBogdan Purcareata const char link_type_mode[] = "MAC_LINK_TYPE_FIXED";
3255707dfb0SBogdan Purcareata
3265707dfb0SBogdan Purcareata sprintf(mac_name, "mac@%d", dpmac_id);
3275707dfb0SBogdan Purcareata
3285707dfb0SBogdan Purcareata /* node not found - create it */
3291161dbccSBogdan Purcareata noff = fdt_subnode_offset(blob, nodeoffset, (const char *)mac_name);
3301161dbccSBogdan Purcareata if (noff < 0) {
3315707dfb0SBogdan Purcareata err = fdt_increase_size(blob, 200);
3325707dfb0SBogdan Purcareata if (err) {
3335707dfb0SBogdan Purcareata printf("fdt_increase_size: err=%s\n",
3345707dfb0SBogdan Purcareata fdt_strerror(err));
3355707dfb0SBogdan Purcareata return err;
3365707dfb0SBogdan Purcareata }
3375707dfb0SBogdan Purcareata
3381161dbccSBogdan Purcareata noff = fdt_add_subnode(blob, nodeoffset, mac_name);
3391161dbccSBogdan Purcareata if (noff < 0) {
3401161dbccSBogdan Purcareata printf("fdt_add_subnode: err=%s\n",
3411161dbccSBogdan Purcareata fdt_strerror(err));
3421161dbccSBogdan Purcareata return err;
3431161dbccSBogdan Purcareata }
3445707dfb0SBogdan Purcareata
3455707dfb0SBogdan Purcareata /* add default property of fixed link */
3461161dbccSBogdan Purcareata err = fdt_appendprop_string(blob, noff,
3475707dfb0SBogdan Purcareata "link_type", link_type_mode);
3485707dfb0SBogdan Purcareata if (err) {
3495707dfb0SBogdan Purcareata printf("fdt_appendprop_string: err=%s\n",
3505707dfb0SBogdan Purcareata fdt_strerror(err));
3515707dfb0SBogdan Purcareata return err;
3525707dfb0SBogdan Purcareata }
3535707dfb0SBogdan Purcareata }
3545707dfb0SBogdan Purcareata
3551161dbccSBogdan Purcareata return mc_fixup_mac_addr(blob, noff, "port_mac_address", eth_dev,
3561161dbccSBogdan Purcareata MC_FIXUP_DPC);
3575707dfb0SBogdan Purcareata }
3585707dfb0SBogdan Purcareata
mc_fixup_mac_addrs(void * blob,enum mc_fixup_type type)3591161dbccSBogdan Purcareata static int mc_fixup_mac_addrs(void *blob, enum mc_fixup_type type)
3601161dbccSBogdan Purcareata {
3611161dbccSBogdan Purcareata int i, err = 0, ret = 0;
362c022ec03SPankaj Bansal char ethname[ETH_NAME_LEN];
3631161dbccSBogdan Purcareata struct eth_device *eth_dev;
3641161dbccSBogdan Purcareata
3651161dbccSBogdan Purcareata for (i = WRIOP1_DPMAC1; i < NUM_WRIOP_PORTS; i++) {
3661161dbccSBogdan Purcareata /* port not enabled */
3671ed19a14SPankaj Bansal if (wriop_is_enabled_dpmac(i) != 1)
3681161dbccSBogdan Purcareata continue;
3691161dbccSBogdan Purcareata
370c022ec03SPankaj Bansal snprintf(ethname, ETH_NAME_LEN, "DPMAC%d@%s", i,
3711161dbccSBogdan Purcareata phy_interface_strings[wriop_get_enet_if(i)]);
3721161dbccSBogdan Purcareata
3731161dbccSBogdan Purcareata eth_dev = eth_get_dev_by_name(ethname);
3741161dbccSBogdan Purcareata if (eth_dev == NULL)
3751161dbccSBogdan Purcareata continue;
3761161dbccSBogdan Purcareata
3771161dbccSBogdan Purcareata switch (type) {
3781161dbccSBogdan Purcareata case MC_FIXUP_DPL:
3791161dbccSBogdan Purcareata err = mc_fixup_dpl_mac_addr(blob, i, eth_dev);
3801161dbccSBogdan Purcareata break;
3811161dbccSBogdan Purcareata case MC_FIXUP_DPC:
3821161dbccSBogdan Purcareata err = mc_fixup_dpc_mac_addr(blob, i, eth_dev);
3831161dbccSBogdan Purcareata break;
3841161dbccSBogdan Purcareata default:
3851161dbccSBogdan Purcareata break;
3865707dfb0SBogdan Purcareata }
3875707dfb0SBogdan Purcareata
3881161dbccSBogdan Purcareata if (err)
3891161dbccSBogdan Purcareata printf("fsl-mc: ERROR fixing mac address for %s\n",
3901161dbccSBogdan Purcareata ethname);
3911161dbccSBogdan Purcareata ret |= err;
3925707dfb0SBogdan Purcareata }
3935707dfb0SBogdan Purcareata
3941161dbccSBogdan Purcareata return ret;
3955707dfb0SBogdan Purcareata }
3965707dfb0SBogdan Purcareata
mc_fixup_dpc(u64 dpc_addr)39721c69870SStuart Yoder static int mc_fixup_dpc(u64 dpc_addr)
39821c69870SStuart Yoder {
39921c69870SStuart Yoder void *blob = (void *)dpc_addr;
4005707dfb0SBogdan Purcareata int nodeoffset, err = 0;
40121c69870SStuart Yoder
40221c69870SStuart Yoder /* delete any existing ICID pools */
40321c69870SStuart Yoder nodeoffset = fdt_path_offset(blob, "/resources/icid_pools");
40421c69870SStuart Yoder if (fdt_del_node(blob, nodeoffset) < 0)
40521c69870SStuart Yoder printf("\nfsl-mc: WARNING: could not delete ICID pool\n");
40621c69870SStuart Yoder
40721c69870SStuart Yoder /* add a new pool */
40821c69870SStuart Yoder nodeoffset = fdt_path_offset(blob, "/resources");
40921c69870SStuart Yoder if (nodeoffset < 0) {
41021c69870SStuart Yoder printf("\nfsl-mc: ERROR: DPC is missing /resources\n");
41121c69870SStuart Yoder return -EINVAL;
41221c69870SStuart Yoder }
41321c69870SStuart Yoder nodeoffset = fdt_add_subnode(blob, nodeoffset, "icid_pools");
41421c69870SStuart Yoder nodeoffset = fdt_add_subnode(blob, nodeoffset, "icid_pool@0");
41521c69870SStuart Yoder do_fixup_by_path_u32(blob, "/resources/icid_pools/icid_pool@0",
41621c69870SStuart Yoder "base_icid", FSL_DPAA2_STREAM_ID_START, 1);
41721c69870SStuart Yoder do_fixup_by_path_u32(blob, "/resources/icid_pools/icid_pool@0",
41821c69870SStuart Yoder "num",
41921c69870SStuart Yoder FSL_DPAA2_STREAM_ID_END -
42021c69870SStuart Yoder FSL_DPAA2_STREAM_ID_START + 1, 1);
42121c69870SStuart Yoder
4225707dfb0SBogdan Purcareata /* fixup MAC addresses for dpmac ports */
4235707dfb0SBogdan Purcareata nodeoffset = fdt_path_offset(blob, "/board_info/ports");
4245707dfb0SBogdan Purcareata if (nodeoffset < 0)
4252e9f1bf5SIoana Ciocoi Radulescu goto out;
4265707dfb0SBogdan Purcareata
4271161dbccSBogdan Purcareata err = mc_fixup_mac_addrs(blob, MC_FIXUP_DPC);
4282e9f1bf5SIoana Ciocoi Radulescu
4292e9f1bf5SIoana Ciocoi Radulescu out:
43021c69870SStuart Yoder flush_dcache_range(dpc_addr, dpc_addr + fdt_totalsize(blob));
43121c69870SStuart Yoder
4325707dfb0SBogdan Purcareata return err;
43321c69870SStuart Yoder }
43421c69870SStuart Yoder
load_mc_dpc(u64 mc_ram_addr,size_t mc_ram_size,u64 mc_dpc_addr)435fb4a87a7SPrabhakar Kushwaha static int load_mc_dpc(u64 mc_ram_addr, size_t mc_ram_size, u64 mc_dpc_addr)
436125e2bc1SJ. German Rivera {
437125e2bc1SJ. German Rivera u64 mc_dpc_offset;
438125e2bc1SJ. German Rivera #ifndef CONFIG_SYS_LS_MC_DPC_IN_DDR
439125e2bc1SJ. German Rivera int error;
440125e2bc1SJ. German Rivera void *dpc_fdt_hdr;
441125e2bc1SJ. German Rivera int dpc_size;
442125e2bc1SJ. German Rivera #endif
443125e2bc1SJ. German Rivera
444125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET
445125e2bc1SJ. German Rivera BUILD_BUG_ON((CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET & 0x3) != 0 ||
446125e2bc1SJ. German Rivera CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET > 0xffffffff);
447125e2bc1SJ. German Rivera
448125e2bc1SJ. German Rivera mc_dpc_offset = CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET;
449125e2bc1SJ. German Rivera #else
450125e2bc1SJ. German Rivera #error "CONFIG_SYS_LS_MC_DRAM_DPC_OFFSET not defined"
451125e2bc1SJ. German Rivera #endif
452125e2bc1SJ. German Rivera
453125e2bc1SJ. German Rivera /*
454125e2bc1SJ. German Rivera * Load the MC DPC blob in the MC private DRAM block:
455125e2bc1SJ. German Rivera */
456125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_DPC_IN_DDR
457125e2bc1SJ. German Rivera printf("MC DPC is preloaded to %#llx\n", mc_ram_addr + mc_dpc_offset);
458125e2bc1SJ. German Rivera #else
459125e2bc1SJ. German Rivera /*
460125e2bc1SJ. German Rivera * Get address and size of the DPC blob stored in flash:
461125e2bc1SJ. German Rivera */
462fb4a87a7SPrabhakar Kushwaha dpc_fdt_hdr = (void *)mc_dpc_addr;
463125e2bc1SJ. German Rivera
464125e2bc1SJ. German Rivera error = fdt_check_header(dpc_fdt_hdr);
465125e2bc1SJ. German Rivera if (error != 0) {
466125e2bc1SJ. German Rivera /*
467125e2bc1SJ. German Rivera * Don't return with error here, since the MC firmware can
468125e2bc1SJ. German Rivera * still boot without a DPC
469125e2bc1SJ. German Rivera */
470cc088c3aSJ. German Rivera printf("\nfsl-mc: WARNING: No DPC image found");
471125e2bc1SJ. German Rivera return 0;
472125e2bc1SJ. German Rivera }
473125e2bc1SJ. German Rivera
474125e2bc1SJ. German Rivera dpc_size = fdt_totalsize(dpc_fdt_hdr);
475125e2bc1SJ. German Rivera if (dpc_size > CONFIG_SYS_LS_MC_DPC_MAX_LENGTH) {
476cc088c3aSJ. German Rivera printf("\nfsl-mc: ERROR: Bad DPC image (too large: %d)\n",
477125e2bc1SJ. German Rivera dpc_size);
478125e2bc1SJ. German Rivera return -EINVAL;
479125e2bc1SJ. German Rivera }
480125e2bc1SJ. German Rivera
481125e2bc1SJ. German Rivera mc_copy_image("MC DPC blob",
482125e2bc1SJ. German Rivera (u64)dpc_fdt_hdr, dpc_size, mc_ram_addr + mc_dpc_offset);
483125e2bc1SJ. German Rivera #endif /* not defined CONFIG_SYS_LS_MC_DPC_IN_DDR */
484125e2bc1SJ. German Rivera
48521c69870SStuart Yoder if (mc_fixup_dpc(mc_ram_addr + mc_dpc_offset))
48621c69870SStuart Yoder return -EINVAL;
48721c69870SStuart Yoder
488125e2bc1SJ. German Rivera dump_ram_words("DPC", (void *)(mc_ram_addr + mc_dpc_offset));
489125e2bc1SJ. German Rivera return 0;
490125e2bc1SJ. German Rivera }
491125e2bc1SJ. German Rivera
4921161dbccSBogdan Purcareata
mc_fixup_dpl(u64 dpl_addr)4931161dbccSBogdan Purcareata static int mc_fixup_dpl(u64 dpl_addr)
4941161dbccSBogdan Purcareata {
4951161dbccSBogdan Purcareata void *blob = (void *)dpl_addr;
4961161dbccSBogdan Purcareata u32 ver = fdt_getprop_u32_default(blob, "/", "dpl-version", 0);
4971161dbccSBogdan Purcareata int err = 0;
4981161dbccSBogdan Purcareata
4991161dbccSBogdan Purcareata /* The DPL fixup for mac addresses is only relevant
5001161dbccSBogdan Purcareata * for old-style DPLs
5011161dbccSBogdan Purcareata */
5021161dbccSBogdan Purcareata if (ver >= 10)
5031161dbccSBogdan Purcareata return 0;
5041161dbccSBogdan Purcareata
5051161dbccSBogdan Purcareata err = mc_fixup_mac_addrs(blob, MC_FIXUP_DPL);
5061161dbccSBogdan Purcareata flush_dcache_range(dpl_addr, dpl_addr + fdt_totalsize(blob));
5071161dbccSBogdan Purcareata
5081161dbccSBogdan Purcareata return err;
5091161dbccSBogdan Purcareata }
5101161dbccSBogdan Purcareata
load_mc_dpl(u64 mc_ram_addr,size_t mc_ram_size,u64 mc_dpl_addr)511fb4a87a7SPrabhakar Kushwaha static int load_mc_dpl(u64 mc_ram_addr, size_t mc_ram_size, u64 mc_dpl_addr)
512125e2bc1SJ. German Rivera {
513125e2bc1SJ. German Rivera u64 mc_dpl_offset;
514125e2bc1SJ. German Rivera #ifndef CONFIG_SYS_LS_MC_DPL_IN_DDR
515125e2bc1SJ. German Rivera int error;
516125e2bc1SJ. German Rivera void *dpl_fdt_hdr;
517125e2bc1SJ. German Rivera int dpl_size;
518125e2bc1SJ. German Rivera #endif
519125e2bc1SJ. German Rivera
520125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET
521125e2bc1SJ. German Rivera BUILD_BUG_ON((CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET & 0x3) != 0 ||
522125e2bc1SJ. German Rivera CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET > 0xffffffff);
523125e2bc1SJ. German Rivera
524125e2bc1SJ. German Rivera mc_dpl_offset = CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET;
525125e2bc1SJ. German Rivera #else
526125e2bc1SJ. German Rivera #error "CONFIG_SYS_LS_MC_DRAM_DPL_OFFSET not defined"
527125e2bc1SJ. German Rivera #endif
528125e2bc1SJ. German Rivera
529125e2bc1SJ. German Rivera /*
530125e2bc1SJ. German Rivera * Load the MC DPL blob in the MC private DRAM block:
531125e2bc1SJ. German Rivera */
532125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_DPL_IN_DDR
533125e2bc1SJ. German Rivera printf("MC DPL is preloaded to %#llx\n", mc_ram_addr + mc_dpl_offset);
534125e2bc1SJ. German Rivera #else
535125e2bc1SJ. German Rivera /*
536125e2bc1SJ. German Rivera * Get address and size of the DPL blob stored in flash:
537125e2bc1SJ. German Rivera */
538fb4a87a7SPrabhakar Kushwaha dpl_fdt_hdr = (void *)mc_dpl_addr;
539125e2bc1SJ. German Rivera
540125e2bc1SJ. German Rivera error = fdt_check_header(dpl_fdt_hdr);
541125e2bc1SJ. German Rivera if (error != 0) {
542cc088c3aSJ. German Rivera printf("\nfsl-mc: ERROR: Bad DPL image (bad header)\n");
543125e2bc1SJ. German Rivera return error;
544125e2bc1SJ. German Rivera }
545125e2bc1SJ. German Rivera
546125e2bc1SJ. German Rivera dpl_size = fdt_totalsize(dpl_fdt_hdr);
547125e2bc1SJ. German Rivera if (dpl_size > CONFIG_SYS_LS_MC_DPL_MAX_LENGTH) {
548cc088c3aSJ. German Rivera printf("\nfsl-mc: ERROR: Bad DPL image (too large: %d)\n",
549125e2bc1SJ. German Rivera dpl_size);
550125e2bc1SJ. German Rivera return -EINVAL;
551125e2bc1SJ. German Rivera }
552125e2bc1SJ. German Rivera
553125e2bc1SJ. German Rivera mc_copy_image("MC DPL blob",
554125e2bc1SJ. German Rivera (u64)dpl_fdt_hdr, dpl_size, mc_ram_addr + mc_dpl_offset);
555125e2bc1SJ. German Rivera #endif /* not defined CONFIG_SYS_LS_MC_DPL_IN_DDR */
556125e2bc1SJ. German Rivera
5571161dbccSBogdan Purcareata if (mc_fixup_dpl(mc_ram_addr + mc_dpl_offset))
5581161dbccSBogdan Purcareata return -EINVAL;
559125e2bc1SJ. German Rivera dump_ram_words("DPL", (void *)(mc_ram_addr + mc_dpl_offset));
560125e2bc1SJ. German Rivera return 0;
561125e2bc1SJ. German Rivera }
562125e2bc1SJ. German Rivera
563125e2bc1SJ. German Rivera /**
564125e2bc1SJ. German Rivera * Return the MC boot timeout value in milliseconds
565125e2bc1SJ. German Rivera */
get_mc_boot_timeout_ms(void)566125e2bc1SJ. German Rivera static unsigned long get_mc_boot_timeout_ms(void)
567125e2bc1SJ. German Rivera {
568125e2bc1SJ. German Rivera unsigned long timeout_ms = CONFIG_SYS_LS_MC_BOOT_TIMEOUT_MS;
569125e2bc1SJ. German Rivera
57000caae6dSSimon Glass char *timeout_ms_env_var = env_get(MC_BOOT_TIMEOUT_ENV_VAR);
571125e2bc1SJ. German Rivera
572125e2bc1SJ. German Rivera if (timeout_ms_env_var) {
573125e2bc1SJ. German Rivera timeout_ms = simple_strtoul(timeout_ms_env_var, NULL, 10);
574125e2bc1SJ. German Rivera if (timeout_ms == 0) {
575125e2bc1SJ. German Rivera printf("fsl-mc: WARNING: Invalid value for \'"
576125e2bc1SJ. German Rivera MC_BOOT_TIMEOUT_ENV_VAR
577125e2bc1SJ. German Rivera "\' environment variable: %lu\n",
578125e2bc1SJ. German Rivera timeout_ms);
579125e2bc1SJ. German Rivera
580125e2bc1SJ. German Rivera timeout_ms = CONFIG_SYS_LS_MC_BOOT_TIMEOUT_MS;
581125e2bc1SJ. German Rivera }
582125e2bc1SJ. German Rivera }
583125e2bc1SJ. German Rivera
584125e2bc1SJ. German Rivera return timeout_ms;
585125e2bc1SJ. German Rivera }
586125e2bc1SJ. German Rivera
587fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET
5883c1d218aSYork Sun
soc_has_aiop(void)5893c1d218aSYork Sun __weak bool soc_has_aiop(void)
5903c1d218aSYork Sun {
5913c1d218aSYork Sun return false;
5923c1d218aSYork Sun }
5933c1d218aSYork Sun
load_mc_aiop_img(u64 aiop_fw_addr)594fb4a87a7SPrabhakar Kushwaha static int load_mc_aiop_img(u64 aiop_fw_addr)
595c1000c12SJ. German Rivera {
596fb4a87a7SPrabhakar Kushwaha u64 mc_ram_addr = mc_get_dram_addr();
597fb4a87a7SPrabhakar Kushwaha #ifndef CONFIG_SYS_LS_MC_DPC_IN_DDR
598c1000c12SJ. German Rivera void *aiop_img;
599fb4a87a7SPrabhakar Kushwaha #endif
600c1000c12SJ. German Rivera
6013c1d218aSYork Sun /* Check if AIOP is available */
6023c1d218aSYork Sun if (!soc_has_aiop())
6033c1d218aSYork Sun return -ENODEV;
604c1000c12SJ. German Rivera /*
605c1000c12SJ. German Rivera * Load the MC AIOP image in the MC private DRAM block:
606c1000c12SJ. German Rivera */
607c1000c12SJ. German Rivera
608fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DPC_IN_DDR
609fb4a87a7SPrabhakar Kushwaha printf("MC AIOP is preloaded to %#llx\n", mc_ram_addr +
610fb4a87a7SPrabhakar Kushwaha CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET);
611fb4a87a7SPrabhakar Kushwaha #else
612fb4a87a7SPrabhakar Kushwaha aiop_img = (void *)aiop_fw_addr;
613c1000c12SJ. German Rivera mc_copy_image("MC AIOP image",
614c1000c12SJ. German Rivera (u64)aiop_img, CONFIG_SYS_LS_MC_AIOP_IMG_MAX_LENGTH,
615c1000c12SJ. German Rivera mc_ram_addr + CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET);
616fb4a87a7SPrabhakar Kushwaha #endif
617fb4a87a7SPrabhakar Kushwaha mc_aiop_applied = 0;
618c1000c12SJ. German Rivera
619c1000c12SJ. German Rivera return 0;
620c1000c12SJ. German Rivera }
621c1000c12SJ. German Rivera #endif
622fb4a87a7SPrabhakar Kushwaha
wait_for_mc(bool booting_mc,u32 * final_reg_gsr)623125e2bc1SJ. German Rivera static int wait_for_mc(bool booting_mc, u32 *final_reg_gsr)
624125e2bc1SJ. German Rivera {
625125e2bc1SJ. German Rivera u32 reg_gsr;
626125e2bc1SJ. German Rivera u32 mc_fw_boot_status;
627125e2bc1SJ. German Rivera unsigned long timeout_ms = get_mc_boot_timeout_ms();
628125e2bc1SJ. German Rivera struct mc_ccsr_registers __iomem *mc_ccsr_regs = MC_CCSR_BASE_ADDR;
629125e2bc1SJ. German Rivera
630125e2bc1SJ. German Rivera dmb();
631125e2bc1SJ. German Rivera assert(timeout_ms > 0);
632125e2bc1SJ. German Rivera for (;;) {
633125e2bc1SJ. German Rivera udelay(1000); /* throttle polling */
634125e2bc1SJ. German Rivera reg_gsr = in_le32(&mc_ccsr_regs->reg_gsr);
635125e2bc1SJ. German Rivera mc_fw_boot_status = (reg_gsr & GSR_FS_MASK);
636125e2bc1SJ. German Rivera if (mc_fw_boot_status & 0x1)
637125e2bc1SJ. German Rivera break;
638125e2bc1SJ. German Rivera
639125e2bc1SJ. German Rivera timeout_ms--;
640125e2bc1SJ. German Rivera if (timeout_ms == 0)
641125e2bc1SJ. German Rivera break;
642125e2bc1SJ. German Rivera }
643125e2bc1SJ. German Rivera
644125e2bc1SJ. German Rivera if (timeout_ms == 0) {
645cc088c3aSJ. German Rivera printf("ERROR: timeout\n");
646125e2bc1SJ. German Rivera
647125e2bc1SJ. German Rivera /* TODO: Get an error status from an MC CCSR register */
648125e2bc1SJ. German Rivera return -ETIMEDOUT;
649125e2bc1SJ. German Rivera }
650125e2bc1SJ. German Rivera
651125e2bc1SJ. German Rivera if (mc_fw_boot_status != 0x1) {
652125e2bc1SJ. German Rivera /*
653125e2bc1SJ. German Rivera * TODO: Identify critical errors from the GSR register's FS
654125e2bc1SJ. German Rivera * field and for those errors, set error to -ENODEV or other
655125e2bc1SJ. German Rivera * appropriate errno, so that the status property is set to
656125e2bc1SJ. German Rivera * failure in the fsl,dprc device tree node.
657125e2bc1SJ. German Rivera */
658cc088c3aSJ. German Rivera printf("WARNING: Firmware returned an error (GSR: %#x)\n",
659125e2bc1SJ. German Rivera reg_gsr);
660125e2bc1SJ. German Rivera } else {
661cc088c3aSJ. German Rivera printf("SUCCESS\n");
662125e2bc1SJ. German Rivera }
663cc088c3aSJ. German Rivera
664125e2bc1SJ. German Rivera
665125e2bc1SJ. German Rivera *final_reg_gsr = reg_gsr;
666125e2bc1SJ. German Rivera return 0;
667125e2bc1SJ. German Rivera }
6687b3bd9a7SJ. German Rivera
mc_init(u64 mc_fw_addr,u64 mc_dpc_addr)669fb4a87a7SPrabhakar Kushwaha int mc_init(u64 mc_fw_addr, u64 mc_dpc_addr)
6707b3bd9a7SJ. German Rivera {
6717b3bd9a7SJ. German Rivera int error = 0;
672a2a55e51SPrabhakar Kushwaha int portal_id = 0;
6737b3bd9a7SJ. German Rivera struct mc_ccsr_registers __iomem *mc_ccsr_regs = MC_CCSR_BASE_ADDR;
674fb4a87a7SPrabhakar Kushwaha u64 mc_ram_addr = mc_get_dram_addr();
6757b3bd9a7SJ. German Rivera u32 reg_gsr;
676125e2bc1SJ. German Rivera u32 reg_mcfbalr;
677125e2bc1SJ. German Rivera #ifndef CONFIG_SYS_LS_MC_FW_IN_DDR
6787b3bd9a7SJ. German Rivera const void *raw_image_addr;
6797b3bd9a7SJ. German Rivera size_t raw_image_size = 0;
680125e2bc1SJ. German Rivera #endif
6817b3bd9a7SJ. German Rivera struct mc_version mc_ver_info;
682125e2bc1SJ. German Rivera u8 mc_ram_num_256mb_blocks;
683125e2bc1SJ. German Rivera size_t mc_ram_size = mc_get_dram_block_size();
6847b3bd9a7SJ. German Rivera
685437858b6SYork Sun mc_ram_num_256mb_blocks = mc_ram_size / MC_RAM_SIZE_ALIGNMENT;
686*43ad41e6SMeenakshi Aggarwal
687*43ad41e6SMeenakshi Aggarwal if (mc_ram_num_256mb_blocks >= 0xff) {
688437858b6SYork Sun error = -EINVAL;
689437858b6SYork Sun printf("fsl-mc: ERROR: invalid MC private RAM size (%lu)\n",
690437858b6SYork Sun mc_ram_size);
691125e2bc1SJ. German Rivera goto out;
692437858b6SYork Sun }
693125e2bc1SJ. German Rivera
6947b3bd9a7SJ. German Rivera /*
695*43ad41e6SMeenakshi Aggarwal * To support 128 MB DDR Size for MC
696*43ad41e6SMeenakshi Aggarwal */
697*43ad41e6SMeenakshi Aggarwal if (mc_ram_num_256mb_blocks == 0)
698*43ad41e6SMeenakshi Aggarwal mc_ram_num_256mb_blocks = 0xFF;
699*43ad41e6SMeenakshi Aggarwal
700*43ad41e6SMeenakshi Aggarwal /*
7017b3bd9a7SJ. German Rivera * Management Complex cores should be held at reset out of POR.
702a187559eSBin Meng * U-Boot should be the first software to touch MC. To be safe,
7037b3bd9a7SJ. German Rivera * we reset all cores again by setting GCR1 to 0. It doesn't do
7047b3bd9a7SJ. German Rivera * anything if they are held at reset. After we setup the firmware
7057b3bd9a7SJ. German Rivera * we kick off MC by deasserting the reset bit for core 0, and
7067b3bd9a7SJ. German Rivera * deasserting the reset bits for Command Portal Managers.
7077b3bd9a7SJ. German Rivera * The stop bits are not touched here. They are used to stop the
7087b3bd9a7SJ. German Rivera * cores when they are active. Setting stop bits doesn't stop the
7097b3bd9a7SJ. German Rivera * cores from fetching instructions when they are released from
7107b3bd9a7SJ. German Rivera * reset.
7117b3bd9a7SJ. German Rivera */
7127b3bd9a7SJ. German Rivera out_le32(&mc_ccsr_regs->reg_gcr1, 0);
7137b3bd9a7SJ. German Rivera dmb();
7147b3bd9a7SJ. German Rivera
715125e2bc1SJ. German Rivera #ifdef CONFIG_SYS_LS_MC_FW_IN_DDR
716125e2bc1SJ. German Rivera printf("MC firmware is preloaded to %#llx\n", mc_ram_addr);
717125e2bc1SJ. German Rivera #else
718fb4a87a7SPrabhakar Kushwaha error = parse_mc_firmware_fit_image(mc_fw_addr, &raw_image_addr,
719fb4a87a7SPrabhakar Kushwaha &raw_image_size);
7207b3bd9a7SJ. German Rivera if (error != 0)
7217b3bd9a7SJ. German Rivera goto out;
7227b3bd9a7SJ. German Rivera /*
7237b3bd9a7SJ. German Rivera * Load the MC FW at the beginning of the MC private DRAM block:
7247b3bd9a7SJ. German Rivera */
7257b3bd9a7SJ. German Rivera mc_copy_image("MC Firmware",
7267b3bd9a7SJ. German Rivera (u64)raw_image_addr, raw_image_size, mc_ram_addr);
7277b3bd9a7SJ. German Rivera #endif
728125e2bc1SJ. German Rivera dump_ram_words("firmware", (void *)mc_ram_addr);
7297b3bd9a7SJ. German Rivera
730fb4a87a7SPrabhakar Kushwaha error = load_mc_dpc(mc_ram_addr, mc_ram_size, mc_dpc_addr);
731125e2bc1SJ. German Rivera if (error != 0)
7327b3bd9a7SJ. German Rivera goto out;
7337b3bd9a7SJ. German Rivera
7347b3bd9a7SJ. German Rivera debug("mc_ccsr_regs %p\n", mc_ccsr_regs);
735125e2bc1SJ. German Rivera dump_mc_ccsr_regs(mc_ccsr_regs);
7367b3bd9a7SJ. German Rivera
7377b3bd9a7SJ. German Rivera /*
738125e2bc1SJ. German Rivera * Tell MC what is the address range of the DRAM block assigned to it:
7397b3bd9a7SJ. German Rivera */
740*43ad41e6SMeenakshi Aggarwal if (mc_ram_num_256mb_blocks < 0xFF) {
741437858b6SYork Sun reg_mcfbalr = (u32)mc_ram_addr |
742125e2bc1SJ. German Rivera (mc_ram_num_256mb_blocks - 1);
743*43ad41e6SMeenakshi Aggarwal } else {
744*43ad41e6SMeenakshi Aggarwal reg_mcfbalr = (u32)mc_ram_addr |
745*43ad41e6SMeenakshi Aggarwal (mc_ram_num_256mb_blocks);
746*43ad41e6SMeenakshi Aggarwal }
747*43ad41e6SMeenakshi Aggarwal
748125e2bc1SJ. German Rivera out_le32(&mc_ccsr_regs->reg_mcfbalr, reg_mcfbalr);
749125e2bc1SJ. German Rivera out_le32(&mc_ccsr_regs->reg_mcfbahr,
750437858b6SYork Sun (u32)(mc_ram_addr >> 32));
75139da644eSStuart Yoder out_le32(&mc_ccsr_regs->reg_mcfapr, FSL_BYPASS_AMQ);
7527b3bd9a7SJ. German Rivera
7537b3bd9a7SJ. German Rivera /*
754125e2bc1SJ. German Rivera * Tell the MC that we want delayed DPL deployment.
7557b3bd9a7SJ. German Rivera */
756125e2bc1SJ. German Rivera out_le32(&mc_ccsr_regs->reg_gsr, 0xDD00);
7577b3bd9a7SJ. German Rivera
758cc088c3aSJ. German Rivera printf("\nfsl-mc: Booting Management Complex ... ");
7597b3bd9a7SJ. German Rivera
7607b3bd9a7SJ. German Rivera /*
7617b3bd9a7SJ. German Rivera * Deassert reset and release MC core 0 to run
7627b3bd9a7SJ. German Rivera */
7637b3bd9a7SJ. German Rivera out_le32(&mc_ccsr_regs->reg_gcr1, GCR1_P1_DE_RST | GCR1_M_ALL_DE_RST);
764125e2bc1SJ. German Rivera error = wait_for_mc(true, ®_gsr);
765125e2bc1SJ. German Rivera if (error != 0)
7667b3bd9a7SJ. German Rivera goto out;
7677b3bd9a7SJ. German Rivera
7687b3bd9a7SJ. German Rivera /*
7697b3bd9a7SJ. German Rivera * TODO: need to obtain the portal_id for the root container from the
7707b3bd9a7SJ. German Rivera * DPL
7717b3bd9a7SJ. German Rivera */
7727b3bd9a7SJ. German Rivera portal_id = 0;
7737b3bd9a7SJ. German Rivera
7747b3bd9a7SJ. German Rivera /*
775a2a55e51SPrabhakar Kushwaha * Initialize the global default MC portal
776a2a55e51SPrabhakar Kushwaha * And check that the MC firmware is responding portal commands:
7777b3bd9a7SJ. German Rivera */
778a572fb6bSPrabhakar Kushwaha root_mc_io = (struct fsl_mc_io *)calloc(sizeof(struct fsl_mc_io), 1);
7791730a17dSPrabhakar Kushwaha if (!root_mc_io) {
780a572fb6bSPrabhakar Kushwaha printf(" No memory: calloc() failed\n");
781a2a55e51SPrabhakar Kushwaha return -ENOMEM;
782a2a55e51SPrabhakar Kushwaha }
7837b3bd9a7SJ. German Rivera
7841730a17dSPrabhakar Kushwaha root_mc_io->mmio_regs = SOC_MC_PORTAL_ADDR(portal_id);
785a2a55e51SPrabhakar Kushwaha debug("Checking access to MC portal of root DPRC container (portal_id %d, portal physical addr %p)\n",
7861730a17dSPrabhakar Kushwaha portal_id, root_mc_io->mmio_regs);
787a2a55e51SPrabhakar Kushwaha
7881730a17dSPrabhakar Kushwaha error = mc_get_version(root_mc_io, MC_CMD_NO_FLAGS, &mc_ver_info);
7897b3bd9a7SJ. German Rivera if (error != 0) {
7907b3bd9a7SJ. German Rivera printf("fsl-mc: ERROR: Firmware version check failed (error: %d)\n",
7917b3bd9a7SJ. German Rivera error);
7927b3bd9a7SJ. German Rivera goto out;
7937b3bd9a7SJ. German Rivera }
7947b3bd9a7SJ. German Rivera
7957b3bd9a7SJ. German Rivera printf("fsl-mc: Management Complex booted (version: %d.%d.%d, boot status: %#x)\n",
7967b3bd9a7SJ. German Rivera mc_ver_info.major, mc_ver_info.minor, mc_ver_info.revision,
797125e2bc1SJ. German Rivera reg_gsr & GSR_FS_MASK);
798125e2bc1SJ. German Rivera
7997b3bd9a7SJ. German Rivera out:
8007b3bd9a7SJ. German Rivera if (error != 0)
8012b7c4a19SPrabhakar Kushwaha mc_boot_status = error;
8027b3bd9a7SJ. German Rivera else
8037b3bd9a7SJ. German Rivera mc_boot_status = 0;
8047b3bd9a7SJ. German Rivera
8057b3bd9a7SJ. German Rivera return error;
8067b3bd9a7SJ. German Rivera }
8077b3bd9a7SJ. German Rivera
mc_apply_dpl(u64 mc_dpl_addr)808fb4a87a7SPrabhakar Kushwaha int mc_apply_dpl(u64 mc_dpl_addr)
809fb4a87a7SPrabhakar Kushwaha {
810fb4a87a7SPrabhakar Kushwaha struct mc_ccsr_registers __iomem *mc_ccsr_regs = MC_CCSR_BASE_ADDR;
811fb4a87a7SPrabhakar Kushwaha int error = 0;
812fb4a87a7SPrabhakar Kushwaha u32 reg_gsr;
813fb4a87a7SPrabhakar Kushwaha u64 mc_ram_addr = mc_get_dram_addr();
814fb4a87a7SPrabhakar Kushwaha size_t mc_ram_size = mc_get_dram_block_size();
815fb4a87a7SPrabhakar Kushwaha
816b7b8410aSAlexander Graf if (!mc_dpl_addr)
817b7b8410aSAlexander Graf return -1;
818b7b8410aSAlexander Graf
819fb4a87a7SPrabhakar Kushwaha error = load_mc_dpl(mc_ram_addr, mc_ram_size, mc_dpl_addr);
820fb4a87a7SPrabhakar Kushwaha if (error != 0)
821fb4a87a7SPrabhakar Kushwaha return error;
822fb4a87a7SPrabhakar Kushwaha
823fb4a87a7SPrabhakar Kushwaha /*
824fb4a87a7SPrabhakar Kushwaha * Tell the MC to deploy the DPL:
825fb4a87a7SPrabhakar Kushwaha */
826fb4a87a7SPrabhakar Kushwaha out_le32(&mc_ccsr_regs->reg_gsr, 0x0);
827fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: Deploying data path layout ... ");
828fb4a87a7SPrabhakar Kushwaha error = wait_for_mc(false, ®_gsr);
829fb4a87a7SPrabhakar Kushwaha
830fb4a87a7SPrabhakar Kushwaha if (!error)
831fb4a87a7SPrabhakar Kushwaha mc_dpl_applied = 0;
832fb4a87a7SPrabhakar Kushwaha
833fb4a87a7SPrabhakar Kushwaha return error;
834fb4a87a7SPrabhakar Kushwaha }
835fb4a87a7SPrabhakar Kushwaha
get_mc_boot_status(void)8367b3bd9a7SJ. German Rivera int get_mc_boot_status(void)
8377b3bd9a7SJ. German Rivera {
8387b3bd9a7SJ. German Rivera return mc_boot_status;
8397b3bd9a7SJ. German Rivera }
8407b3bd9a7SJ. German Rivera
841fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET
get_aiop_apply_status(void)842fb4a87a7SPrabhakar Kushwaha int get_aiop_apply_status(void)
843fb4a87a7SPrabhakar Kushwaha {
844fb4a87a7SPrabhakar Kushwaha return mc_aiop_applied;
845fb4a87a7SPrabhakar Kushwaha }
846fb4a87a7SPrabhakar Kushwaha #endif
847fb4a87a7SPrabhakar Kushwaha
get_dpl_apply_status(void)848fb4a87a7SPrabhakar Kushwaha int get_dpl_apply_status(void)
849fb4a87a7SPrabhakar Kushwaha {
850fb4a87a7SPrabhakar Kushwaha return mc_dpl_applied;
851fb4a87a7SPrabhakar Kushwaha }
852fb4a87a7SPrabhakar Kushwaha
is_lazy_dpl_addr_valid(void)8537e968049SMian Yousaf Kaukab int is_lazy_dpl_addr_valid(void)
8547e968049SMian Yousaf Kaukab {
8557e968049SMian Yousaf Kaukab return !!mc_lazy_dpl_addr;
8567e968049SMian Yousaf Kaukab }
8577e968049SMian Yousaf Kaukab
858033c538eSPriyanka Jain /*
859fb4a87a7SPrabhakar Kushwaha * Return the MC address of private DRAM block.
860033c538eSPriyanka Jain * As per MC design document, MC initial base address
861033c538eSPriyanka Jain * should be least significant 512MB address of MC private
862033c538eSPriyanka Jain * memory, i.e. address should point to end address masked
863033c538eSPriyanka Jain * with 512MB offset in private DRAM block.
864fb4a87a7SPrabhakar Kushwaha */
mc_get_dram_addr(void)865fb4a87a7SPrabhakar Kushwaha u64 mc_get_dram_addr(void)
866fb4a87a7SPrabhakar Kushwaha {
867033c538eSPriyanka Jain size_t mc_ram_size = mc_get_dram_block_size();
868033c538eSPriyanka Jain
86987519a9eSPrabhakar Kushwaha if (!mc_memset_resv_ram || (get_mc_boot_status() < 0)) {
87087519a9eSPrabhakar Kushwaha mc_memset_resv_ram = 1;
87187519a9eSPrabhakar Kushwaha memset((void *)gd->arch.resv_ram, 0, mc_ram_size);
87287519a9eSPrabhakar Kushwaha }
87387519a9eSPrabhakar Kushwaha
874033c538eSPriyanka Jain return (gd->arch.resv_ram + mc_ram_size - 1) &
875033c538eSPriyanka Jain MC_RAM_BASE_ADDR_ALIGNMENT_MASK;
876fb4a87a7SPrabhakar Kushwaha }
877fb4a87a7SPrabhakar Kushwaha
8787b3bd9a7SJ. German Rivera /**
8797b3bd9a7SJ. German Rivera * Return the actual size of the MC private DRAM block.
8807b3bd9a7SJ. German Rivera */
mc_get_dram_block_size(void)8817b3bd9a7SJ. German Rivera unsigned long mc_get_dram_block_size(void)
8827b3bd9a7SJ. German Rivera {
883125e2bc1SJ. German Rivera unsigned long dram_block_size = CONFIG_SYS_LS_MC_DRAM_BLOCK_MIN_SIZE;
884125e2bc1SJ. German Rivera
88500caae6dSSimon Glass char *dram_block_size_env_var = env_get(MC_MEM_SIZE_ENV_VAR);
886125e2bc1SJ. German Rivera
887125e2bc1SJ. German Rivera if (dram_block_size_env_var) {
888125e2bc1SJ. German Rivera dram_block_size = simple_strtoul(dram_block_size_env_var, NULL,
889f53e12d8SPrabhakar Kushwaha 16);
890125e2bc1SJ. German Rivera
891125e2bc1SJ. German Rivera if (dram_block_size < CONFIG_SYS_LS_MC_DRAM_BLOCK_MIN_SIZE) {
892125e2bc1SJ. German Rivera printf("fsl-mc: WARNING: Invalid value for \'"
893125e2bc1SJ. German Rivera MC_MEM_SIZE_ENV_VAR
894125e2bc1SJ. German Rivera "\' environment variable: %lu\n",
895125e2bc1SJ. German Rivera dram_block_size);
896125e2bc1SJ. German Rivera
897*43ad41e6SMeenakshi Aggarwal dram_block_size = MC_DRAM_BLOCK_DEFAULT_SIZE;
898125e2bc1SJ. German Rivera }
899125e2bc1SJ. German Rivera }
900125e2bc1SJ. German Rivera
901125e2bc1SJ. German Rivera return dram_block_size;
9027b3bd9a7SJ. German Rivera }
903a2a55e51SPrabhakar Kushwaha
fsl_mc_ldpaa_init(bd_t * bis)9041730a17dSPrabhakar Kushwaha int fsl_mc_ldpaa_init(bd_t *bis)
9051730a17dSPrabhakar Kushwaha {
906c919ab9eSPrabhakar Kushwaha int i;
907c919ab9eSPrabhakar Kushwaha
908c919ab9eSPrabhakar Kushwaha for (i = WRIOP1_DPMAC1; i < NUM_WRIOP_PORTS; i++)
9091ed19a14SPankaj Bansal if (wriop_is_enabled_dpmac(i) == 1)
910c919ab9eSPrabhakar Kushwaha ldpaa_eth_init(i, wriop_get_enet_if(i));
9111730a17dSPrabhakar Kushwaha return 0;
9121730a17dSPrabhakar Kushwaha }
9131730a17dSPrabhakar Kushwaha
dprc_version_check(struct fsl_mc_io * mc_io,uint16_t handle)9149a696f56SPrabhakar Kushwaha static int dprc_version_check(struct fsl_mc_io *mc_io, uint16_t handle)
9159a696f56SPrabhakar Kushwaha {
9169a696f56SPrabhakar Kushwaha int error;
9172557c5a9SYogesh Gaur uint16_t major_ver, minor_ver;
9189a696f56SPrabhakar Kushwaha
9192557c5a9SYogesh Gaur error = dprc_get_api_version(mc_io, 0,
9202557c5a9SYogesh Gaur &major_ver,
9212557c5a9SYogesh Gaur &minor_ver);
9222557c5a9SYogesh Gaur if (error < 0) {
9232557c5a9SYogesh Gaur printf("dprc_get_api_version() failed: %d\n", error);
9242557c5a9SYogesh Gaur return error;
9252557c5a9SYogesh Gaur }
9262557c5a9SYogesh Gaur
9272557c5a9SYogesh Gaur if (major_ver < DPRC_VER_MAJOR || (major_ver == DPRC_VER_MAJOR &&
9282557c5a9SYogesh Gaur minor_ver < DPRC_VER_MINOR)) {
9299a696f56SPrabhakar Kushwaha printf("DPRC version mismatch found %u.%u,",
9302557c5a9SYogesh Gaur major_ver, minor_ver);
9319a696f56SPrabhakar Kushwaha printf("supported version is %u.%u\n",
9329a696f56SPrabhakar Kushwaha DPRC_VER_MAJOR, DPRC_VER_MINOR);
9339a696f56SPrabhakar Kushwaha }
9342557c5a9SYogesh Gaur
9359a696f56SPrabhakar Kushwaha return error;
9369a696f56SPrabhakar Kushwaha }
9379a696f56SPrabhakar Kushwaha
dpio_init(void)9381730a17dSPrabhakar Kushwaha static int dpio_init(void)
939a2a55e51SPrabhakar Kushwaha {
940a2a55e51SPrabhakar Kushwaha struct qbman_swp_desc p_des;
941a2a55e51SPrabhakar Kushwaha struct dpio_attr attr;
9421730a17dSPrabhakar Kushwaha struct dpio_cfg dpio_cfg;
943a2a55e51SPrabhakar Kushwaha int err = 0;
9442557c5a9SYogesh Gaur uint16_t major_ver, minor_ver;
945a2a55e51SPrabhakar Kushwaha
946a572fb6bSPrabhakar Kushwaha dflt_dpio = (struct fsl_dpio_obj *)calloc(
947a572fb6bSPrabhakar Kushwaha sizeof(struct fsl_dpio_obj), 1);
948a2a55e51SPrabhakar Kushwaha if (!dflt_dpio) {
949a572fb6bSPrabhakar Kushwaha printf("No memory: calloc() failed\n");
9501730a17dSPrabhakar Kushwaha err = -ENOMEM;
951a572fb6bSPrabhakar Kushwaha goto err_calloc;
952a2a55e51SPrabhakar Kushwaha }
9531730a17dSPrabhakar Kushwaha dpio_cfg.channel_mode = DPIO_LOCAL_CHANNEL;
9541730a17dSPrabhakar Kushwaha dpio_cfg.num_priorities = 8;
955a2a55e51SPrabhakar Kushwaha
9562557c5a9SYogesh Gaur err = dpio_create(dflt_mc_io,
9572557c5a9SYogesh Gaur dflt_dprc_handle,
9582557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
9592557c5a9SYogesh Gaur &dpio_cfg,
9602557c5a9SYogesh Gaur &dflt_dpio->dpio_id);
9611730a17dSPrabhakar Kushwaha if (err < 0) {
9621730a17dSPrabhakar Kushwaha printf("dpio_create() failed: %d\n", err);
9631730a17dSPrabhakar Kushwaha err = -ENODEV;
9641730a17dSPrabhakar Kushwaha goto err_create;
965a2a55e51SPrabhakar Kushwaha }
966a2a55e51SPrabhakar Kushwaha
9672557c5a9SYogesh Gaur err = dpio_get_api_version(dflt_mc_io, 0,
9682557c5a9SYogesh Gaur &major_ver,
9692557c5a9SYogesh Gaur &minor_ver);
9702557c5a9SYogesh Gaur if (err < 0) {
9712557c5a9SYogesh Gaur printf("dpio_get_api_version() failed: %d\n", err);
9722557c5a9SYogesh Gaur goto err_get_api_ver;
9732557c5a9SYogesh Gaur }
9742557c5a9SYogesh Gaur
9752557c5a9SYogesh Gaur if (major_ver < DPIO_VER_MAJOR || (major_ver == DPIO_VER_MAJOR &&
9762557c5a9SYogesh Gaur minor_ver < DPIO_VER_MINOR)) {
9772557c5a9SYogesh Gaur printf("DPRC version mismatch found %u.%u,",
9782557c5a9SYogesh Gaur major_ver,
9792557c5a9SYogesh Gaur minor_ver);
9802557c5a9SYogesh Gaur }
9812557c5a9SYogesh Gaur
9822557c5a9SYogesh Gaur err = dpio_open(dflt_mc_io,
9832557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
9842557c5a9SYogesh Gaur dflt_dpio->dpio_id,
9852557c5a9SYogesh Gaur &dflt_dpio->dpio_handle);
9862557c5a9SYogesh Gaur if (err) {
9872557c5a9SYogesh Gaur printf("dpio_open() failed\n");
9882557c5a9SYogesh Gaur goto err_open;
9892557c5a9SYogesh Gaur }
9902557c5a9SYogesh Gaur
9911730a17dSPrabhakar Kushwaha memset(&attr, 0, sizeof(struct dpio_attr));
99287457d11SPrabhakar Kushwaha err = dpio_get_attributes(dflt_mc_io, MC_CMD_NO_FLAGS,
9931730a17dSPrabhakar Kushwaha dflt_dpio->dpio_handle, &attr);
9941730a17dSPrabhakar Kushwaha if (err < 0) {
9951730a17dSPrabhakar Kushwaha printf("dpio_get_attributes() failed: %d\n", err);
996a2a55e51SPrabhakar Kushwaha goto err_get_attr;
997a2a55e51SPrabhakar Kushwaha }
998a2a55e51SPrabhakar Kushwaha
9992557c5a9SYogesh Gaur if (dflt_dpio->dpio_id != attr.id) {
10002557c5a9SYogesh Gaur printf("dnpi object id and attribute id are not same\n");
10012557c5a9SYogesh Gaur goto err_attr_not_same;
10029a696f56SPrabhakar Kushwaha }
10039a696f56SPrabhakar Kushwaha
10041730a17dSPrabhakar Kushwaha #ifdef DEBUG
10051730a17dSPrabhakar Kushwaha printf("Init: DPIO id=0x%d\n", dflt_dpio->dpio_id);
10061730a17dSPrabhakar Kushwaha #endif
10071730a17dSPrabhakar Kushwaha err = dpio_enable(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle);
10081730a17dSPrabhakar Kushwaha if (err < 0) {
1009a2a55e51SPrabhakar Kushwaha printf("dpio_enable() failed %d\n", err);
1010a2a55e51SPrabhakar Kushwaha goto err_get_enable;
1011a2a55e51SPrabhakar Kushwaha }
10121f1c25c7SPrabhakar Kushwaha debug("ce_offset=0x%llx, ci_offset=0x%llx, portalid=%d, prios=%d\n",
10131f1c25c7SPrabhakar Kushwaha attr.qbman_portal_ce_offset,
10141f1c25c7SPrabhakar Kushwaha attr.qbman_portal_ci_offset,
1015a2a55e51SPrabhakar Kushwaha attr.qbman_portal_id,
1016a2a55e51SPrabhakar Kushwaha attr.num_priorities);
1017a2a55e51SPrabhakar Kushwaha
10181f1c25c7SPrabhakar Kushwaha p_des.cena_bar = (void *)(SOC_QBMAN_PORTALS_BASE_ADDR
10191f1c25c7SPrabhakar Kushwaha + attr.qbman_portal_ce_offset);
10201f1c25c7SPrabhakar Kushwaha p_des.cinh_bar = (void *)(SOC_QBMAN_PORTALS_BASE_ADDR
10211f1c25c7SPrabhakar Kushwaha + attr.qbman_portal_ci_offset);
1022a2a55e51SPrabhakar Kushwaha
1023a2a55e51SPrabhakar Kushwaha dflt_dpio->sw_portal = qbman_swp_init(&p_des);
1024a2a55e51SPrabhakar Kushwaha if (dflt_dpio->sw_portal == NULL) {
1025a2a55e51SPrabhakar Kushwaha printf("qbman_swp_init() failed\n");
1026a2a55e51SPrabhakar Kushwaha goto err_get_swp_init;
1027a2a55e51SPrabhakar Kushwaha }
1028a2a55e51SPrabhakar Kushwaha return 0;
1029a2a55e51SPrabhakar Kushwaha
1030a2a55e51SPrabhakar Kushwaha err_get_swp_init:
10311730a17dSPrabhakar Kushwaha dpio_disable(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle);
1032a2a55e51SPrabhakar Kushwaha err_get_enable:
10331730a17dSPrabhakar Kushwaha err_get_attr:
10342557c5a9SYogesh Gaur err_attr_not_same:
10351730a17dSPrabhakar Kushwaha dpio_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle);
10362557c5a9SYogesh Gaur err_open:
10372557c5a9SYogesh Gaur err_get_api_ver:
10382557c5a9SYogesh Gaur dpio_destroy(dflt_mc_io,
10392557c5a9SYogesh Gaur dflt_dprc_handle,
10402557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
10412557c5a9SYogesh Gaur dflt_dpio->dpio_id);
10421730a17dSPrabhakar Kushwaha err_create:
1043cd7b3fbcSPrabhakar Kushwaha free(dflt_dpio);
1044a572fb6bSPrabhakar Kushwaha err_calloc:
1045a2a55e51SPrabhakar Kushwaha return err;
1046a2a55e51SPrabhakar Kushwaha }
1047a2a55e51SPrabhakar Kushwaha
dpio_exit(void)10481730a17dSPrabhakar Kushwaha static int dpio_exit(void)
1049a2a55e51SPrabhakar Kushwaha {
10501730a17dSPrabhakar Kushwaha int err;
10511730a17dSPrabhakar Kushwaha
10521730a17dSPrabhakar Kushwaha err = dpio_disable(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle);
10531730a17dSPrabhakar Kushwaha if (err < 0) {
10541730a17dSPrabhakar Kushwaha printf("dpio_disable() failed: %d\n", err);
10551730a17dSPrabhakar Kushwaha goto err;
10561730a17dSPrabhakar Kushwaha }
10571730a17dSPrabhakar Kushwaha
10582557c5a9SYogesh Gaur dpio_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpio->dpio_handle);
10592557c5a9SYogesh Gaur if (err < 0) {
10602557c5a9SYogesh Gaur printf("dpio_close() failed: %d\n", err);
10612557c5a9SYogesh Gaur goto err;
10622557c5a9SYogesh Gaur }
10632557c5a9SYogesh Gaur
10642557c5a9SYogesh Gaur err = dpio_destroy(dflt_mc_io,
10652557c5a9SYogesh Gaur dflt_dprc_handle,
10662557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
10672557c5a9SYogesh Gaur dflt_dpio->dpio_id);
10681730a17dSPrabhakar Kushwaha if (err < 0) {
10691730a17dSPrabhakar Kushwaha printf("dpio_destroy() failed: %d\n", err);
10701730a17dSPrabhakar Kushwaha goto err;
10711730a17dSPrabhakar Kushwaha }
10721730a17dSPrabhakar Kushwaha
10731730a17dSPrabhakar Kushwaha #ifdef DEBUG
10741730a17dSPrabhakar Kushwaha printf("Exit: DPIO id=0x%d\n", dflt_dpio->dpio_id);
10751730a17dSPrabhakar Kushwaha #endif
10761730a17dSPrabhakar Kushwaha
10771730a17dSPrabhakar Kushwaha if (dflt_dpio)
10781730a17dSPrabhakar Kushwaha free(dflt_dpio);
10791730a17dSPrabhakar Kushwaha
10801730a17dSPrabhakar Kushwaha return 0;
10811730a17dSPrabhakar Kushwaha err:
10821730a17dSPrabhakar Kushwaha return err;
10831730a17dSPrabhakar Kushwaha }
10841730a17dSPrabhakar Kushwaha
dprc_init(void)10851730a17dSPrabhakar Kushwaha static int dprc_init(void)
10861730a17dSPrabhakar Kushwaha {
10871730a17dSPrabhakar Kushwaha int err, child_portal_id, container_id;
10881730a17dSPrabhakar Kushwaha struct dprc_cfg cfg;
10891730a17dSPrabhakar Kushwaha uint64_t mc_portal_offset;
10901730a17dSPrabhakar Kushwaha
10911730a17dSPrabhakar Kushwaha /* Open root container */
10921730a17dSPrabhakar Kushwaha err = dprc_get_container_id(root_mc_io, MC_CMD_NO_FLAGS, &container_id);
10931730a17dSPrabhakar Kushwaha if (err < 0) {
10941730a17dSPrabhakar Kushwaha printf("dprc_get_container_id(): Root failed: %d\n", err);
10951730a17dSPrabhakar Kushwaha goto err_root_container_id;
10961730a17dSPrabhakar Kushwaha }
10971730a17dSPrabhakar Kushwaha
10981730a17dSPrabhakar Kushwaha #ifdef DEBUG
10991730a17dSPrabhakar Kushwaha printf("Root container id = %d\n", container_id);
11001730a17dSPrabhakar Kushwaha #endif
11011730a17dSPrabhakar Kushwaha err = dprc_open(root_mc_io, MC_CMD_NO_FLAGS, container_id,
11021730a17dSPrabhakar Kushwaha &root_dprc_handle);
11031730a17dSPrabhakar Kushwaha if (err < 0) {
11041730a17dSPrabhakar Kushwaha printf("dprc_open(): Root Container failed: %d\n", err);
11051730a17dSPrabhakar Kushwaha goto err_root_open;
11061730a17dSPrabhakar Kushwaha }
11071730a17dSPrabhakar Kushwaha
11081730a17dSPrabhakar Kushwaha if (!root_dprc_handle) {
11091730a17dSPrabhakar Kushwaha printf("dprc_open(): Root Container Handle is not valid\n");
11101730a17dSPrabhakar Kushwaha goto err_root_open;
11111730a17dSPrabhakar Kushwaha }
11121730a17dSPrabhakar Kushwaha
11139a696f56SPrabhakar Kushwaha err = dprc_version_check(root_mc_io, root_dprc_handle);
11149a696f56SPrabhakar Kushwaha if (err < 0) {
11159a696f56SPrabhakar Kushwaha printf("dprc_version_check() failed: %d\n", err);
11169a696f56SPrabhakar Kushwaha goto err_root_open;
11179a696f56SPrabhakar Kushwaha }
11189a696f56SPrabhakar Kushwaha
11195373b204SPrabhakar Kushwaha memset(&cfg, 0, sizeof(struct dprc_cfg));
11201730a17dSPrabhakar Kushwaha cfg.options = DPRC_CFG_OPT_TOPOLOGY_CHANGES_ALLOWED |
11211730a17dSPrabhakar Kushwaha DPRC_CFG_OPT_OBJ_CREATE_ALLOWED |
11221730a17dSPrabhakar Kushwaha DPRC_CFG_OPT_ALLOC_ALLOWED;
11231730a17dSPrabhakar Kushwaha cfg.icid = DPRC_GET_ICID_FROM_POOL;
1124335b1936SPrabhakar Kushwaha cfg.portal_id = DPRC_GET_PORTAL_ID_FROM_POOL;
11251730a17dSPrabhakar Kushwaha err = dprc_create_container(root_mc_io, MC_CMD_NO_FLAGS,
11261730a17dSPrabhakar Kushwaha root_dprc_handle,
11271730a17dSPrabhakar Kushwaha &cfg,
11281730a17dSPrabhakar Kushwaha &child_dprc_id,
11291730a17dSPrabhakar Kushwaha &mc_portal_offset);
11301730a17dSPrabhakar Kushwaha if (err < 0) {
11311730a17dSPrabhakar Kushwaha printf("dprc_create_container() failed: %d\n", err);
11321730a17dSPrabhakar Kushwaha goto err_create;
11331730a17dSPrabhakar Kushwaha }
11341730a17dSPrabhakar Kushwaha
1135a572fb6bSPrabhakar Kushwaha dflt_mc_io = (struct fsl_mc_io *)calloc(sizeof(struct fsl_mc_io), 1);
11361730a17dSPrabhakar Kushwaha if (!dflt_mc_io) {
11371730a17dSPrabhakar Kushwaha err = -ENOMEM;
1138a572fb6bSPrabhakar Kushwaha printf(" No memory: calloc() failed\n");
1139a572fb6bSPrabhakar Kushwaha goto err_calloc;
11401730a17dSPrabhakar Kushwaha }
11411730a17dSPrabhakar Kushwaha
11421730a17dSPrabhakar Kushwaha child_portal_id = MC_PORTAL_OFFSET_TO_PORTAL_ID(mc_portal_offset);
11431730a17dSPrabhakar Kushwaha dflt_mc_io->mmio_regs = SOC_MC_PORTAL_ADDR(child_portal_id);
11442557c5a9SYogesh Gaur
11451730a17dSPrabhakar Kushwaha #ifdef DEBUG
11461730a17dSPrabhakar Kushwaha printf("MC portal of child DPRC container: %d, physical addr %p)\n",
11471730a17dSPrabhakar Kushwaha child_dprc_id, dflt_mc_io->mmio_regs);
11481730a17dSPrabhakar Kushwaha #endif
11491730a17dSPrabhakar Kushwaha
11501730a17dSPrabhakar Kushwaha err = dprc_open(dflt_mc_io, MC_CMD_NO_FLAGS, child_dprc_id,
11511730a17dSPrabhakar Kushwaha &dflt_dprc_handle);
11521730a17dSPrabhakar Kushwaha if (err < 0) {
11531730a17dSPrabhakar Kushwaha printf("dprc_open(): Child container failed: %d\n", err);
11541730a17dSPrabhakar Kushwaha goto err_child_open;
11551730a17dSPrabhakar Kushwaha }
11561730a17dSPrabhakar Kushwaha
11571730a17dSPrabhakar Kushwaha if (!dflt_dprc_handle) {
11581730a17dSPrabhakar Kushwaha printf("dprc_open(): Child container Handle is not valid\n");
11591730a17dSPrabhakar Kushwaha goto err_child_open;
11601730a17dSPrabhakar Kushwaha }
11611730a17dSPrabhakar Kushwaha
11621730a17dSPrabhakar Kushwaha return 0;
11631730a17dSPrabhakar Kushwaha err_child_open:
11641730a17dSPrabhakar Kushwaha free(dflt_mc_io);
1165a572fb6bSPrabhakar Kushwaha err_calloc:
11661730a17dSPrabhakar Kushwaha dprc_destroy_container(root_mc_io, MC_CMD_NO_FLAGS,
11671730a17dSPrabhakar Kushwaha root_dprc_handle, child_dprc_id);
11681730a17dSPrabhakar Kushwaha err_create:
11691730a17dSPrabhakar Kushwaha dprc_close(root_mc_io, MC_CMD_NO_FLAGS, root_dprc_handle);
11701730a17dSPrabhakar Kushwaha err_root_open:
11711730a17dSPrabhakar Kushwaha err_root_container_id:
11721730a17dSPrabhakar Kushwaha return err;
11731730a17dSPrabhakar Kushwaha }
11741730a17dSPrabhakar Kushwaha
dprc_exit(void)11751730a17dSPrabhakar Kushwaha static int dprc_exit(void)
11761730a17dSPrabhakar Kushwaha {
11771730a17dSPrabhakar Kushwaha int err;
11781730a17dSPrabhakar Kushwaha
11791730a17dSPrabhakar Kushwaha err = dprc_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dprc_handle);
11801730a17dSPrabhakar Kushwaha if (err < 0) {
11811730a17dSPrabhakar Kushwaha printf("dprc_close(): Child failed: %d\n", err);
11821730a17dSPrabhakar Kushwaha goto err;
11831730a17dSPrabhakar Kushwaha }
11841730a17dSPrabhakar Kushwaha
11851730a17dSPrabhakar Kushwaha err = dprc_destroy_container(root_mc_io, MC_CMD_NO_FLAGS,
11861730a17dSPrabhakar Kushwaha root_dprc_handle, child_dprc_id);
11871730a17dSPrabhakar Kushwaha if (err < 0) {
11881730a17dSPrabhakar Kushwaha printf("dprc_destroy_container() failed: %d\n", err);
11891730a17dSPrabhakar Kushwaha goto err;
11901730a17dSPrabhakar Kushwaha }
11911730a17dSPrabhakar Kushwaha
11921730a17dSPrabhakar Kushwaha err = dprc_close(root_mc_io, MC_CMD_NO_FLAGS, root_dprc_handle);
11931730a17dSPrabhakar Kushwaha if (err < 0) {
11941730a17dSPrabhakar Kushwaha printf("dprc_close(): Root failed: %d\n", err);
11951730a17dSPrabhakar Kushwaha goto err;
11961730a17dSPrabhakar Kushwaha }
11971730a17dSPrabhakar Kushwaha
11981730a17dSPrabhakar Kushwaha if (dflt_mc_io)
11991730a17dSPrabhakar Kushwaha free(dflt_mc_io);
12001730a17dSPrabhakar Kushwaha
12011730a17dSPrabhakar Kushwaha if (root_mc_io)
12021730a17dSPrabhakar Kushwaha free(root_mc_io);
12031730a17dSPrabhakar Kushwaha
12041730a17dSPrabhakar Kushwaha return 0;
12051730a17dSPrabhakar Kushwaha
12061730a17dSPrabhakar Kushwaha err:
12071730a17dSPrabhakar Kushwaha return err;
12081730a17dSPrabhakar Kushwaha }
12091730a17dSPrabhakar Kushwaha
dpbp_init(void)12101730a17dSPrabhakar Kushwaha static int dpbp_init(void)
12111730a17dSPrabhakar Kushwaha {
12121730a17dSPrabhakar Kushwaha int err;
12131730a17dSPrabhakar Kushwaha struct dpbp_attr dpbp_attr;
12141730a17dSPrabhakar Kushwaha struct dpbp_cfg dpbp_cfg;
12152557c5a9SYogesh Gaur uint16_t major_ver, minor_ver;
12161730a17dSPrabhakar Kushwaha
1217a572fb6bSPrabhakar Kushwaha dflt_dpbp = (struct fsl_dpbp_obj *)calloc(
1218a572fb6bSPrabhakar Kushwaha sizeof(struct fsl_dpbp_obj), 1);
1219a2a55e51SPrabhakar Kushwaha if (!dflt_dpbp) {
1220a572fb6bSPrabhakar Kushwaha printf("No memory: calloc() failed\n");
12211730a17dSPrabhakar Kushwaha err = -ENOMEM;
1222a572fb6bSPrabhakar Kushwaha goto err_calloc;
1223a2a55e51SPrabhakar Kushwaha }
12241730a17dSPrabhakar Kushwaha
12251730a17dSPrabhakar Kushwaha dpbp_cfg.options = 512;
12261730a17dSPrabhakar Kushwaha
12272557c5a9SYogesh Gaur err = dpbp_create(dflt_mc_io,
12282557c5a9SYogesh Gaur dflt_dprc_handle,
12292557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
12302557c5a9SYogesh Gaur &dpbp_cfg,
12312557c5a9SYogesh Gaur &dflt_dpbp->dpbp_id);
12321730a17dSPrabhakar Kushwaha
12331730a17dSPrabhakar Kushwaha if (err < 0) {
12341730a17dSPrabhakar Kushwaha err = -ENODEV;
12351730a17dSPrabhakar Kushwaha printf("dpbp_create() failed: %d\n", err);
12361730a17dSPrabhakar Kushwaha goto err_create;
12371730a17dSPrabhakar Kushwaha }
12381730a17dSPrabhakar Kushwaha
12392557c5a9SYogesh Gaur err = dpbp_get_api_version(dflt_mc_io, 0,
12402557c5a9SYogesh Gaur &major_ver,
12412557c5a9SYogesh Gaur &minor_ver);
12422557c5a9SYogesh Gaur if (err < 0) {
12432557c5a9SYogesh Gaur printf("dpbp_get_api_version() failed: %d\n", err);
12442557c5a9SYogesh Gaur goto err_get_api_ver;
12452557c5a9SYogesh Gaur }
12462557c5a9SYogesh Gaur
12472557c5a9SYogesh Gaur if (major_ver < DPBP_VER_MAJOR || (major_ver == DPBP_VER_MAJOR &&
12482557c5a9SYogesh Gaur minor_ver < DPBP_VER_MINOR)) {
12492557c5a9SYogesh Gaur printf("DPBP version mismatch found %u.%u,",
12502557c5a9SYogesh Gaur major_ver, minor_ver);
12512557c5a9SYogesh Gaur printf("supported version is %u.%u\n",
12522557c5a9SYogesh Gaur DPBP_VER_MAJOR, DPBP_VER_MINOR);
12532557c5a9SYogesh Gaur }
12542557c5a9SYogesh Gaur
12552557c5a9SYogesh Gaur err = dpbp_open(dflt_mc_io,
12562557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
12572557c5a9SYogesh Gaur dflt_dpbp->dpbp_id,
12582557c5a9SYogesh Gaur &dflt_dpbp->dpbp_handle);
12592557c5a9SYogesh Gaur if (err) {
12602557c5a9SYogesh Gaur printf("dpbp_open() failed\n");
12612557c5a9SYogesh Gaur goto err_open;
12622557c5a9SYogesh Gaur }
12632557c5a9SYogesh Gaur
12641730a17dSPrabhakar Kushwaha memset(&dpbp_attr, 0, sizeof(struct dpbp_attr));
12651730a17dSPrabhakar Kushwaha err = dpbp_get_attributes(dflt_mc_io, MC_CMD_NO_FLAGS,
12661730a17dSPrabhakar Kushwaha dflt_dpbp->dpbp_handle,
12671730a17dSPrabhakar Kushwaha &dpbp_attr);
12681730a17dSPrabhakar Kushwaha if (err < 0) {
12691730a17dSPrabhakar Kushwaha printf("dpbp_get_attributes() failed: %d\n", err);
12701730a17dSPrabhakar Kushwaha goto err_get_attr;
12711730a17dSPrabhakar Kushwaha }
12721730a17dSPrabhakar Kushwaha
12732557c5a9SYogesh Gaur if (dflt_dpbp->dpbp_id != dpbp_attr.id) {
12742557c5a9SYogesh Gaur printf("dpbp object id and attribute id are not same\n");
12752557c5a9SYogesh Gaur goto err_attr_not_same;
12769a696f56SPrabhakar Kushwaha }
12779a696f56SPrabhakar Kushwaha
12781730a17dSPrabhakar Kushwaha #ifdef DEBUG
12792557c5a9SYogesh Gaur printf("Init: DPBP id=0x%x\n", dflt_dpbp->dpbp_attr.id);
12801730a17dSPrabhakar Kushwaha #endif
12811730a17dSPrabhakar Kushwaha
12821730a17dSPrabhakar Kushwaha err = dpbp_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpbp->dpbp_handle);
12831730a17dSPrabhakar Kushwaha if (err < 0) {
12841730a17dSPrabhakar Kushwaha printf("dpbp_close() failed: %d\n", err);
12851730a17dSPrabhakar Kushwaha goto err_close;
12861730a17dSPrabhakar Kushwaha }
1287a2a55e51SPrabhakar Kushwaha
1288a2a55e51SPrabhakar Kushwaha return 0;
12891730a17dSPrabhakar Kushwaha
12901730a17dSPrabhakar Kushwaha err_get_attr:
12912557c5a9SYogesh Gaur err_attr_not_same:
12921730a17dSPrabhakar Kushwaha dpbp_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpbp->dpbp_handle);
12932557c5a9SYogesh Gaur dpbp_destroy(dflt_mc_io,
12942557c5a9SYogesh Gaur dflt_dprc_handle,
12952557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
12962557c5a9SYogesh Gaur dflt_dpbp->dpbp_id);
12972557c5a9SYogesh Gaur err_get_api_ver:
12982557c5a9SYogesh Gaur err_close:
12992557c5a9SYogesh Gaur err_open:
13001730a17dSPrabhakar Kushwaha err_create:
13012557c5a9SYogesh Gaur free(dflt_dpbp);
1302a572fb6bSPrabhakar Kushwaha err_calloc:
13031730a17dSPrabhakar Kushwaha return err;
1304a2a55e51SPrabhakar Kushwaha }
1305a2a55e51SPrabhakar Kushwaha
dpbp_exit(void)13061730a17dSPrabhakar Kushwaha static int dpbp_exit(void)
1307a2a55e51SPrabhakar Kushwaha {
13081730a17dSPrabhakar Kushwaha int err;
13091730a17dSPrabhakar Kushwaha
13102557c5a9SYogesh Gaur err = dpbp_destroy(dflt_mc_io, dflt_dprc_handle, MC_CMD_NO_FLAGS,
13112557c5a9SYogesh Gaur dflt_dpbp->dpbp_id);
13121730a17dSPrabhakar Kushwaha if (err < 0) {
13131730a17dSPrabhakar Kushwaha printf("dpbp_destroy() failed: %d\n", err);
13141730a17dSPrabhakar Kushwaha goto err;
13151730a17dSPrabhakar Kushwaha }
13161730a17dSPrabhakar Kushwaha
13171730a17dSPrabhakar Kushwaha #ifdef DEBUG
13181730a17dSPrabhakar Kushwaha printf("Exit: DPBP id=0x%d\n", dflt_dpbp->dpbp_attr.id);
13191730a17dSPrabhakar Kushwaha #endif
13201730a17dSPrabhakar Kushwaha
13211730a17dSPrabhakar Kushwaha if (dflt_dpbp)
13221730a17dSPrabhakar Kushwaha free(dflt_dpbp);
13231730a17dSPrabhakar Kushwaha return 0;
13241730a17dSPrabhakar Kushwaha
13251730a17dSPrabhakar Kushwaha err:
13261730a17dSPrabhakar Kushwaha return err;
13271730a17dSPrabhakar Kushwaha }
13281730a17dSPrabhakar Kushwaha
dpni_init(void)13291730a17dSPrabhakar Kushwaha static int dpni_init(void)
13301730a17dSPrabhakar Kushwaha {
13311730a17dSPrabhakar Kushwaha int err;
13322557c5a9SYogesh Gaur uint8_t cfg_buf[256] = {0};
13331730a17dSPrabhakar Kushwaha struct dpni_cfg dpni_cfg;
13342557c5a9SYogesh Gaur uint16_t major_ver, minor_ver;
13351730a17dSPrabhakar Kushwaha
1336a572fb6bSPrabhakar Kushwaha dflt_dpni = (struct fsl_dpni_obj *)calloc(
1337a572fb6bSPrabhakar Kushwaha sizeof(struct fsl_dpni_obj), 1);
13381730a17dSPrabhakar Kushwaha if (!dflt_dpni) {
1339a572fb6bSPrabhakar Kushwaha printf("No memory: calloc() failed\n");
13401730a17dSPrabhakar Kushwaha err = -ENOMEM;
1341a572fb6bSPrabhakar Kushwaha goto err_calloc;
13421730a17dSPrabhakar Kushwaha }
13431730a17dSPrabhakar Kushwaha
13442557c5a9SYogesh Gaur memset(&dpni_cfg, 0, sizeof(dpni_cfg));
13452557c5a9SYogesh Gaur err = dpni_prepare_cfg(&dpni_cfg, &cfg_buf[0]);
1346879a59acSPrabhakar Kushwaha if (err < 0) {
1347879a59acSPrabhakar Kushwaha err = -ENODEV;
13482557c5a9SYogesh Gaur printf("dpni_prepare_cfg() failed: %d\n", err);
13492557c5a9SYogesh Gaur goto err_prepare_cfg;
1350879a59acSPrabhakar Kushwaha }
1351879a59acSPrabhakar Kushwaha
13522557c5a9SYogesh Gaur err = dpni_create(dflt_mc_io,
13532557c5a9SYogesh Gaur dflt_dprc_handle,
13542557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
13552557c5a9SYogesh Gaur &dpni_cfg,
13562557c5a9SYogesh Gaur &dflt_dpni->dpni_id);
13571730a17dSPrabhakar Kushwaha if (err < 0) {
13581730a17dSPrabhakar Kushwaha err = -ENODEV;
13592557c5a9SYogesh Gaur printf("dpni create() failed: %d\n", err);
13601730a17dSPrabhakar Kushwaha goto err_create;
13611730a17dSPrabhakar Kushwaha }
13621730a17dSPrabhakar Kushwaha
13632557c5a9SYogesh Gaur err = dpni_get_api_version(dflt_mc_io, 0,
13642557c5a9SYogesh Gaur &major_ver,
13652557c5a9SYogesh Gaur &minor_ver);
13661730a17dSPrabhakar Kushwaha if (err < 0) {
13672557c5a9SYogesh Gaur printf("dpni_get_api_version() failed: %d\n", err);
13682557c5a9SYogesh Gaur goto err_get_version;
13691730a17dSPrabhakar Kushwaha }
13701730a17dSPrabhakar Kushwaha
13712557c5a9SYogesh Gaur if (major_ver < DPNI_VER_MAJOR || (major_ver == DPNI_VER_MAJOR &&
13722557c5a9SYogesh Gaur minor_ver < DPNI_VER_MINOR)) {
13739a696f56SPrabhakar Kushwaha printf("DPNI version mismatch found %u.%u,",
13742557c5a9SYogesh Gaur major_ver, minor_ver);
13759a696f56SPrabhakar Kushwaha printf("supported version is %u.%u\n",
13769a696f56SPrabhakar Kushwaha DPNI_VER_MAJOR, DPNI_VER_MINOR);
13779a696f56SPrabhakar Kushwaha }
13789a696f56SPrabhakar Kushwaha
13792557c5a9SYogesh Gaur err = dpni_open(dflt_mc_io,
13802557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
13812557c5a9SYogesh Gaur dflt_dpni->dpni_id,
13822557c5a9SYogesh Gaur &dflt_dpni->dpni_handle);
13832557c5a9SYogesh Gaur if (err) {
13842557c5a9SYogesh Gaur printf("dpni_open() failed\n");
13852557c5a9SYogesh Gaur goto err_open;
13862557c5a9SYogesh Gaur }
13872557c5a9SYogesh Gaur
13881730a17dSPrabhakar Kushwaha #ifdef DEBUG
13891730a17dSPrabhakar Kushwaha printf("Init: DPNI id=0x%d\n", dflt_dpni->dpni_id);
13901730a17dSPrabhakar Kushwaha #endif
13911730a17dSPrabhakar Kushwaha err = dpni_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpni->dpni_handle);
13921730a17dSPrabhakar Kushwaha if (err < 0) {
13931730a17dSPrabhakar Kushwaha printf("dpni_close() failed: %d\n", err);
13941730a17dSPrabhakar Kushwaha goto err_close;
13951730a17dSPrabhakar Kushwaha }
1396a2a55e51SPrabhakar Kushwaha
1397fb4a87a7SPrabhakar Kushwaha return 0;
13981730a17dSPrabhakar Kushwaha
13991730a17dSPrabhakar Kushwaha err_close:
14001730a17dSPrabhakar Kushwaha dpni_close(dflt_mc_io, MC_CMD_NO_FLAGS, dflt_dpni->dpni_handle);
14012557c5a9SYogesh Gaur err_open:
14022557c5a9SYogesh Gaur err_get_version:
14032557c5a9SYogesh Gaur dpni_destroy(dflt_mc_io,
14042557c5a9SYogesh Gaur dflt_dprc_handle,
14052557c5a9SYogesh Gaur MC_CMD_NO_FLAGS,
14062557c5a9SYogesh Gaur dflt_dpni->dpni_id);
14071730a17dSPrabhakar Kushwaha err_create:
14082557c5a9SYogesh Gaur err_prepare_cfg:
1409879a59acSPrabhakar Kushwaha free(dflt_dpni);
1410a572fb6bSPrabhakar Kushwaha err_calloc:
14111730a17dSPrabhakar Kushwaha return err;
1412a2a55e51SPrabhakar Kushwaha }
1413a2a55e51SPrabhakar Kushwaha
dpni_exit(void)14141730a17dSPrabhakar Kushwaha static int dpni_exit(void)
1415a2a55e51SPrabhakar Kushwaha {
14161730a17dSPrabhakar Kushwaha int err;
14171730a17dSPrabhakar Kushwaha
14182557c5a9SYogesh Gaur err = dpni_destroy(dflt_mc_io, dflt_dprc_handle, MC_CMD_NO_FLAGS,
14192557c5a9SYogesh Gaur dflt_dpni->dpni_id);
14201730a17dSPrabhakar Kushwaha if (err < 0) {
14211730a17dSPrabhakar Kushwaha printf("dpni_destroy() failed: %d\n", err);
14221730a17dSPrabhakar Kushwaha goto err;
14231730a17dSPrabhakar Kushwaha }
14241730a17dSPrabhakar Kushwaha
14251730a17dSPrabhakar Kushwaha #ifdef DEBUG
14261730a17dSPrabhakar Kushwaha printf("Exit: DPNI id=0x%d\n", dflt_dpni->dpni_id);
14271730a17dSPrabhakar Kushwaha #endif
14281730a17dSPrabhakar Kushwaha
14291730a17dSPrabhakar Kushwaha if (dflt_dpni)
14301730a17dSPrabhakar Kushwaha free(dflt_dpni);
14311730a17dSPrabhakar Kushwaha return 0;
14321730a17dSPrabhakar Kushwaha
14331730a17dSPrabhakar Kushwaha err:
14341730a17dSPrabhakar Kushwaha return err;
14351730a17dSPrabhakar Kushwaha }
14361730a17dSPrabhakar Kushwaha
mc_init_object(void)14371730a17dSPrabhakar Kushwaha static int mc_init_object(void)
14381730a17dSPrabhakar Kushwaha {
14391730a17dSPrabhakar Kushwaha int err = 0;
14401730a17dSPrabhakar Kushwaha
14411730a17dSPrabhakar Kushwaha err = dprc_init();
14421730a17dSPrabhakar Kushwaha if (err < 0) {
14431730a17dSPrabhakar Kushwaha printf("dprc_init() failed: %d\n", err);
14441730a17dSPrabhakar Kushwaha goto err;
14451730a17dSPrabhakar Kushwaha }
14461730a17dSPrabhakar Kushwaha
14471730a17dSPrabhakar Kushwaha err = dpbp_init();
14481730a17dSPrabhakar Kushwaha if (err < 0) {
14491730a17dSPrabhakar Kushwaha printf("dpbp_init() failed: %d\n", err);
14501730a17dSPrabhakar Kushwaha goto err;
14511730a17dSPrabhakar Kushwaha }
14521730a17dSPrabhakar Kushwaha
14531730a17dSPrabhakar Kushwaha err = dpio_init();
14541730a17dSPrabhakar Kushwaha if (err < 0) {
14551730a17dSPrabhakar Kushwaha printf("dpio_init() failed: %d\n", err);
14561730a17dSPrabhakar Kushwaha goto err;
14571730a17dSPrabhakar Kushwaha }
14581730a17dSPrabhakar Kushwaha
14591730a17dSPrabhakar Kushwaha err = dpni_init();
14601730a17dSPrabhakar Kushwaha if (err < 0) {
14611730a17dSPrabhakar Kushwaha printf("dpni_init() failed: %d\n", err);
14621730a17dSPrabhakar Kushwaha goto err;
14631730a17dSPrabhakar Kushwaha }
14641730a17dSPrabhakar Kushwaha
14651730a17dSPrabhakar Kushwaha return 0;
14661730a17dSPrabhakar Kushwaha err:
14671730a17dSPrabhakar Kushwaha return err;
14681730a17dSPrabhakar Kushwaha }
14691730a17dSPrabhakar Kushwaha
fsl_mc_ldpaa_exit(bd_t * bd)14701730a17dSPrabhakar Kushwaha int fsl_mc_ldpaa_exit(bd_t *bd)
14711730a17dSPrabhakar Kushwaha {
14721730a17dSPrabhakar Kushwaha int err = 0;
147342e81790SYogesh Gaur bool is_dpl_apply_status = false;
147406651b94SSantan Kumar bool mc_boot_status = false;
14751730a17dSPrabhakar Kushwaha
1476b7b8410aSAlexander Graf if (bd && mc_lazy_dpl_addr && !fsl_mc_ldpaa_exit(NULL)) {
1477f9747a5aSYogesh Gaur err = mc_apply_dpl(mc_lazy_dpl_addr);
1478f9747a5aSYogesh Gaur if (!err)
1479f9747a5aSYogesh Gaur fdt_fixup_board_enet(working_fdt);
1480b7b8410aSAlexander Graf mc_lazy_dpl_addr = 0;
1481b7b8410aSAlexander Graf }
1482b7b8410aSAlexander Graf
148306651b94SSantan Kumar if (!get_mc_boot_status())
148406651b94SSantan Kumar mc_boot_status = true;
148506651b94SSantan Kumar
14866dedceddSPrabhakar Kushwaha /* MC is not loaded intentionally, So return success. */
148706651b94SSantan Kumar if (bd && !mc_boot_status)
14881730a17dSPrabhakar Kushwaha return 0;
14891730a17dSPrabhakar Kushwaha
149042e81790SYogesh Gaur /* If DPL is deployed, set is_dpl_apply_status as TRUE. */
149142e81790SYogesh Gaur if (!get_dpl_apply_status())
149242e81790SYogesh Gaur is_dpl_apply_status = true;
14931730a17dSPrabhakar Kushwaha
149442e81790SYogesh Gaur /*
149542e81790SYogesh Gaur * For case MC is loaded but DPL is not deployed, return success and
149642e81790SYogesh Gaur * print message on console. Else FDT fix-up code execution hanged.
149742e81790SYogesh Gaur */
149806651b94SSantan Kumar if (bd && mc_boot_status && !is_dpl_apply_status) {
149942e81790SYogesh Gaur printf("fsl-mc: DPL not deployed, DPAA2 ethernet not work\n");
150073fa206aSYogesh Gaur goto mc_obj_cleanup;
150142e81790SYogesh Gaur }
15021730a17dSPrabhakar Kushwaha
150306651b94SSantan Kumar if (bd && mc_boot_status && is_dpl_apply_status)
150406651b94SSantan Kumar return 0;
150506651b94SSantan Kumar
150673fa206aSYogesh Gaur mc_obj_cleanup:
15071730a17dSPrabhakar Kushwaha err = dpbp_exit();
15081730a17dSPrabhakar Kushwaha if (err < 0) {
1509a2a4dc56SPrabhakar Kushwaha printf("dpbp_exit() failed: %d\n", err);
15101730a17dSPrabhakar Kushwaha goto err;
15111730a17dSPrabhakar Kushwaha }
15121730a17dSPrabhakar Kushwaha
15131730a17dSPrabhakar Kushwaha err = dpio_exit();
15141730a17dSPrabhakar Kushwaha if (err < 0) {
15151730a17dSPrabhakar Kushwaha printf("dpio_exit() failed: %d\n", err);
15161730a17dSPrabhakar Kushwaha goto err;
15171730a17dSPrabhakar Kushwaha }
15181730a17dSPrabhakar Kushwaha
15191730a17dSPrabhakar Kushwaha err = dpni_exit();
15201730a17dSPrabhakar Kushwaha if (err < 0) {
15211730a17dSPrabhakar Kushwaha printf("dpni_exit() failed: %d\n", err);
15221730a17dSPrabhakar Kushwaha goto err;
15231730a17dSPrabhakar Kushwaha }
15241730a17dSPrabhakar Kushwaha
15251730a17dSPrabhakar Kushwaha err = dprc_exit();
15261730a17dSPrabhakar Kushwaha if (err < 0) {
15271730a17dSPrabhakar Kushwaha printf("dprc_exit() failed: %d\n", err);
15281730a17dSPrabhakar Kushwaha goto err;
15291730a17dSPrabhakar Kushwaha }
15301730a17dSPrabhakar Kushwaha
15311730a17dSPrabhakar Kushwaha return 0;
15321730a17dSPrabhakar Kushwaha err:
15331730a17dSPrabhakar Kushwaha return err;
1534fb4a87a7SPrabhakar Kushwaha }
1535fb4a87a7SPrabhakar Kushwaha
do_fsl_mc(cmd_tbl_t * cmdtp,int flag,int argc,char * const argv[])1536fb4a87a7SPrabhakar Kushwaha static int do_fsl_mc(cmd_tbl_t *cmdtp, int flag, int argc, char * const argv[])
1537fb4a87a7SPrabhakar Kushwaha {
1538fb4a87a7SPrabhakar Kushwaha int err = 0;
1539fb4a87a7SPrabhakar Kushwaha if (argc < 3)
1540fb4a87a7SPrabhakar Kushwaha goto usage;
1541fb4a87a7SPrabhakar Kushwaha
1542fb4a87a7SPrabhakar Kushwaha switch (argv[1][0]) {
1543fb4a87a7SPrabhakar Kushwaha case 's': {
1544fb4a87a7SPrabhakar Kushwaha char sub_cmd;
154544937214SPrabhakar Kushwaha u64 mc_fw_addr, mc_dpc_addr;
154644937214SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET
154744937214SPrabhakar Kushwaha u64 aiop_fw_addr;
154844937214SPrabhakar Kushwaha #endif
1549fb4a87a7SPrabhakar Kushwaha
1550fb4a87a7SPrabhakar Kushwaha sub_cmd = argv[2][0];
15512557c5a9SYogesh Gaur
1552fb4a87a7SPrabhakar Kushwaha switch (sub_cmd) {
1553fb4a87a7SPrabhakar Kushwaha case 'm':
1554fb4a87a7SPrabhakar Kushwaha if (argc < 5)
1555fb4a87a7SPrabhakar Kushwaha goto usage;
1556a2a55e51SPrabhakar Kushwaha
1557125e2bc1SJ. German Rivera if (get_mc_boot_status() == 0) {
1558fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: MC is already booted");
1559fb4a87a7SPrabhakar Kushwaha printf("\n");
1560fb4a87a7SPrabhakar Kushwaha return err;
1561a2a55e51SPrabhakar Kushwaha }
1562fb4a87a7SPrabhakar Kushwaha mc_fw_addr = simple_strtoull(argv[3], NULL, 16);
1563fb4a87a7SPrabhakar Kushwaha mc_dpc_addr = simple_strtoull(argv[4], NULL,
1564fb4a87a7SPrabhakar Kushwaha 16);
15651730a17dSPrabhakar Kushwaha
15661730a17dSPrabhakar Kushwaha if (!mc_init(mc_fw_addr, mc_dpc_addr))
15671730a17dSPrabhakar Kushwaha err = mc_init_object();
1568fb4a87a7SPrabhakar Kushwaha break;
1569fb4a87a7SPrabhakar Kushwaha
1570fb4a87a7SPrabhakar Kushwaha #ifdef CONFIG_SYS_LS_MC_DRAM_AIOP_IMG_OFFSET
1571fb4a87a7SPrabhakar Kushwaha case 'a':
1572fb4a87a7SPrabhakar Kushwaha if (argc < 4)
1573fb4a87a7SPrabhakar Kushwaha goto usage;
1574fb4a87a7SPrabhakar Kushwaha if (get_aiop_apply_status() == 0) {
1575fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: AIOP FW is already");
1576fb4a87a7SPrabhakar Kushwaha printf(" applied\n");
1577fb4a87a7SPrabhakar Kushwaha return err;
1578a2a55e51SPrabhakar Kushwaha }
1579a2a55e51SPrabhakar Kushwaha
1580fb4a87a7SPrabhakar Kushwaha aiop_fw_addr = simple_strtoull(argv[3], NULL,
1581fb4a87a7SPrabhakar Kushwaha 16);
1582fb4a87a7SPrabhakar Kushwaha
15833c1d218aSYork Sun /* if SoC doesn't have AIOP, err = -ENODEV */
1584fb4a87a7SPrabhakar Kushwaha err = load_mc_aiop_img(aiop_fw_addr);
1585fb4a87a7SPrabhakar Kushwaha if (!err)
1586fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: AIOP FW applied\n");
1587fb4a87a7SPrabhakar Kushwaha break;
1588fb4a87a7SPrabhakar Kushwaha #endif
1589fb4a87a7SPrabhakar Kushwaha default:
1590fb4a87a7SPrabhakar Kushwaha printf("Invalid option: %s\n", argv[2]);
1591fb4a87a7SPrabhakar Kushwaha goto usage;
1592fb4a87a7SPrabhakar Kushwaha
1593fb4a87a7SPrabhakar Kushwaha break;
1594fb4a87a7SPrabhakar Kushwaha }
1595fb4a87a7SPrabhakar Kushwaha }
1596fb4a87a7SPrabhakar Kushwaha break;
1597fb4a87a7SPrabhakar Kushwaha
1598b7b8410aSAlexander Graf case 'l':
1599fb4a87a7SPrabhakar Kushwaha case 'a': {
1600fb4a87a7SPrabhakar Kushwaha u64 mc_dpl_addr;
1601fb4a87a7SPrabhakar Kushwaha
1602fb4a87a7SPrabhakar Kushwaha if (argc < 4)
1603fb4a87a7SPrabhakar Kushwaha goto usage;
1604fb4a87a7SPrabhakar Kushwaha
1605fb4a87a7SPrabhakar Kushwaha if (get_dpl_apply_status() == 0) {
1606fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: DPL already applied\n");
1607fb4a87a7SPrabhakar Kushwaha return err;
1608125e2bc1SJ. German Rivera }
1609125e2bc1SJ. German Rivera
1610fb4a87a7SPrabhakar Kushwaha mc_dpl_addr = simple_strtoull(argv[3], NULL,
1611fb4a87a7SPrabhakar Kushwaha 16);
16121730a17dSPrabhakar Kushwaha
1613fb4a87a7SPrabhakar Kushwaha if (get_mc_boot_status() != 0) {
1614fb4a87a7SPrabhakar Kushwaha printf("fsl-mc: Deploying data path layout ..");
1615fb4a87a7SPrabhakar Kushwaha printf("ERROR (MC is not booted)\n");
1616fb4a87a7SPrabhakar Kushwaha return -ENODEV;
1617a2a55e51SPrabhakar Kushwaha }
16181730a17dSPrabhakar Kushwaha
1619b7b8410aSAlexander Graf if (argv[1][0] == 'l') {
1620b7b8410aSAlexander Graf /*
1621b7b8410aSAlexander Graf * We will do the actual dpaa exit and dpl apply
1622b7b8410aSAlexander Graf * later from announce_and_cleanup().
1623b7b8410aSAlexander Graf */
1624b7b8410aSAlexander Graf mc_lazy_dpl_addr = mc_dpl_addr;
1625b7b8410aSAlexander Graf } else {
1626b7b8410aSAlexander Graf /* The user wants it applied now */
16271730a17dSPrabhakar Kushwaha if (!fsl_mc_ldpaa_exit(NULL))
1628fb4a87a7SPrabhakar Kushwaha err = mc_apply_dpl(mc_dpl_addr);
1629b7b8410aSAlexander Graf }
1630fb4a87a7SPrabhakar Kushwaha break;
1631fb4a87a7SPrabhakar Kushwaha }
1632fb4a87a7SPrabhakar Kushwaha default:
1633fb4a87a7SPrabhakar Kushwaha printf("Invalid option: %s\n", argv[1]);
1634fb4a87a7SPrabhakar Kushwaha goto usage;
1635fb4a87a7SPrabhakar Kushwaha break;
1636fb4a87a7SPrabhakar Kushwaha }
1637fb4a87a7SPrabhakar Kushwaha return err;
1638fb4a87a7SPrabhakar Kushwaha usage:
1639fb4a87a7SPrabhakar Kushwaha return CMD_RET_USAGE;
1640fb4a87a7SPrabhakar Kushwaha }
1641fb4a87a7SPrabhakar Kushwaha
1642fb4a87a7SPrabhakar Kushwaha U_BOOT_CMD(
1643fb4a87a7SPrabhakar Kushwaha fsl_mc, CONFIG_SYS_MAXARGS, 1, do_fsl_mc,
1644fb4a87a7SPrabhakar Kushwaha "DPAA2 command to manage Management Complex (MC)",
1645fb4a87a7SPrabhakar Kushwaha "start mc [FW_addr] [DPC_addr] - Start Management Complex\n"
1646fb4a87a7SPrabhakar Kushwaha "fsl_mc apply DPL [DPL_addr] - Apply DPL file\n"
1647b7b8410aSAlexander Graf "fsl_mc lazyapply DPL [DPL_addr] - Apply DPL file on exit\n"
1648fb4a87a7SPrabhakar Kushwaha "fsl_mc start aiop [FW_addr] - Start AIOP\n"
1649fb4a87a7SPrabhakar Kushwaha );
165033a8991aSBogdan Purcareata
mc_env_boot(void)165133a8991aSBogdan Purcareata void mc_env_boot(void)
165233a8991aSBogdan Purcareata {
165333a8991aSBogdan Purcareata #if defined(CONFIG_FSL_MC_ENET)
165433a8991aSBogdan Purcareata char *mc_boot_env_var;
165533a8991aSBogdan Purcareata /* The MC may only be initialized in the reset PHY function
165633a8991aSBogdan Purcareata * because otherwise U-Boot has not yet set up all the MAC
165733a8991aSBogdan Purcareata * address info properly. Without MAC addresses, the MC code
165833a8991aSBogdan Purcareata * can not properly initialize the DPC.
165933a8991aSBogdan Purcareata */
166000caae6dSSimon Glass mc_boot_env_var = env_get(MC_BOOT_ENV_VAR);
166133a8991aSBogdan Purcareata if (mc_boot_env_var)
166233a8991aSBogdan Purcareata run_command_list(mc_boot_env_var, -1, 0);
166333a8991aSBogdan Purcareata #endif /* CONFIG_FSL_MC_ENET */
166433a8991aSBogdan Purcareata }
1665