soc: qcom: socinfo: Expose custom attributes

The Qualcomm socinfo provides a number of additional attributes,
add these to the socinfo driver and expose them via debugfs
functionality.

Tested-by: Vinod Koul <vkoul@kernel.org>
Reviewed-by: Vinod Koul <vkoul@kernel.org>
Signed-off-by: Vaishali Thakkar <vaishali.thakkar@linaro.org>
Signed-off-by: Bjorn Andersson <bjorn.andersson@linaro.org>

diff --git a/drivers/soc/qcom/socinfo.c b/drivers/soc/qcom/socinfo.c
index 1b9eb44df7fe7ef3f7c25804409b0193385bb91b..6a4795433d57e4d97e9942ca09243e8fa20dec8a 100644 (file)
--- a/drivers/soc/qcom/socinfo.c
+++ b/drivers/soc/qcom/socinfo.c
@@ -4,6 +4,7 @@
  * Copyright (c) 2017-2019, Linaro Ltd.
  */
 
+#include <linux/debugfs.h>
 #include <linux/err.h>
 #include <linux/module.h>
 #include <linux/platform_device.h>
@@ -20,6 +21,7 @@
  */
 #define SOCINFO_MAJOR(ver) (((ver) >> 16) & 0xffff)
 #define SOCINFO_MINOR(ver) ((ver) & 0xffff)
+#define SOCINFO_VERSION(maj, min)  ((((maj) & 0xffff) << 16)|((min) & 0xffff))
 
 #define SMEM_SOCINFO_BUILD_ID_LENGTH           32
 
@@ -29,6 +31,27 @@
  */
 #define SMEM_HW_SW_BUILD_ID            137
 
