^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 1) // SPDX-License-Identifier: GPL-2.0
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 2) /*
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 3) * Copyright 2019 NXP.
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 4) */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 5)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 6) #include <dt-bindings/firmware/imx/rsrc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 7) #include <linux/firmware/imx/sci.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 8) #include <linux/slab.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 9) #include <linux/sys_soc.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 10) #include <linux/platform_device.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 11) #include <linux/of.h>
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 12)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 13) static struct imx_sc_ipc *imx_sc_soc_ipc_handle;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 14)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 15) struct imx_sc_msg_misc_get_soc_id {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 16) struct imx_sc_rpc_msg hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 17) union {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 18) struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 19) u32 control;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 20) u16 resource;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 21) } __packed req;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 22) struct {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 23) u32 id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 24) } resp;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 25) } data;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 26) } __packed __aligned(4);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 27)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 28) struct imx_sc_msg_misc_get_soc_uid {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 29) struct imx_sc_rpc_msg hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 30) u32 uid_low;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 31) u32 uid_high;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 32) } __packed;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 33)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 34) static int imx_scu_soc_uid(u64 *soc_uid)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 35) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 36) struct imx_sc_msg_misc_get_soc_uid msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 37) struct imx_sc_rpc_msg *hdr = &msg.hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 38) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 39)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 40) hdr->ver = IMX_SC_RPC_VERSION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 41) hdr->svc = IMX_SC_RPC_SVC_MISC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 42) hdr->func = IMX_SC_MISC_FUNC_UNIQUE_ID;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 43) hdr->size = 1;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 44)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 45) ret = imx_scu_call_rpc(imx_sc_soc_ipc_handle, &msg, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 46) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 47) pr_err("%s: get soc uid failed, ret %d\n", __func__, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 48) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 49) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 50)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 51) *soc_uid = msg.uid_high;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 52) *soc_uid <<= 32;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 53) *soc_uid |= msg.uid_low;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 54)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 55) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 56) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 57)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 58) static int imx_scu_soc_id(void)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 59) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 60) struct imx_sc_msg_misc_get_soc_id msg;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 61) struct imx_sc_rpc_msg *hdr = &msg.hdr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 62) int ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 63)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 64) hdr->ver = IMX_SC_RPC_VERSION;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 65) hdr->svc = IMX_SC_RPC_SVC_MISC;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 66) hdr->func = IMX_SC_MISC_FUNC_GET_CONTROL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 67) hdr->size = 3;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 68)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 69) msg.data.req.control = IMX_SC_C_ID;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 70) msg.data.req.resource = IMX_SC_R_SYSTEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 71)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 72) ret = imx_scu_call_rpc(imx_sc_soc_ipc_handle, &msg, true);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 73) if (ret) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 74) pr_err("%s: get soc info failed, ret %d\n", __func__, ret);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 75) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 76) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 77)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 78) return msg.data.resp.id;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 79) }
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 80)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 81) int imx_scu_soc_init(struct device *dev)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 82) {
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 83) struct soc_device_attribute *soc_dev_attr;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 84) struct soc_device *soc_dev;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 85) int id, ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 86) u64 uid = 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 87) u32 val;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 88)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 89) ret = imx_scu_get_handle(&imx_sc_soc_ipc_handle);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 90) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 91) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 92)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 93) soc_dev_attr = devm_kzalloc(dev, sizeof(*soc_dev_attr),
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 94) GFP_KERNEL);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 95) if (!soc_dev_attr)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 96) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 97)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 98) soc_dev_attr->family = "Freescale i.MX";
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 99)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 100) ret = of_property_read_string(of_root,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 101) "model",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 102) &soc_dev_attr->machine);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 103) if (ret)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 104) return ret;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 105)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 106) id = imx_scu_soc_id();
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 107) if (id < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 108) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 109)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 110) ret = imx_scu_soc_uid(&uid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 111) if (ret < 0)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 112) return -EINVAL;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 113)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 114) /* format soc_id value passed from SCU firmware */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 115) val = id & 0x1f;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 116) soc_dev_attr->soc_id = devm_kasprintf(dev, GFP_KERNEL, "0x%x", val);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 117) if (!soc_dev_attr->soc_id)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 118) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 119)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 120) /* format revision value passed from SCU firmware */
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 121) val = (id >> 5) & 0xf;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 122) val = (((val >> 2) + 1) << 4) | (val & 0x3);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 123) soc_dev_attr->revision = devm_kasprintf(dev, GFP_KERNEL, "%d.%d",
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 124) (val >> 4) & 0xf, val & 0xf);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 125) if (!soc_dev_attr->revision)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 126) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 127)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 128) soc_dev_attr->serial_number = devm_kasprintf(dev, GFP_KERNEL,
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 129) "%016llX", uid);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 130) if (!soc_dev_attr->serial_number)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 131) return -ENOMEM;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 132)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 133) soc_dev = soc_device_register(soc_dev_attr);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 134) if (IS_ERR(soc_dev))
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 135) return PTR_ERR(soc_dev);
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 136)
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 137) return 0;
^8f3ce5b39 (kx 2023-10-28 12:00:06 +0300 138) }
Orange Pi5 kernel
Deprecated Linux kernel 5.10.110 for OrangePi 5/5B/5+ boards
3 Commits
0 Branches
0 Tags