Loading...
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 | // SPDX-License-Identifier: GPL-2.0 /* * Copyright (c) 2019 Samsung Electronics Co., Ltd. * http://www.samsung.com/ * * Exynos - CHIP ID support * Author: Pankaj Dubey <pankaj.dubey@samsung.com> * Author: Bartlomiej Zolnierkiewicz <b.zolnierkie@samsung.com> */ #include <linux/io.h> #include <linux/mfd/syscon.h> #include <linux/of.h> #include <linux/regmap.h> #include <linux/slab.h> #include <linux/soc/samsung/exynos-chipid.h> #include <linux/sys_soc.h> static const struct exynos_soc_id { const char *name; unsigned int id; } soc_ids[] = { /* List ordered by SoC name */ { "EXYNOS3250", 0xE3472000 }, { "EXYNOS4210", 0x43200000 }, /* EVT0 revision */ { "EXYNOS4210", 0x43210000 }, { "EXYNOS4212", 0x43220000 }, { "EXYNOS4412", 0xE4412000 }, { "EXYNOS5250", 0x43520000 }, { "EXYNOS5260", 0xE5260000 }, { "EXYNOS5410", 0xE5410000 }, { "EXYNOS5420", 0xE5420000 }, { "EXYNOS5433", 0xE5433000 }, { "EXYNOS5440", 0xE5440000 }, { "EXYNOS5800", 0xE5422000 }, { "EXYNOS7420", 0xE7420000 }, }; static const char * __init product_id_to_soc_id(unsigned int product_id) { int i; for (i = 0; i < ARRAY_SIZE(soc_ids); i++) if ((product_id & EXYNOS_MASK) == soc_ids[i].id) return soc_ids[i].name; return NULL; } static int __init exynos_chipid_early_init(void) { struct soc_device_attribute *soc_dev_attr; struct soc_device *soc_dev; struct device_node *root; struct device_node *syscon; struct regmap *regmap; u32 product_id; u32 revision; int ret; syscon = of_find_compatible_node(NULL, NULL, "samsung,exynos4210-chipid"); if (!syscon) return -ENODEV; regmap = device_node_to_regmap(syscon); of_node_put(syscon); if (IS_ERR(regmap)) return PTR_ERR(regmap); ret = regmap_read(regmap, EXYNOS_CHIPID_REG_PRO_ID, &product_id); if (ret < 0) return ret; revision = product_id & EXYNOS_REV_MASK; soc_dev_attr = kzalloc(sizeof(*soc_dev_attr), GFP_KERNEL); if (!soc_dev_attr) return -ENOMEM; soc_dev_attr->family = "Samsung Exynos"; root = of_find_node_by_path("/"); of_property_read_string(root, "model", &soc_dev_attr->machine); of_node_put(root); soc_dev_attr->revision = kasprintf(GFP_KERNEL, "%x", revision); soc_dev_attr->soc_id = product_id_to_soc_id(product_id); if (!soc_dev_attr->soc_id) { pr_err("Unknown SoC\n"); ret = -ENODEV; goto err; } /* please note that the actual registration will be deferred */ soc_dev = soc_device_register(soc_dev_attr); if (IS_ERR(soc_dev)) { ret = PTR_ERR(soc_dev); goto err; } dev_info(soc_device_to_device(soc_dev), "Exynos: CPU[%s] PRO_ID[0x%x] REV[0x%x] Detected\n", soc_dev_attr->soc_id, product_id, revision); return 0; err: kfree(soc_dev_attr->revision); kfree(soc_dev_attr); return ret; } arch_initcall(exynos_chipid_early_init); |