Re: [PATCH v2 35/36] soc: fsl: cpm1: qmc: Handle QUICC Engine (QE) soft-qmc firmware

Christophe Leroy
2024-08-23T08:14:54Z

Le 08/08/2024 à 09:11, Herve Codina a écrit :
> The QUICC Engine (QE) QMC can use a firmware to have the QMC working in
> 'soft-qmc' mode.
>
> Handle this optional 'soft-qmc' firmware.
>
> Signed-off-by: Herve Codina <herve.codina@bootlin.com>

Reviewed-by: Christophe Leroy <christophe.leroy@csgroup.eu>

> ---
> drivers/soc/fsl/qe/qmc.c | 67 ++++++++++++++++++++++++++++++++++++++++
> 1 file changed, 67 insertions(+)
>
> diff --git a/drivers/soc/fsl/qe/qmc.c b/drivers/soc/fsl/qe/qmc.c
> index b3a9534441ee..3dffebb48b0d 100644
> --- a/drivers/soc/fsl/qe/qmc.c
> +++ b/drivers/soc/fsl/qe/qmc.c
> @@ -10,6 +10,7 @@
> #include <soc/fsl/qe/qmc.h>
> #include <linux/bitfield.h>
> #include <linux/dma-mapping.h>
> +#include <linux/firmware.h>
> #include <linux/hdlc.h>
> #include <linux/interrupt.h>
> #include <linux/io.h>
> @@ -1649,6 +1650,66 @@ static irqreturn_t qmc_irq_handler(int irq, void *priv)
> return IRQ_HANDLED;
> }
>
> +static int qmc_qe_soft_qmc_init(struct qmc *qmc, struct device_node *np)
> +{
> + struct qe_firmware_info *qe_fw_info;
> + const struct qe_firmware *qe_fw;
> + const struct firmware *fw;
> + const char *filename;
> + int ret;
> +
> + ret = of_property_read_string(np, "fsl,soft-qmc", &filename);
> + switch (ret) {
> + case 0:
> + break;
> + case -EINVAL:
> + /* fsl,soft-qmc property not set -> Simply do nothing */
> + return 0;
> + default:
> + dev_err(qmc->dev, "%pOF: failed to read fsl,soft-qmc\n",
> + np);
> + return ret;
> + }
> +
> + qe_fw_info = qe_get_firmware_info();
> + if (qe_fw_info) {
> + if (!strstr(qe_fw_info->id, "Soft-QMC")) {
> + dev_err(qmc->dev, "Another Firmware is already loaded\n");
> + return -EALREADY;
> + }
> + dev_info(qmc->dev, "Firmware already loaded\n");
> + return 0;
> + }
> +
> + dev_info(qmc->dev, "Using firmware %s\n", filename);
> +
> + ret = request_firmware(&fw, filename, qmc->dev);
> + if (ret) {
> + dev_err(qmc->dev, "Failed to request firmware %s\n", filename);
> + return ret;
> + }
> +
> + qe_fw = (const struct qe_firmware *)fw->data;
> +
> + if (fw->size < sizeof(qe_fw->header) ||
> + be32_to_cpu(qe_fw->header.length) != fw->size) {
> + dev_err(qmc->dev, "Invalid firmware %s\n", filename);
> + ret = -EINVAL;
> + goto end;
> + }
> +
> + ret = qe_upload_firmware(qe_fw);
> + if (ret) {
> + dev_err(qmc->dev, "Failed to load firmware %s\n", filename);
> + goto end;
> + }
> +
> + ret = 0;
> +end:
> + release_firmware(fw);
> + return ret;
> +}
> +
> static int qmc_cpm1_init_resources(struct qmc *qmc, struct platform_device *pdev)
> {
> struct resource *res;
> @@ -1855,6 +1916,12 @@ static int qmc_probe(struct platform_device *pdev)
> if (ret)
> return ret;
>
> + if (qmc_is_qe(qmc)) {
> + ret = qmc_qe_soft_qmc_init(qmc, np);
> + if (ret)
> + return ret;
> + }
> +
> /* Parse channels informationss */
> ret = qmc_of_parse_chans(qmc, np);
> if (ret)