Add the rt linux 4.1.3-rt3 as base

[kvmfornfv.git] / kernel / drivers / mfd / qcom-spmi-pmic.c

diff --git a/kernel/drivers/mfd/qcom-spmi-pmic.c b/kernel/drivers/mfd/qcom-spmi-pmic.c
new file mode 100644 (file)
index 0000000..af6ac1c
--- /dev/null
+++ b/kernel/drivers/mfd/qcom-spmi-pmic.c
@@ -0,0 +1,156 @@
+/*
+ * Copyright (c) 2014, The Linux Foundation. All rights reserved.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 and
+ * only version 2 as published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ */
+
+#include <linux/kernel.h>
+#include <linux/module.h>
+#include <linux/spmi.h>
+#include <linux/regmap.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 COMMON_SUBTYPE         0x00
+#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 const struct of_device_id pmic_spmi_id_table[] = {
+       { .compatible = "qcom,spmi-pmic", .data = (void *)COMMON_SUBTYPE },
+       { .compatible = "qcom,pm8941",    .data = (void *)PM8941_SUBTYPE },
+       { .compatible = "qcom,pm8841",    .data = (void *)PM8841_SUBTYPE },
+       { .compatible = "qcom,pm8019",    .data = (void *)PM8019_SUBTYPE },
+       { .compatible = "qcom,pm8226",    .data = (void *)PM8226_SUBTYPE },
+       { .compatible = "qcom,pm8110",    .data = (void *)PM8110_SUBTYPE },
+       { .compatible = "qcom,pma8084",   .data = (void *)PMA8084_SUBTYPE },
+       { .compatible = "qcom,pmi8962",   .data = (void *)PMI8962_SUBTYPE },
+       { .compatible = "qcom,pmd9635",   .data = (void *)PMD9635_SUBTYPE },
+       { .compatible = "qcom,pm8994",    .data = (void *)PM8994_SUBTYPE },
+       { .compatible = "qcom,pmi8994",   .data = (void *)PMI8994_SUBTYPE },
+       { .compatible = "qcom,pm8916",    .data = (void *)PM8916_SUBTYPE },
+       { .compatible = "qcom,pm8004",    .data = (void *)PM8004_SUBTYPE },
+       { .compatible = "qcom,pm8909",    .data = (void *)PM8909_SUBTYPE },
+       { }
+};
+
+static void pmic_spmi_show_revid(struct regmap *map, struct device *dev)
+{
+       unsigned int rev2, minor, major, type, subtype;
+       const char *name = "unknown";
+       int ret, i;
+
+       ret = regmap_read(map, PMIC_TYPE, &type);
+       if (ret < 0)
+               return;
+
+       if (type != PMIC_TYPE_VALUE)
+               return;
+
+       ret = regmap_read(map, PMIC_SUBTYPE, &subtype);
+       if (ret < 0)
+               return;
+
+       for (i = 0; i < ARRAY_SIZE(pmic_spmi_id_table); i++) {
+               if (subtype == (unsigned long)pmic_spmi_id_table[i].data)
+                       break;
+       }
+
+       if (i != ARRAY_SIZE(pmic_spmi_id_table))
+               name = pmic_spmi_id_table[i].compatible;
+
+       ret = regmap_read(map, PMIC_REV2, &rev2);
+       if (ret < 0)
+               return;
+
+       ret = regmap_read(map, PMIC_REV3, &minor);
+       if (ret < 0)
+               return;
+
+       ret = regmap_read(map, PMIC_REV4, &major);
+       if (ret < 0)
+               return;
+
+       /*
+        * 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) &&
+           major < 0x02)
+               major++;
+
+       if (subtype == PM8110_SUBTYPE)
+               minor = rev2;
+
+       dev_dbg(dev, "%x: %s v%d.%d\n", subtype, name, major, minor);
+}
+
+static const struct regmap_config spmi_regmap_config = {
+       .reg_bits       = 16,
+       .val_bits       = 8,
+       .max_register   = 0xffff,
+       .fast_io        = true,
+};
+
+static int pmic_spmi_probe(struct spmi_device *sdev)
+{
+       struct device_node *root = sdev->dev.of_node;
+       struct regmap *regmap;
+
+       regmap = devm_regmap_init_spmi_ext(sdev, &spmi_regmap_config);
+       if (IS_ERR(regmap))
+               return PTR_ERR(regmap);
+
+       pmic_spmi_show_revid(regmap, &sdev->dev);
+
+       return of_platform_populate(root, NULL, NULL, &sdev->dev);
+}
+
+static void pmic_spmi_remove(struct spmi_device *sdev)
+{
+       of_platform_depopulate(&sdev->dev);
+}
+
+MODULE_DEVICE_TABLE(of, pmic_spmi_id_table);
+
+static struct spmi_driver pmic_spmi_driver = {
+       .probe = pmic_spmi_probe,
+       .remove = pmic_spmi_remove,
+       .driver = {
+               .name = "pmic-spmi",
+               .of_match_table = pmic_spmi_id_table,
+       },
+};
+module_spmi_driver(pmic_spmi_driver);
+
+MODULE_DESCRIPTION("Qualcomm SPMI PMIC driver");
+MODULE_ALIAS("spmi:spmi-pmic");
+MODULE_LICENSE("GPL v2");
+MODULE_AUTHOR("Josh Cartwright <joshc@codeaurora.org>");
+MODULE_AUTHOR("Stanimir Varbanov <svarbanov@mm-sol.com>");