1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Copyright 2020 NXP 4 */ 5 6 #include <linux/mfd/syscon.h> 7 #include <linux/of.h> 8 #include <linux/of_address.h> 9 #include <linux/regmap.h> 10 #include <linux/slab.h> 11 #include <linux/sys_soc.h> 12 13 #include <soc/imx/cpu.h> 14 #include <soc/imx/revision.h> 15 16 #define OCOTP_UID_H 0x420 17 #define OCOTP_UID_L 0x410 18 19 #define OCOTP_ULP_UID_1 0x4b0 20 #define OCOTP_ULP_UID_2 0x4c0 21 #define OCOTP_ULP_UID_3 0x4d0 22 #define OCOTP_ULP_UID_4 0x4e0 23 24 static int __init imx_soc_device_init(void) 25 { 26 struct soc_device_attribute *soc_dev_attr; 27 const char *ocotp_compat = NULL; 28 struct soc_device *soc_dev; 29 struct device_node *root; 30 struct regmap *ocotp = NULL; 31 const char *soc_id; 32 u64 soc_uid = 0; 33 u32 val; 34 int ret; 35 36 if (of_machine_is_compatible("fsl,ls1021a")) 37 return 0; 38 39 soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL); 40 if (!soc_dev_attr) 41 return -ENOMEM; 42 43 soc_dev_attr->family = "Freescale i.MX"; 44 45 root = of_find_node_by_path("/"); 46 ret = of_property_read_string(root, "model", &soc_dev_attr->machine); 47 of_node_put(root); 48 if (ret) 49 goto free_soc; 50 51 switch (__mxc_cpu_type) { 52 case MXC_CPU_MX1: 53 soc_id = "i.MX1"; 54 break; 55 case MXC_CPU_MX21: 56 soc_id = "i.MX21"; 57 break; 58 case MXC_CPU_MX25: 59 soc_id = "i.MX25"; 60 break; 61 case MXC_CPU_MX27: 62 soc_id = "i.MX27"; 63 break; 64 case MXC_CPU_MX31: 65 soc_id = "i.MX31"; 66 break; 67 case MXC_CPU_MX35: 68 soc_id = "i.MX35"; 69 break; 70 case MXC_CPU_MX51: 71 soc_id = "i.MX51"; 72 break; 73 case MXC_CPU_MX53: 74 soc_id = "i.MX53"; 75 break; 76 case MXC_CPU_IMX6SL: 77 ocotp_compat = "fsl,imx6sl-ocotp"; 78 soc_id = "i.MX6SL"; 79 break; 80 case MXC_CPU_IMX6DL: 81 ocotp_compat = "fsl,imx6q-ocotp"; 82 soc_id = "i.MX6DL"; 83 break; 84 case MXC_CPU_IMX6SX: 85 ocotp_compat = "fsl,imx6sx-ocotp"; 86 soc_id = "i.MX6SX"; 87 break; 88 case MXC_CPU_IMX6Q: 89 ocotp_compat = "fsl,imx6q-ocotp"; 90 soc_id = "i.MX6Q"; 91 break; 92 case MXC_CPU_IMX6UL: 93 ocotp_compat = "fsl,imx6ul-ocotp"; 94 soc_id = "i.MX6UL"; 95 break; 96 case MXC_CPU_IMX6ULL: 97 ocotp_compat = "fsl,imx6ull-ocotp"; 98 soc_id = "i.MX6ULL"; 99 break; 100 case MXC_CPU_IMX6ULZ: 101 ocotp_compat = "fsl,imx6ull-ocotp"; 102 soc_id = "i.MX6ULZ"; 103 break; 104 case MXC_CPU_IMX6SLL: 105 ocotp_compat = "fsl,imx6sll-ocotp"; 106 soc_id = "i.MX6SLL"; 107 break; 108 case MXC_CPU_IMX7D: 109 ocotp_compat = "fsl,imx7d-ocotp"; 110 soc_id = "i.MX7D"; 111 break; 112 case MXC_CPU_IMX7ULP: 113 ocotp_compat = "fsl,imx7ulp-ocotp"; 114 soc_id = "i.MX7ULP"; 115 break; 116 case MXC_CPU_VF500: 117 ocotp_compat = "fsl,vf610-ocotp"; 118 soc_id = "VF500"; 119 break; 120 case MXC_CPU_VF510: 121 ocotp_compat = "fsl,vf610-ocotp"; 122 soc_id = "VF510"; 123 break; 124 case MXC_CPU_VF600: 125 ocotp_compat = "fsl,vf610-ocotp"; 126 soc_id = "VF600"; 127 break; 128 case MXC_CPU_VF610: 129 ocotp_compat = "fsl,vf610-ocotp"; 130 soc_id = "VF610"; 131 break; 132 default: 133 soc_id = "Unknown"; 134 } 135 soc_dev_attr->soc_id = soc_id; 136 137 if (ocotp_compat) { 138 ocotp = syscon_regmap_lookup_by_compatible(ocotp_compat); 139 if (IS_ERR(ocotp)) 140 pr_err("%s: failed to find %s regmap!\n", __func__, ocotp_compat); 141 } 142 143 if (!IS_ERR_OR_NULL(ocotp)) { 144 if (__mxc_cpu_type == MXC_CPU_IMX7ULP) { 145 regmap_read(ocotp, OCOTP_ULP_UID_4, &val); 146 soc_uid = val & 0xffff; 147 regmap_read(ocotp, OCOTP_ULP_UID_3, &val); 148 soc_uid <<= 16; 149 soc_uid |= val & 0xffff; 150 regmap_read(ocotp, OCOTP_ULP_UID_2, &val); 151 soc_uid <<= 16; 152 soc_uid |= val & 0xffff; 153 regmap_read(ocotp, OCOTP_ULP_UID_1, &val); 154 soc_uid <<= 16; 155 soc_uid |= val & 0xffff; 156 } else { 157 regmap_read(ocotp, OCOTP_UID_H, &val); 158 soc_uid = val; 159 regmap_read(ocotp, OCOTP_UID_L, &val); 160 soc_uid <<= 32; 161 soc_uid |= val; 162 } 163 } 164 165 soc_dev_attr->revision = kasprintf(GFP_KERNEL, "%d.%d", 166 (imx_get_soc_revision() >> 4) & 0xf, 167 imx_get_soc_revision() & 0xf); 168 if (!soc_dev_attr->revision) { 169 ret = -ENOMEM; 170 goto free_soc; 171 } 172 173 soc_dev_attr->serial_number = kasprintf(GFP_KERNEL, "%016llX", soc_uid); 174 if (!soc_dev_attr->serial_number) { 175 ret = -ENOMEM; 176 goto free_rev; 177 } 178 179 soc_dev = soc_device_register(soc_dev_attr); 180 if (IS_ERR(soc_dev)) { 181 ret = PTR_ERR(soc_dev); 182 goto free_serial_number; 183 } 184 185 return 0; 186 187 free_serial_number: 188 kfree(soc_dev_attr->serial_number); 189 free_rev: 190 kfree(soc_dev_attr->revision); 191 free_soc: 192 kfree(soc_dev_attr); 193 return ret; 194 } 195 device_initcall(imx_soc_device_init); 196