[<prev] [next>] [<thread-prev] [thread-next>] [day] [month] [year] [list]
Message-ID: <2964906.e9J7NaK4W3@steina-w>
Date: Wed, 30 Oct 2024 12:05:04 +0100
From: Alexander Stein <alexander.stein@...tq-group.com>
To: wahrenst@....net, shawnguo@...nel.org, s.hauer@...gutronix.de, kernel@...gutronix.de, festevam@...il.com, alice.guo@....nxp.com
Cc: imx@...ts.linux.dev, linux-arm-kernel@...ts.infradead.org, linux-kernel@...r.kernel.org, "alice.guo" <alice.guo@....com>
Subject: Re: [PATCH v3] soc: imx: Add SoC device register for i.MX9
Am Mittwoch, 30. Oktober 2024, 10:13:36 CET schrieb alice.guo@....nxp.com:
> From: "alice.guo" <alice.guo@....com>
>
> i.MX9 SoCs have SoC ID, SoC revision number and chip unique identifier
> which are provided by the corresponding ARM trusted firmware API. This
> patch intends to use SMC call to obtain these information and then
> register i.MX9 SoC as a device.
>
> Signed-off-by: alice.guo <alice.guo@....com>
I was able to successfully this on two boards:
$ grep . /sys/bus/soc/devices/soc0/* 2> /dev/null
/sys/bus/soc/devices/soc0/family:Freescale i.MX
/sys/bus/soc/devices/soc0/machine:TQ-Systems i.MX93 TQMa93xxLA/TQMa93xxCA on MBa93xxCA starter kit
/sys/bus/soc/devices/soc0/revision:1.1
/sys/bus/soc/devices/soc0/serial_number:3d0f41f05242fc17baca88b84febf6de
/sys/bus/soc/devices/soc0/soc_id:i.MX93
$ grep . /sys/bus/soc/devices/soc0/* 2> /dev/null
/sys/bus/soc/devices/soc0/family:Freescale i.MX
/sys/bus/soc/devices/soc0/machine:TQ-Systems i.MX95 TQMa95xxSA on MB-SMARC-2
/sys/bus/soc/devices/soc0/revision:1.1
/sys/bus/soc/devices/soc0/serial_number:64955bc2d946b9c3f11984a9522b2822
/sys/bus/soc/devices/soc0/soc_id:i.MX95
Tested-by: Alexander Stein <alexander.stein@...tq-group.com>
Thanks
Alexander
> ---
>
> Changes for v2:
> - refine error log print
> Changes for v3:
> - return -EINVAL when arm_smccc_smc failed
> - fix the build warning caused by pr_err("%s: SMC failed: %d\n", __func__, res.a0);
> - drop the pr_err in imx9_soc_init
> - free the memory in the reverse order of allocation
> - use of_match_node instead of of_machine_is_compatible
>
> drivers/soc/imx/Makefile | 2 +-
> drivers/soc/imx/soc-imx9.c | 106 +++++++++++++++++++++++++++++++++++++
> 2 files changed, 107 insertions(+), 1 deletion(-)
> create mode 100644 drivers/soc/imx/soc-imx9.c
>
> diff --git a/drivers/soc/imx/Makefile b/drivers/soc/imx/Makefile
> index 3ad321ca608a..ca6a5fa1618f 100644
> --- a/drivers/soc/imx/Makefile
> +++ b/drivers/soc/imx/Makefile
> @@ -3,4 +3,4 @@ ifeq ($(CONFIG_ARM),y)
> obj-$(CONFIG_ARCH_MXC) += soc-imx.o
> endif
> obj-$(CONFIG_SOC_IMX8M) += soc-imx8m.o
> -obj-$(CONFIG_SOC_IMX9) += imx93-src.o
> +obj-$(CONFIG_SOC_IMX9) += imx93-src.o soc-imx9.o
> diff --git a/drivers/soc/imx/soc-imx9.c b/drivers/soc/imx/soc-imx9.c
> new file mode 100644
> index 000000000000..823395584533
> --- /dev/null
> +++ b/drivers/soc/imx/soc-imx9.c
> @@ -0,0 +1,106 @@
> +// SPDX-License-Identifier: GPL-2.0+
> +/*
> + * Copyright 2024 NXP
> + */
> +
> +#include <linux/arm-smccc.h>
> +#include <linux/init.h>
> +#include <linux/module.h>
> +#include <linux/of.h>
> +#include <linux/slab.h>
> +#include <linux/sys_soc.h>
> +
> +#define IMX_SIP_GET_SOC_INFO 0xc2000006
> +#define SOC_ID(x) (((x) & 0xFFFF) >> 8)
> +#define SOC_REV_MAJOR(x) ((((x) >> 28) & 0xF) - 0x9)
> +#define SOC_REV_MINOR(x) (((x) >> 24) & 0xF)
> +
> +static int imx9_soc_device_register(void)
> +{
> + struct soc_device_attribute *attr;
> + struct arm_smccc_res res;
> + struct soc_device *sdev;
> + u32 soc_id, rev_major, rev_minor;
> + u64 uid127_64, uid63_0;
> + int err;
> +
> + attr = kzalloc(sizeof(*attr), GFP_KERNEL);
> + if (!attr)
> + return -ENOMEM;
> +
> + err = of_property_read_string(of_root, "model", &attr->machine);
> + if (err) {
> + pr_err("%s: missing model property: %d\n", __func__, err);
> + goto attr;
> + }
> +
> + attr->family = kasprintf(GFP_KERNEL, "Freescale i.MX");
> +
> + /*
> + * Retrieve the soc id, rev & uid info:
> + * res.a1[31:16]: soc revision;
> + * res.a1[15:0]: soc id;
> + * res.a2: uid[127:64];
> + * res.a3: uid[63:0];
> + */
> + arm_smccc_smc(IMX_SIP_GET_SOC_INFO, 0, 0, 0, 0, 0, 0, 0, &res);
> + if (res.a0 != SMCCC_RET_SUCCESS) {
> + pr_err("%s: SMC failed: 0x%lx\n", __func__, res.a0);
> + err = -EINVAL;
> + goto family;
> + }
> +
> + soc_id = SOC_ID(res.a1);
> + rev_major = SOC_REV_MAJOR(res.a1);
> + rev_minor = SOC_REV_MINOR(res.a1);
> +
> + attr->soc_id = kasprintf(GFP_KERNEL, "i.MX%2x", soc_id);
> + attr->revision = kasprintf(GFP_KERNEL, "%d.%d", rev_major, rev_minor);
> +
> + uid127_64 = res.a2;
> + uid63_0 = res.a3;
> + attr->serial_number = kasprintf(GFP_KERNEL, "%016llx%016llx", uid127_64, uid63_0);
> +
> + sdev = soc_device_register(attr);
> + if (IS_ERR(sdev)) {
> + err = PTR_ERR(sdev);
> + pr_err("%s failed to register SoC as a device: %d\n", __func__, err);
> + goto serial_number;
> + }
> +
> + return 0;
> +
> +serial_number:
> + kfree(attr->serial_number);
> + kfree(attr->revision);
> + kfree(attr->soc_id);
> +family:
> + kfree(attr->family);
> +attr:
> + kfree(attr);
> + return err;
> +}
> +
> +static const struct of_device_id imx9_soc_match[] = {
> + { .compatible = "fsl,imx93", },
> + { .compatible = "fsl,imx95", },
> + { }
> +};
> +
> +static int __init imx9_soc_init(void)
> +{
> + int ret;
> +
> + /* No match means it is not an i.MX 9 series SoC, do nothing. */
> + if (!of_match_node(imx9_soc_match, of_root))
> + return 0;
> +
> + ret = imx9_soc_device_register();
> +
> + return ret;
> +}
> +device_initcall(imx9_soc_init);
> +
> +MODULE_AUTHOR("NXP");
> +MODULE_DESCRIPTION("NXP i.MX9 SoC");
> +MODULE_LICENSE("GPL");
>
--
TQ-Systems GmbH | Mühlstraße 2, Gut Delling | 82229 Seefeld, Germany
Amtsgericht München, HRB 105018
Geschäftsführer: Detlef Schneider, Rüdiger Stahl, Stefan Schneider
http://www.tq-group.com/
Powered by blists - more mailing lists