bus: fsl-mc: wait for the MC firmware to complete its boot

There are use cases in which the Management Complex firmware boot
process is started by the bootloader which does not wait for the boot to
complete. This is mainly done in order to reduce the overall boot time
of a DPAA2 based SoC.

In this kind of circumstance, the fsl-mc bus driver needs to make sure
that the MC firmware boot process is finished before proceeding to the
usual operations such as interrogating the firmware to gather all
existent DPAA2 objects, creating the fsl-mc devices on the bus etc.

Add this kind of check early in the boot process of the fsl-mc bus and
defer the probe in case the firmware is still in its boot process.

Signed-off-by: Ioana Ciornei <ioana.ciornei@nxp.com>
Link: https://lore.kernel.org/r/20260401144508.3062019-1-ioana.ciornei@nxp.com
Signed-off-by: Christophe Leroy (CS GROUP) <chleroy@kernel.org>

diff --git a/drivers/bus/fsl-mc/fsl-mc-bus.c b/drivers/bus/fsl-mc/fsl-mc-bus.c
index 1a6c8e3c0b27fc0f308a1c19375c9310127488d1..994834a87b2fb839950cd68e72555fae4d59fecb 100644 (file)
--- a/drivers/bus/fsl-mc/fsl-mc-bus.c
+++ b/drivers/bus/fsl-mc/fsl-mc-bus.c
@@ -66,6 +66,13 @@ struct fsl_mc_addr_translation_range {
 #define GCR1_P1_STOP   BIT(31)
 #define GCR1_P2_STOP   BIT(30)
 
+#define FSL_MC_GSR             0x8
+#define FSL_MC_GSR_BOOT_DONE   BIT(0)
+#define FSL_MC_GSR_MCS_MASK    GENMASK(7, 0)
+#define FSL_MC_GSR_MCS_ERR_MASK        GENMASK(7, 1)
+#define FSL_MC_GSR_BC_MASK     GENMASK(15, 8)
+#define FSL_MC_GSR_BC_SHIFT    8
+
 #define FSL_MC_FAPR    0x28
 #define MC_FAPR_PL     BIT(18)
 #define MC_FAPR_BMT    BIT(17)
@@ -1019,6 +1026,41 @@ static int get_mc_addr_translation_ranges(struct device *dev,
        return 0;
 }
 
+static u32 fsl_mc_read_gsr(struct fsl_mc *mc)
+{
+       return readl(mc->fsl_mc_regs + FSL_MC_GSR);
+}
+
+static int fsl_mc_firmware_check(struct platform_device *pdev)
+{
+       struct fsl_mc *mc = platform_get_drvdata(pdev);
+       u32 gsr, boot_done, boot_code, mcs;
+
+       gsr = fsl_mc_read_gsr(mc);
+       boot_code = (gsr & FSL_MC_GSR_BC_MASK) >> FSL_MC_GSR_BC_SHIFT;
+       if (boot_code == 0xDD) {
+               dev_err(&pdev->dev,
+                       "fsl-mc: DPL processing was not started, DPAA2 will not work!\n");
+               return -EOPNOTSUPP;
+       }
+
+       boot_done = gsr & FSL_MC_GSR_BOOT_DONE;
+       if (!boot_done) {
+               dev_dbg(&pdev->dev,
+                       "fsl-mc: DPL processing in progress, defer probe\n");
+               return -EPROBE_DEFER;
+       }
+
+       mcs = gsr & FSL_MC_GSR_MCS_MASK;
+       if (mcs & FSL_MC_GSR_MCS_ERR_MASK) {
+               dev_err(&pdev->dev,
+                       "fsl-mc: MC boot completed with error 0x%x\n", mcs);
+               return -EINVAL;
+       }
+
+       return 0;
+}
+
 /*
  * fsl_mc_bus_probe - callback invoked when the root MC bus is being
  * added
@@ -1083,6 +1125,10 @@ static int fsl_mc_bus_probe(struct platform_device *pdev)
                       mc->fsl_mc_regs + FSL_MC_GCR1);
        }
 
+       error = fsl_mc_firmware_check(pdev);
+       if (error)
+               return error;
+
        /*
         * Get physical address of MC portal for the root DPRC:
         */