[PATCH] mfd: qcom-spmi-pmic: Add support for more chips versions
From: Ivan T. Ivanov
Date: Tue Nov 04 2014 - 08:33:13 EST
Update compatible string with runtime detected chip revision
information, for example qcom,pm8941 will become qcom,pm8941-v1.0.
Signed-off-by: Ivan T. Ivanov <iivanov@xxxxxxxxxx>
---
.../devicetree/bindings/mfd/qcom,spmi-pmic.txt | 18 ++-
drivers/mfd/qcom-spmi-pmic.c | 142 +++++++++++++++++++++
2 files changed, 156 insertions(+), 4 deletions(-)
diff --git a/Documentation/devicetree/bindings/mfd/qcom,spmi-pmic.txt b/Documentation/devicetree/bindings/mfd/qcom,spmi-pmic.txt
index 7182b88..bbe7db8 100644
--- a/Documentation/devicetree/bindings/mfd/qcom,spmi-pmic.txt
+++ b/Documentation/devicetree/bindings/mfd/qcom,spmi-pmic.txt
@@ -15,10 +15,20 @@ each. A function can consume one or more of these fixed-size register regions.
Required properties:
- compatible: Should contain one of:
- "qcom,pm8941"
- "qcom,pm8841"
- "qcom,pma8084"
- or generalized "qcom,spmi-pmic".
+ qcom,pm8941,
+ qcom,pm8841,
+ qcom,pm8019,
+ qcom,pm8226,
+ qcom,pm8110,
+ qcom,pma8084,
+ qcom,pmi8962,
+ qcom,pmd9635,
+ qcom,pm8994,
+ qcom,pmi8994,
+ qcom,pm8916,
+ qcom,pm8004,
+ qcom,pm8909,
+ or generalized "qcom,spmi-pmic".
- reg: Specifies the SPMI USID slave address for this device.
For more information see:
Documentation/devicetree/bindings/spmi/spmi.txt
diff --git a/drivers/mfd/qcom-spmi-pmic.c b/drivers/mfd/qcom-spmi-pmic.c
index 4b8beb2..67446a4 100644
--- a/drivers/mfd/qcom-spmi-pmic.c
+++ b/drivers/mfd/qcom-spmi-pmic.c
@@ -13,10 +13,126 @@
#include <linux/kernel.h>
#include <linux/module.h>
+#include <linux/slab.h>
#include <linux/spmi.h>
#include <linux/regmap.h>
+#include <linux/of.h>
#include <linux/of_platform.h>
+#define PMIC_REV2 0x101
+#define PMIC_REV3 0x102
+#define PMIC_REV4 0x103
+#define PMIC_TYPE 0x104
+#define PMIC_SUBTYPE 0x105
+
+#define PMIC_TYPE_VALUE 0x51
+
+#define PM8941_SUBTYPE 0x01
+#define PM8841_SUBTYPE 0x02
+#define PM8019_SUBTYPE 0x03
+#define PM8226_SUBTYPE 0x04
+#define PM8110_SUBTYPE 0x05
+#define PMA8084_SUBTYPE 0x06
+#define PMI8962_SUBTYPE 0x07
+#define PMD9635_SUBTYPE 0x08
+#define PM8994_SUBTYPE 0x09
+#define PMI8994_SUBTYPE 0x0a
+#define PM8916_SUBTYPE 0x0b
+#define PM8004_SUBTYPE 0x0c
+#define PM8909_SUBTYPE 0x0d
+
+static int pmic_spmi_read_revid(struct regmap *map, char **name,
+ int *major, int *minor)
+{
+ unsigned int rev2, rev3, rev4, type, subtype;
+ int ret;
+
+ ret = regmap_read(map, PMIC_TYPE, &type);
+ if (ret < 0)
+ return ret;
+
+ if (type != PMIC_TYPE_VALUE)
+ return -EINVAL;
+
+ ret = regmap_read(map, PMIC_SUBTYPE, &subtype);
+ if (ret < 0)
+ return ret;
+
+ rev2 = regmap_read(map, PMIC_REV2, &rev2);
+ if (ret < 0)
+ return ret;
+
+ rev3 = regmap_read(map, PMIC_REV3, &rev3);
+ if (ret < 0)
+ return ret;
+
+ rev4 = regmap_read(map, PMIC_REV4, &rev4);
+ if (ret < 0)
+ return ret;
+
+ /*
+ * In early versions of PM8941 and PM8226, the major revision number
+ * started incrementing from 0 (eg 0 = v1.0, 1 = v2.0).
+ * Increment the major revision number here if the chip is an early
+ * version of PM8941 or PM8226.
+ */
+ if ((subtype == PM8941_SUBTYPE || subtype == PM8226_SUBTYPE) &&
+ rev4 < 0x02)
+ rev4++;
+
+ *major = rev4;
+ if (subtype == PM8110_SUBTYPE)
+ *minor = rev2;
+ else
+ *minor = rev3;
+
+ switch (subtype) {
+ case PM8941_SUBTYPE:
+ *name = "pm8941";
+ break;
+ case PM8841_SUBTYPE:
+ *name = "pm8841";
+ break;
+ case PM8019_SUBTYPE:
+ *name = "pm8019";
+ break;
+ case PM8226_SUBTYPE:
+ *name = "pm8226";
+ break;
+ case PM8110_SUBTYPE:
+ *name = "pm8110";
+ break;
+ case PMA8084_SUBTYPE:
+ *name = "pma8084";
+ break;
+ case PMI8962_SUBTYPE:
+ *name = "pmi8962";
+ break;
+ case PMD9635_SUBTYPE:
+ *name = "pmd8635";
+ break;
+ case PM8994_SUBTYPE:
+ *name = "pm8994";
+ break;
+ case PMI8994_SUBTYPE:
+ *name = "pmi8994";
+ break;
+ case PM8916_SUBTYPE:
+ *name = "pm8916";
+ break;
+ case PM8004_SUBTYPE:
+ *name = "pm8004";
+ break;
+ case PM8909_SUBTYPE:
+ *name = "pm8909";
+ break;
+ default:
+ return -EINVAL;
+ }
+
+ return 0;
+}
+
static const struct regmap_config spmi_regmap_config = {
.reg_bits = 16,
.val_bits = 8,
@@ -28,11 +144,27 @@ static int pmic_spmi_probe(struct spmi_device *sdev)
{
struct device_node *root = sdev->dev.of_node;
struct regmap *regmap;
+ struct property *prop;
+ int major, minor, ret;
+ char *name, compatible[32];
regmap = devm_regmap_init_spmi_ext(sdev, &spmi_regmap_config);
if (IS_ERR(regmap))
return PTR_ERR(regmap);
+ ret = pmic_spmi_read_revid(regmap, &name, &major, &minor);
+ if (!ret) {
+ snprintf(compatible, ARRAY_SIZE(compatible), "qcom,%s-v%d.%d",
+ name, major, minor);
+ prop = kzalloc(sizeof(*prop), GFP_KERNEL);
+ if (prop) {
+ prop->name = kstrdup("compatible", GFP_KERNEL);
+ prop->value = kstrdup(compatible, GFP_KERNEL);
+ prop->length = strlen(prop->value);
+ of_update_property(root, prop);
+ }
+ }
+
return of_platform_populate(root, NULL, NULL, &sdev->dev);
}
@@ -45,7 +177,17 @@ static const struct of_device_id pmic_spmi_id_table[] = {
{ .compatible = "qcom,spmi-pmic" },
{ .compatible = "qcom,pm8941" },
{ .compatible = "qcom,pm8841" },
+ { .compatible = "qcom,pm8019" },
+ { .compatible = "qcom,pm8226" },
+ { .compatible = "qcom,pm8110" },
{ .compatible = "qcom,pma8084" },
+ { .compatible = "qcom,pmi8962" },
+ { .compatible = "qcom,pmd9635" },
+ { .compatible = "qcom,pm8994" },
+ { .compatible = "qcom,pmi8994" },
+ { .compatible = "qcom,pm8916" },
+ { .compatible = "qcom,pm8004" },
+ { .compatible = "qcom,pm8909" },
{ }
};
MODULE_DEVICE_TABLE(of, pmic_spmi_id_table);
--
1.9.1
--
To unsubscribe from this list: send the line "unsubscribe linux-kernel" in
the body of a message to majordomo@xxxxxxxxxxxxxxx
More majordomo info at http://vger.kernel.org/majordomo-info.html
Please read the FAQ at http://www.tux.org/lkml/