+#ifdef CONFIG_DEBUG_FS
+static const char *const pmic_models[] = {
+       [0]  = "Unknown PMIC model",
+       [9]  = "PM8994",
+       [11] = "PM8916",
+       [13] = "PM8058",
+       [14] = "PM8028",
+       [15] = "PM8901",
+       [16] = "PM8027",
+       [17] = "ISL9519",
+       [18] = "PM8921",
+       [19] = "PM8018",
+       [20] = "PM8015",
+       [21] = "PM8014",
+       [22] = "PM8821",
+       [23] = "PM8038",
+       [24] = "PM8922",
+       [25] = "PM8917",
+};
+#endif /* CONFIG_DEBUG_FS */
+
 /* Socinfo SMEM item structure */
 struct socinfo {
        __le32 fmt;
@@ -67,9 +90,28 @@ struct socinfo {
        __le32 raw_device_num;
 };
 
+#ifdef CONFIG_DEBUG_FS
+struct socinfo_params {
+       u32 raw_device_family;
+       u32 hw_plat_subtype;
+       u32 accessory_chip;
+       u32 raw_device_num;
+       u32 chip_family;
+       u32 foundry_id;
+       u32 plat_ver;
+       u32 raw_ver;
+       u32 hw_plat;
+       u32 fmt;
+};
+#endif /* CONFIG_DEBUG_FS */
+
 struct qcom_socinfo {
        struct soc_device *soc_dev;
        struct soc_device_attribute attr;
+#ifdef CONFIG_DEBUG_FS
+       struct dentry *dbg_root;
+       struct socinfo_params info;
+#endif /* CONFIG_DEBUG_FS */
 };
 
 struct soc_id {
@@ -130,6 +172,150 @@ static const char *socinfo_machine(struct device *dev, unsigned int id)
        return NULL;
 }
 
+#ifdef CONFIG_DEBUG_FS
+
+#define QCOM_OPEN(name, _func)                                         \
+static int qcom_open_##name(struct inode *inode, struct file *file)    \
+{                                                                      \
+       return single_open(file, _func, inode->i_private);              \
+}                                                                      \
+                                                                       \
+static const struct file_operations qcom_ ##name## _ops = {            \
+       .open = qcom_open_##name,                                       \
+       .read = seq_read,                                               \
+       .llseek = seq_lseek,                                            \
+       .release = single_release,                                      \
+}
+
+#define DEBUGFS_ADD(info, name)                                                \
+       debugfs_create_file(__stringify(name), 0400,                    \
+                           qcom_socinfo->dbg_root,                     \
+                           info, &qcom_ ##name## _ops)
+
+
+static int qcom_show_build_id(struct seq_file *seq, void *p)
+{
+       struct socinfo *socinfo = seq->private;
+
+       seq_printf(seq, "%s\n", socinfo->build_id);
+
+       return 0;
+}
+
+static int qcom_show_pmic_model(struct seq_file *seq, void *p)
+{
+       struct socinfo *socinfo = seq->private;
+       int model = SOCINFO_MINOR(le32_to_cpu(socinfo->pmic_model));
+
+       if (model < 0)
+               return -EINVAL;
+
+       seq_printf(seq, "%s\n", pmic_models[model]);
+
+       return 0;
+}
+
+static int qcom_show_pmic_die_revision(struct seq_file *seq, void *p)
+{
+       struct socinfo *socinfo = seq->private;
+
+       seq_printf(seq, "%u.%u\n",
+                  SOCINFO_MAJOR(le32_to_cpu(socinfo->pmic_die_rev)),
+                  SOCINFO_MINOR(le32_to_cpu(socinfo->pmic_die_rev)));
+
+       return 0;
+}
+
+QCOM_OPEN(build_id, qcom_show_build_id);
+QCOM_OPEN(pmic_model, qcom_show_pmic_model);
+QCOM_OPEN(pmic_die_rev, qcom_show_pmic_die_revision);
+
+static void socinfo_debugfs_init(struct qcom_socinfo *qcom_socinfo,
+                                struct socinfo *info)
+{
+       size_t size;
+
+       qcom_socinfo->dbg_root = debugfs_create_dir("qcom_socinfo", NULL);
+
+       qcom_socinfo->info.fmt = __le32_to_cpu(info->fmt);
+
+       switch (qcom_socinfo->info.fmt) {
+       case SOCINFO_VERSION(0, 12):
+               qcom_socinfo->info.chip_family =
+                       __le32_to_cpu(info->chip_family);
+               qcom_socinfo->info.raw_device_family =
+                       __le32_to_cpu(info->raw_device_family);
+               qcom_socinfo->info.raw_device_num =
+                       __le32_to_cpu(info->raw_device_num);
+
+               debugfs_create_x32("chip_family", 0400, qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.chip_family);
+               debugfs_create_x32("raw_device_family", 0400,
+                                  qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.raw_device_family);
+               debugfs_create_x32("raw_device_number", 0400,
+                                  qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.raw_device_num);
+       case SOCINFO_VERSION(0, 11):
+       case SOCINFO_VERSION(0, 10):
+       case SOCINFO_VERSION(0, 9):
+               qcom_socinfo->info.foundry_id = __le32_to_cpu(info->foundry_id);
+
+               debugfs_create_u32("foundry_id", 0400, qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.foundry_id);
+       case SOCINFO_VERSION(0, 8):
+       case SOCINFO_VERSION(0, 7):
+               DEBUGFS_ADD(info, pmic_model);
+               DEBUGFS_ADD(info, pmic_die_rev);
+       case SOCINFO_VERSION(0, 6):
+               qcom_socinfo->info.hw_plat_subtype =
+                       __le32_to_cpu(info->hw_plat_subtype);
+
+               debugfs_create_u32("hardware_platform_subtype", 0400,
+                                  qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.hw_plat_subtype);
+       case SOCINFO_VERSION(0, 5):
+               qcom_socinfo->info.accessory_chip =
+                       __le32_to_cpu(info->accessory_chip);
+
+               debugfs_create_u32("accessory_chip", 0400,
+                                  qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.accessory_chip);
+       case SOCINFO_VERSION(0, 4):
+               qcom_socinfo->info.plat_ver = __le32_to_cpu(info->plat_ver);
+
+               debugfs_create_u32("platform_version", 0400,
+                                  qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.plat_ver);
+       case SOCINFO_VERSION(0, 3):
+               qcom_socinfo->info.hw_plat = __le32_to_cpu(info->hw_plat);
+
+               debugfs_create_u32("hardware_platform", 0400,
+                                  qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.hw_plat);
+       case SOCINFO_VERSION(0, 2):
+               qcom_socinfo->info.raw_ver  = __le32_to_cpu(info->raw_ver);
+
+               debugfs_create_u32("raw_version", 0400, qcom_socinfo->dbg_root,
+                                  &qcom_socinfo->info.raw_ver);
+       case SOCINFO_VERSION(0, 1):
+               DEBUGFS_ADD(info, build_id);
+               break;
+       }
+}
+
+static void socinfo_debugfs_exit(struct qcom_socinfo *qcom_socinfo)
+{
+       debugfs_remove_recursive(qcom_socinfo->dbg_root);
+}
+#else
+static void socinfo_debugfs_init(struct qcom_socinfo *qcom_socinfo,
+                                struct socinfo *info)
+{
+}
+static void socinfo_debugfs_exit(struct qcom_socinfo *qcom_socinfo) {  }
+#endif /* CONFIG_DEBUG_FS */
+
 static int qcom_socinfo_probe(struct platform_device *pdev)
 {
        struct qcom_socinfo *qs;
@@ -162,6 +348,8 @@ static int qcom_socinfo_probe(struct platform_device *pdev)
        if (IS_ERR(qs->soc_dev))
                return PTR_ERR(qs->soc_dev);
 
+       socinfo_debugfs_init(qs, info);
+
        /* Feed the soc specific unique data into entropy pool */
        add_device_randomness(info, item_size);
 
@@ -176,6 +364,8 @@ static int qcom_socinfo_remove(struct platform_device *pdev)
 
        soc_device_unregister(qs->soc_dev);
 
+       socinfo_debugfs_exit(qs);
+
        return 0;
 }