[PATCH v2 09/15] soc: qcom: smem: get serial number from socinfo

[Casey Connolly]

Implement socinfo support to fetch the serial number if available.

Signed-off-by: Casey Connolly <casey.conno...@linaro.org>
---
 drivers/soc/qcom/smem.c | 25 +++++++++++++++++++++++++
 include/soc/qcom/smem.h |  1 +
 2 files changed, 26 insertions(+)

diff --git a/drivers/soc/qcom/smem.c b/drivers/soc/qcom/smem.c
index 96288d7bcdef..e20523e2cec3 100644
--- a/drivers/soc/qcom/smem.c
+++ b/drivers/soc/qcom/smem.c
@@ -14,8 +14,10 @@
 #include <linux/io.h>
 #include <linux/ioport.h>
 #include <linux/sizes.h>
 #include <soc/qcom/smem.h>
+#include <soc/qcom/socinfo.h>
+#include <env.h>
 
 /*
  * The Qualcomm shared memory system is a allocate only heap structure that
  * consists of one of more memory areas that can be accessed by the processors
@@ -991,8 +993,31 @@ static int qcom_smem_map_global(struct qcom_smem *smem, 
u32 size)
 
        return 0;
 }
 
+int qcom_socinfo_init(void)
+{
+       struct socinfo *info;
+       size_t item_size;
+       char buf[32] = { 0 };
+
+       info = qcom_smem_get(QCOM_SMEM_HOST_ANY, SMEM_HW_SW_BUILD_ID,
+                            &item_size);
+       if (IS_ERR(info)) {
+               log_err("Couldn't find socinfo: %ld\n", PTR_ERR(info));
+               return PTR_ERR(info);
+       }
+
+       if (offsetof(struct socinfo, serial_num) + sizeof(info->serial_num) <= 
item_size) {
+               snprintf(buf, sizeof(buf), "%u", le32_to_cpu(info->serial_num));
+               env_set("serial#", buf);
+       } else {
+               return -ENOENT;
+       }
+
+       return 0;
+}
+
 int qcom_smem_init(void)
 {
        struct smem_header *header;
        int num_regions;
diff --git a/include/soc/qcom/smem.h b/include/soc/qcom/smem.h
index a955db08c0f0..755003807dba 100644
--- a/include/soc/qcom/smem.h
+++ b/include/soc/qcom/smem.h
@@ -4,8 +4,9 @@
 
 #define QCOM_SMEM_HOST_ANY -1
 
 int qcom_smem_init(void);
+int qcom_socinfo_init(void);
 
 bool qcom_smem_is_available(void);
 int qcom_smem_alloc(unsigned host, unsigned item, size_t size);
 void *qcom_smem_get(unsigned host, unsigned item, size_t *size);

-- 
2.53.0