1 files changed, 513 insertions, 0 deletions

diff --git a/drivers/regulator/da903x.c b/drivers/regulator/da903x.c
new file mode 100644
index 000000000000..3688e339db87
--- /dev/null
+++ b/drivers/regulator/da903x.c
@@ -0,0 +1,513 @@
+/*
+ * Regulators driver for Dialog Semiconductor DA903x
+ *
+ * Copyright (C) 2006-2008 Marvell International Ltd.
+ * Copyright (C) 2008 Compulab Ltd.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ */
+
+#include <linux/kernel.h>
+#include <linux/init.h>
+#include <linux/err.h>
+#include <linux/platform_device.h>
+#include <linux/regulator/driver.h>
+#include <linux/regulator/machine.h>
+#include <linux/mfd/da903x.h>
+
+/* DA9030 Registers */
+#define DA9030_INVAL            (-1)
+#define DA9030_LDO1011          (0x10)
+#define DA9030_LDO15            (0x11)
+#define DA9030_LDO1416          (0x12)
+#define DA9030_LDO1819          (0x13)
+#define DA9030_LDO17            (0x14)
+#define DA9030_BUCK2DVM1        (0x15)
+#define DA9030_BUCK2DVM2        (0x16)
+#define DA9030_RCTL11           (0x17)
+#define DA9030_RCTL21           (0x18)
+#define DA9030_LDO1             (0x90)
+#define DA9030_LDO23            (0x91)
+#define DA9030_LDO45            (0x92)
+#define DA9030_LDO6             (0x93)
+#define DA9030_LDO78            (0x94)
+#define DA9030_LDO912           (0x95)
+#define DA9030_BUCK             (0x96)
+#define DA9030_RCTL12           (0x97)
+#define DA9030_RCTL22           (0x98)
+#define DA9030_LDO_UNLOCK       (0xa0)
+#define DA9030_LDO_UNLOCK_MASK  (0xe0)
+#define DA9034_OVER1            (0x10)
+
+/* DA9034 Registers */
+#define DA9034_INVAL            (-1)
+#define DA9034_OVER2            (0x11)
+#define DA9034_OVER3            (0x12)
+#define DA9034_LDO643           (0x13)
+#define DA9034_LDO987           (0x14)
+#define DA9034_LDO1110          (0x15)
+#define DA9034_LDO1312          (0x16)
+#define DA9034_LDO1514          (0x17)
+#define DA9034_VCC1             (0x20)
+#define DA9034_ADTV1            (0x23)
+#define DA9034_ADTV2            (0x24)
+#define DA9034_AVRC             (0x25)
+#define DA9034_CDTV1            (0x26)
+#define DA9034_CDTV2            (0x27)
+#define DA9034_CVRC             (0x28)
+#define DA9034_SDTV1            (0x29)
+#define DA9034_SDTV2            (0x2a)
+#define DA9034_SVRC             (0x2b)
+#define DA9034_MDTV1            (0x32)
+#define DA9034_MDTV2            (0x33)
+#define DA9034_MVRC             (0x34)
+
+struct da903x_regulator_info {
+        struct regulator_desc desc;
+
+        int     min_uV;
+        int     max_uV;
+        int     step_uV;
+        int     vol_reg;
+        int     vol_shift;
+        int     vol_nbits;
+        int     update_reg;
+        int     update_bit;
+        int     enable_reg;
+        int     enable_bit;
+};
+
+static inline int check_range(struct da903x_regulator_info *info,
+                                int min_uV, int max_uV)
+{
+        if (min_uV < info->min_uV || min_uV > info->max_uV)
+                return -EINVAL;
+
+        return 0;
+}
+
+/* DA9030/DA9034 common operations */
+static int da903x_set_ldo_voltage(struct regulator_dev *rdev,
+                                  int min_uV, int max_uV)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da9034_dev = rdev_get_dev(rdev)->parent;
+        uint8_t val, mask;
+
+        if (check_range(info, min_uV, max_uV)) {
+                pr_err("invalid voltage range (%d, %d) uV", min_uV, max_uV);
+                return -EINVAL;
+        }
+
+        val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
+        val <<= info->vol_shift;
+        mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
+
+        return da903x_update(da9034_dev, info->vol_reg, val, mask);
+}
+
+static int da903x_get_voltage(struct regulator_dev *rdev)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da9034_dev = rdev_get_dev(rdev)->parent;
+        uint8_t val, mask;
+        int ret;
+
+        ret = da903x_read(da9034_dev, info->vol_reg, &val);
+        if (ret)
+                return ret;
+
+        mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
+        val = (val & mask) >> info->vol_shift;
+
+        return info->min_uV + info->step_uV * val;
+}
+
+static int da903x_enable(struct regulator_dev *rdev)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da9034_dev = rdev_get_dev(rdev)->parent;
+
+        return da903x_set_bits(da9034_dev, info->enable_reg,
+                                        1 << info->enable_bit);
+}
+
+static int da903x_disable(struct regulator_dev *rdev)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da9034_dev = rdev_get_dev(rdev)->parent;
+
+        return da903x_clr_bits(da9034_dev, info->enable_reg,
+                                        1 << info->enable_bit);
+}
+
+static int da903x_is_enabled(struct regulator_dev *rdev)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da9034_dev = rdev_get_dev(rdev)->parent;
+        uint8_t reg_val;
+        int ret;
+
+        ret = da903x_read(da9034_dev, info->enable_reg, &reg_val);
+        if (ret)
+                return ret;
+
+        return reg_val & (1 << info->enable_bit);
+}
+
+/* DA9030 specific operations */
+static int da9030_set_ldo1_15_voltage(struct regulator_dev *rdev,
+                                       int min_uV, int max_uV)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da903x_dev = rdev_get_dev(rdev)->parent;
+        uint8_t val, mask;
+        int ret;
+
+        if (check_range(info, min_uV, max_uV)) {
+                pr_err("invalid voltage range (%d, %d) uV", min_uV, max_uV);
+                return -EINVAL;
+        }
+
+        val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
+        val <<= info->vol_shift;
+        mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
+        val |= DA9030_LDO_UNLOCK; /* have to set UNLOCK bits */
+        mask |= DA9030_LDO_UNLOCK_MASK;
+
+        /* write twice */
+        ret = da903x_update(da903x_dev, info->vol_reg, val, mask);
+        if (ret)
+                return ret;
+
+        return da903x_update(da903x_dev, info->vol_reg, val, mask);
+}
+
+static int da9030_set_ldo14_voltage(struct regulator_dev *rdev,
+                                  int min_uV, int max_uV)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da903x_dev = rdev_get_dev(rdev)->parent;
+        uint8_t val, mask;
+        int thresh;
+
+        if (check_range(info, min_uV, max_uV)) {
+                pr_err("invalid voltage range (%d, %d) uV", min_uV, max_uV);
+                return -EINVAL;
+        }
+
+        thresh = (info->max_uV + info->min_uV) / 2;
+        if (min_uV < thresh) {
+                val = (thresh - min_uV + info->step_uV - 1) / info->step_uV;
+                val |= 0x4;
+        } else {
+                val = (min_uV - thresh + info->step_uV - 1) / info->step_uV;
+        }
+
+        val <<= info->vol_shift;
+        mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
+
+        return da903x_update(da903x_dev, info->vol_reg, val, mask);
+}
+
+static int da9030_get_ldo14_voltage(struct regulator_dev *rdev)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da903x_dev = rdev_get_dev(rdev)->parent;
+        uint8_t val, mask;
+        int ret;
+
+        ret = da903x_read(da903x_dev, info->vol_reg, &val);
+        if (ret)
+                return ret;
+
+        mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
+        val = (val & mask) >> info->vol_shift;
+
+        if (val & 0x4)
+                return info->min_uV + info->step_uV * (3 - (val & ~0x4));
+        else
+                return (info->max_uV + info->min_uV) / 2 +
+                        info->step_uV * (val & ~0x4);
+}
+
+/* DA9034 specific operations */
+static int da9034_set_dvc_voltage(struct regulator_dev *rdev,
+                                  int min_uV, int max_uV)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da9034_dev = rdev_get_dev(rdev)->parent;
+        uint8_t val, mask;
+        int ret;
+
+        if (check_range(info, min_uV, max_uV)) {
+                pr_err("invalid voltage range (%d, %d) uV", min_uV, max_uV);
+                return -EINVAL;
+        }
+
+        val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
+        val <<= info->vol_shift;
+        mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
+
+        ret = da903x_update(da9034_dev, info->vol_reg, val, mask);
+        if (ret)
+                return ret;
+
+        ret = da903x_set_bits(da9034_dev, info->update_reg,
+                                        1 << info->update_bit);
+        return ret;
+}
+
+static int da9034_set_ldo12_voltage(struct regulator_dev *rdev,
+                                    int min_uV, int max_uV)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da9034_dev = rdev_get_dev(rdev)->parent;
+        uint8_t val, mask;
+
+        if (check_range(info, min_uV, max_uV)) {
+                pr_err("invalid voltage range (%d, %d) uV", min_uV, max_uV);
+                return -EINVAL;
+        }
+
+        val = (min_uV - info->min_uV + info->step_uV - 1) / info->step_uV;
+        val = (val > 7 || val < 20) ? 8 : val - 12;
+        val <<= info->vol_shift;
+        mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
+
+        return da903x_update(da9034_dev, info->vol_reg, val, mask);
+}
+
+static int da9034_get_ldo12_voltage(struct regulator_dev *rdev)
+{
+        struct da903x_regulator_info *info = rdev_get_drvdata(rdev);
+        struct device *da9034_dev = rdev_get_dev(rdev)->parent;
+        uint8_t val, mask;
+        int ret;
+
+        ret = da903x_read(da9034_dev, info->vol_reg, &val);
+        if (ret)
+                return ret;
+
+        mask = ((1 << info->vol_nbits) - 1)  << info->vol_shift;
+        val = (val & mask) >> info->vol_shift;
+
+        if (val >= 8)
+                return 2700000 + info->step_uV * (val - 8);
+
+        return info->min_uV + info->step_uV * val;
+}
+
+static struct regulator_ops da903x_regulator_ldo_ops = {
+        .set_voltage    = da903x_set_ldo_voltage,
+        .get_voltage    = da903x_get_voltage,
+        .enable         = da903x_enable,
+        .disable        = da903x_disable,
+        .is_enabled     = da903x_is_enabled,
+};
+
+/* NOTE: this is dedicated for the insane DA9030 LDO14 */
+static struct regulator_ops da9030_regulator_ldo14_ops = {
+        .set_voltage    = da9030_set_ldo14_voltage,
+        .get_voltage    = da9030_get_ldo14_voltage,
+        .enable         = da903x_enable,
+        .disable        = da903x_disable,
+        .is_enabled     = da903x_is_enabled,
+};
+
+/* NOTE: this is dedicated for the DA9030 LDO1 and LDO15 that have locks  */
+static struct regulator_ops da9030_regulator_ldo1_15_ops = {
+        .set_voltage    = da9030_set_ldo1_15_voltage,
+        .get_voltage    = da903x_get_voltage,
+        .enable         = da903x_enable,
+        .disable        = da903x_disable,
+        .is_enabled     = da903x_is_enabled,
+};
+
+static struct regulator_ops da9034_regulator_dvc_ops = {
+        .set_voltage    = da9034_set_dvc_voltage,
+        .get_voltage    = da903x_get_voltage,
+        .enable         = da903x_enable,
+        .disable        = da903x_disable,
+        .is_enabled     = da903x_is_enabled,
+};
+
+/* NOTE: this is dedicated for the insane LDO12 */
+static struct regulator_ops da9034_regulator_ldo12_ops = {
+        .set_voltage    = da9034_set_ldo12_voltage,
+        .get_voltage    = da9034_get_ldo12_voltage,
+        .enable         = da903x_enable,
+        .disable        = da903x_disable,
+        .is_enabled     = da903x_is_enabled,
+};
+
+#define DA903x_LDO(_pmic, _id, min, max, step, vreg, shift, nbits, ereg, ebit)  \
+{                                                                       \
+        .desc   = {                                                     \
+                .name   = "LDO" #_id,                                   \
+                .ops    = &da903x_regulator_ldo_ops,                    \
+                .type   = REGULATOR_VOLTAGE,                            \
+                .id     = _pmic##_ID_LDO##_id,                          \
+                .owner  = THIS_MODULE,                                  \
+        },                                                              \
+        .min_uV         = (min) * 1000,                                 \
+        .max_uV         = (max) * 1000,                                 \
+        .step_uV        = (step) * 1000,                                \
+        .vol_reg        = _pmic##_##vreg,                               \
+        .vol_shift      = (shift),                                      \
+        .vol_nbits      = (nbits),                                      \
+        .enable_reg     = _pmic##_##ereg,                               \
+        .enable_bit     = (ebit),                                       \
+}
+
+#define DA9034_DVC(_id, min, max, step, vreg, nbits, ureg, ubit, ereg, ebit) \
+{                                                                       \
+        .desc   = {                                                     \
+                .name   = #_id,                                         \
+                .ops    = &da9034_regulator_dvc_ops,                    \
+                .type   = REGULATOR_VOLTAGE,                            \
+                .id     = DA9034_ID_##_id,                              \
+                .owner  = THIS_MODULE,                                  \
+        },                                                              \
+        .min_uV         = (min) * 1000,                                 \
+        .max_uV         = (max) * 1000,                                 \
+        .step_uV        = (step) * 1000,                                \
+        .vol_reg        = DA9034_##vreg,                                \
+        .vol_shift      = (0),                                          \
+        .vol_nbits      = (nbits),                                      \
+        .update_reg     = DA9034_##ureg,                                \
+        .update_bit     = (ubit),                                       \
+        .enable_reg     = DA9034_##ereg,                                \
+        .enable_bit     = (ebit),                                       \
+}
+
+#define DA9034_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
+        DA903x_LDO(DA9034, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
+
+#define DA9030_LDO(_id, min, max, step, vreg, shift, nbits, ereg, ebit) \
+        DA903x_LDO(DA9030, _id, min, max, step, vreg, shift, nbits, ereg, ebit)
+
+static struct da903x_regulator_info da903x_regulator_info[] = {
+        /* DA9030 */
+        DA9030_LDO( 1, 1200, 3200, 100,    LDO1, 0, 5, RCTL12, 1),
+        DA9030_LDO( 2, 1800, 3200, 100,   LDO23, 0, 4, RCTL12, 2),
+        DA9030_LDO( 3, 1800, 3200, 100,   LDO23, 4, 4, RCTL12, 3),
+        DA9030_LDO( 4, 1800, 3200, 100,   LDO45, 0, 4, RCTL12, 4),
+        DA9030_LDO( 5, 1800, 3200, 100,   LDO45, 4, 4, RCTL12, 5),
+        DA9030_LDO( 6, 1800, 3200, 100,    LDO6, 0, 4, RCTL12, 6),
+        DA9030_LDO( 7, 1800, 3200, 100,   LDO78, 0, 4, RCTL12, 7),
+        DA9030_LDO( 8, 1800, 3200, 100,   LDO78, 4, 4, RCTL22, 0),
+        DA9030_LDO( 9, 1800, 3200, 100,  LDO912, 0, 4, RCTL22, 1),
+        DA9030_LDO(10, 1800, 3200, 100, LDO1011, 0, 4, RCTL22, 2),
+        DA9030_LDO(11, 1800, 3200, 100, LDO1011, 4, 4, RCTL22, 3),
+        DA9030_LDO(12, 1800, 3200, 100,  LDO912, 4, 4, RCTL22, 4),
+        DA9030_LDO(14, 2760, 2940,  30, LDO1416, 0, 3, RCTL11, 4),
+        DA9030_LDO(15, 1100, 2650,  50,   LDO15, 0, 5, RCTL11, 5),
+        DA9030_LDO(16, 1100, 2650,  50, LDO1416, 3, 5, RCTL11, 6),
+        DA9030_LDO(17, 1800, 3200, 100,   LDO17, 0, 4, RCTL11, 7),
+        DA9030_LDO(18, 1800, 3200, 100, LDO1819, 0, 4, RCTL21, 2),
+        DA9030_LDO(19, 1800, 3200, 100, LDO1819, 4, 4, RCTL21, 1),
+        DA9030_LDO(13, 2100, 2100, 0, INVAL, 0, 0, RCTL11, 3), /* fixed @2.1V */
+
+        /* DA9034 */
+        DA9034_DVC(BUCK1, 725, 1500, 25, ADTV1, 5, VCC1, 0, OVER1, 0),
+        DA9034_DVC(BUCK2, 725, 1500, 25, CDTV1, 5, VCC1, 2, OVER1, 1),
+        DA9034_DVC(LDO2,  725, 1500, 25, SDTV1, 5, VCC1, 4, OVER1, 2),
+        DA9034_DVC(LDO1, 1700, 2075, 25, MDTV1, 4, VCC1, 6, OVER3, 4),
+
+        DA9034_LDO( 3, 1800, 3300, 100,  LDO643, 0, 4, OVER3, 5),
+        DA9034_LDO( 4, 1800, 2900,1100,  LDO643, 4, 1, OVER3, 6),
+        DA9034_LDO( 6, 2500, 2850,  50,  LDO643, 5, 3, OVER2, 0),
+        DA9034_LDO( 7, 2700, 3050,  50,  LDO987, 0, 3, OVER2, 1),
+        DA9034_LDO( 8, 2700, 2850,  50,  LDO987, 3, 2, OVER2, 2),
+        DA9034_LDO( 9, 2700, 3050,  50,  LDO987, 5, 3, OVER2, 3),
+        DA9034_LDO(10, 2700, 3050,  50, LDO1110, 0, 3, OVER2, 4),
+        DA9034_LDO(11, 1800, 3300, 100, LDO1110, 4, 4, OVER2, 5),
+        DA9034_LDO(12, 1700, 3050,  50, LDO1312, 0, 4, OVER3, 6),
+        DA9034_LDO(13, 1800, 3300, 100, LDO1312, 4, 4, OVER2, 7),
+        DA9034_LDO(14, 1800, 3300, 100, LDO1514, 0, 4, OVER3, 0),
+        DA9034_LDO(15, 1800, 3300, 100, LDO1514, 4, 4, OVER3, 1),
+        DA9034_LDO(5, 3100, 3100, 0, INVAL, 0, 0, OVER3, 7), /* fixed @3.1V */
+};
+
+static inline struct da903x_regulator_info *find_regulator_info(int id)
+{
+        struct da903x_regulator_info *ri;
+        int i;
+
+        for (i = 0; i < ARRAY_SIZE(da903x_regulator_info); i++) {
+                ri = &da903x_regulator_info[i];
+                if (ri->desc.id == id)
+                        return ri;
+        }
+        return NULL;
+}
+
+static int __devinit da903x_regulator_probe(struct platform_device *pdev)
+{
+        struct da903x_regulator_info *ri = NULL;
+        struct regulator_dev *rdev;
+
+        ri = find_regulator_info(pdev->id);
+        if (ri == NULL) {
+                dev_err(&pdev->dev, "invalid regulator ID specified\n");
+                return -EINVAL;
+        }
+
+        /* Workaround for the weird LDO12 voltage setting */
+        if (ri->desc.id == DA9034_ID_LDO12)
+                ri->desc.ops = &da9034_regulator_ldo12_ops;
+
+        if (ri->desc.id == DA9030_ID_LDO14)
+                ri->desc.ops = &da9030_regulator_ldo14_ops;
+
+        if (ri->desc.id == DA9030_ID_LDO1 || ri->desc.id == DA9030_ID_LDO15)
+                ri->desc.ops = &da9030_regulator_ldo1_15_ops;
+
+        rdev = regulator_register(&ri->desc, pdev->dev.parent, ri);
+        if (IS_ERR(rdev)) {
+                dev_err(&pdev->dev, "failed to register regulator %s\n",
+                                ri->desc.name);
+                return PTR_ERR(rdev);
+        }
+
+        platform_set_drvdata(pdev, rdev);
+        return 0;
+}
+
+static int __devexit da903x_regulator_remove(struct platform_device *pdev)
+{
+        struct regulator_dev *rdev = platform_get_drvdata(pdev);
+
+        regulator_unregister(rdev);
+        return 0;
+}
+
+static struct platform_driver da903x_regulator_driver = {
+        .driver = {
+                .name   = "da903x-regulator",
+                .owner  = THIS_MODULE,
+        },
+        .probe          = da903x_regulator_probe,
+        .remove         = da903x_regulator_remove,
+};
+
+static int __init da903x_regulator_init(void)
+{
+        return platform_driver_register(&da903x_regulator_driver);
+}
+module_init(da903x_regulator_init);
+
+static void __exit da903x_regulator_exit(void)
+{
+        platform_driver_unregister(&da903x_regulator_driver);
+}
+module_exit(da903x_regulator_exit);
+
+MODULE_LICENSE("GPL");
+MODULE_AUTHOR("Eric Miao <eric.miao@marvell.com>"
+              "Mike Rapoport <mike@compulab.co.il>");
+MODULE_DESCRIPTION("Regulator Driver for Dialog Semiconductor DA903X PMIC");
+MODULE_ALIAS("platform:da903x-regulator");