| /* | |
| * drivers/regulator/ab3100.c | |
| * | |
| * Copyright (C) 2008-2009 ST-Ericsson AB | |
| * License terms: GNU General Public License (GPL) version 2 | |
| * Low-level control of the AB3100 IC Low Dropout (LDO) | |
| * regulators, external regulator and buck converter | |
| * Author: Mattias Wallin <mattias.wallin@stericsson.com> | |
| * Author: Linus Walleij <linus.walleij@stericsson.com> | |
| */ | |
| #include <linux/module.h> | |
| #include <linux/kernel.h> | |
| #include <linux/init.h> | |
| #include <linux/err.h> | |
| #include <linux/platform_device.h> | |
| #include <linux/regulator/driver.h> | |
| #include <linux/mfd/ab3100.h> | |
| #include <linux/mfd/abx500.h> | |
| #include <linux/of.h> | |
| #include <linux/regulator/of_regulator.h> | |
| /* LDO registers and some handy masking definitions for AB3100 */ | |
| #define AB3100_LDO_A 0x40 | |
| #define AB3100_LDO_C 0x41 | |
| #define AB3100_LDO_D 0x42 | |
| #define AB3100_LDO_E 0x43 | |
| #define AB3100_LDO_E_SLEEP 0x44 | |
| #define AB3100_LDO_F 0x45 | |
| #define AB3100_LDO_G 0x46 | |
| #define AB3100_LDO_H 0x47 | |
| #define AB3100_LDO_H_SLEEP_MODE 0 | |
| #define AB3100_LDO_H_SLEEP_EN 2 | |
| #define AB3100_LDO_ON 4 | |
| #define AB3100_LDO_H_VSEL_AC 5 | |
| #define AB3100_LDO_K 0x48 | |
| #define AB3100_LDO_EXT 0x49 | |
| #define AB3100_BUCK 0x4A | |
| #define AB3100_BUCK_SLEEP 0x4B | |
| #define AB3100_REG_ON_MASK 0x10 | |
| /** | |
| * struct ab3100_regulator | |
| * A struct passed around the individual regulator functions | |
| * @platform_device: platform device holding this regulator | |
| * @dev: handle to the device | |
| * @plfdata: AB3100 platform data passed in at probe time | |
| * @regreg: regulator register number in the AB3100 | |
| */ | |
| struct ab3100_regulator { | |
| struct regulator_dev *rdev; | |
| struct device *dev; | |
| struct ab3100_platform_data *plfdata; | |
| u8 regreg; | |
| }; | |
| /* The order in which registers are initialized */ | |
| static const u8 ab3100_reg_init_order[AB3100_NUM_REGULATORS+2] = { | |
| AB3100_LDO_A, | |
| AB3100_LDO_C, | |
| AB3100_LDO_E, | |
| AB3100_LDO_E_SLEEP, | |
| AB3100_LDO_F, | |
| AB3100_LDO_G, | |
| AB3100_LDO_H, | |
| AB3100_LDO_K, | |
| AB3100_LDO_EXT, | |
| AB3100_BUCK, | |
| AB3100_BUCK_SLEEP, | |
| AB3100_LDO_D, | |
| }; | |
| /* Preset (hardware defined) voltages for these regulators */ | |
| #define LDO_A_VOLTAGE 2750000 | |
| #define LDO_C_VOLTAGE 2650000 | |
| #define LDO_D_VOLTAGE 2650000 | |
| static const unsigned int ldo_e_buck_typ_voltages[] = { | |
| 1800000, | |
| 1400000, | |
| 1300000, | |
| 1200000, | |
| 1100000, | |
| 1050000, | |
| 900000, | |
| }; | |
| static const unsigned int ldo_f_typ_voltages[] = { | |
| 1800000, | |
| 1400000, | |
| 1300000, | |
| 1200000, | |
| 1100000, | |
| 1050000, | |
| 2500000, | |
| 2650000, | |
| }; | |
| static const unsigned int ldo_g_typ_voltages[] = { | |
| 2850000, | |
| 2750000, | |
| 1800000, | |
| 1500000, | |
| }; | |
| static const unsigned int ldo_h_typ_voltages[] = { | |
| 2750000, | |
| 1800000, | |
| 1500000, | |
| 1200000, | |
| }; | |
| static const unsigned int ldo_k_typ_voltages[] = { | |
| 2750000, | |
| 1800000, | |
| }; | |
| /* The regulator devices */ | |
| static struct ab3100_regulator | |
| ab3100_regulators[AB3100_NUM_REGULATORS] = { | |
| { | |
| .regreg = AB3100_LDO_A, | |
| }, | |
| { | |
| .regreg = AB3100_LDO_C, | |
| }, | |
| { | |
| .regreg = AB3100_LDO_D, | |
| }, | |
| { | |
| .regreg = AB3100_LDO_E, | |
| }, | |
| { | |
| .regreg = AB3100_LDO_F, | |
| }, | |
| { | |
| .regreg = AB3100_LDO_G, | |
| }, | |
| { | |
| .regreg = AB3100_LDO_H, | |
| }, | |
| { | |
| .regreg = AB3100_LDO_K, | |
| }, | |
| { | |
| .regreg = AB3100_LDO_EXT, | |
| /* No voltages for the external regulator */ | |
| }, | |
| { | |
| .regreg = AB3100_BUCK, | |
| }, | |
| }; | |
| /* | |
| * General functions for enable, disable and is_enabled used for | |
| * LDO: A,C,E,F,G,H,K,EXT and BUCK | |
| */ | |
| static int ab3100_enable_regulator(struct regulator_dev *reg) | |
| { | |
| struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | |
| int err; | |
| u8 regval; | |
| err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg, | |
| ®val); | |
| if (err) { | |
| dev_warn(®->dev, "failed to get regid %d value\n", | |
| abreg->regreg); | |
| return err; | |
| } | |
| /* The regulator is already on, no reason to go further */ | |
| if (regval & AB3100_REG_ON_MASK) | |
| return 0; | |
| regval |= AB3100_REG_ON_MASK; | |
| err = abx500_set_register_interruptible(abreg->dev, 0, abreg->regreg, | |
| regval); | |
| if (err) { | |
| dev_warn(®->dev, "failed to set regid %d value\n", | |
| abreg->regreg); | |
| return err; | |
| } | |
| return 0; | |
| } | |
| static int ab3100_disable_regulator(struct regulator_dev *reg) | |
| { | |
| struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | |
| int err; | |
| u8 regval; | |
| /* | |
| * LDO D is a special regulator. When it is disabled, the entire | |
| * system is shut down. So this is handled specially. | |
| */ | |
| pr_info("Called ab3100_disable_regulator\n"); | |
| if (abreg->regreg == AB3100_LDO_D) { | |
| dev_info(®->dev, "disabling LDO D - shut down system\n"); | |
| /* Setting LDO D to 0x00 cuts the power to the SoC */ | |
| return abx500_set_register_interruptible(abreg->dev, 0, | |
| AB3100_LDO_D, 0x00U); | |
| } | |
| /* | |
| * All other regulators are handled here | |
| */ | |
| err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg, | |
| ®val); | |
| if (err) { | |
| dev_err(®->dev, "unable to get register 0x%x\n", | |
| abreg->regreg); | |
| return err; | |
| } | |
| regval &= ~AB3100_REG_ON_MASK; | |
| return abx500_set_register_interruptible(abreg->dev, 0, abreg->regreg, | |
| regval); | |
| } | |
| static int ab3100_is_enabled_regulator(struct regulator_dev *reg) | |
| { | |
| struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | |
| u8 regval; | |
| int err; | |
| err = abx500_get_register_interruptible(abreg->dev, 0, abreg->regreg, | |
| ®val); | |
| if (err) { | |
| dev_err(®->dev, "unable to get register 0x%x\n", | |
| abreg->regreg); | |
| return err; | |
| } | |
| return regval & AB3100_REG_ON_MASK; | |
| } | |
| static int ab3100_get_voltage_regulator(struct regulator_dev *reg) | |
| { | |
| struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | |
| u8 regval; | |
| int err; | |
| /* | |
| * For variable types, read out setting and index into | |
| * supplied voltage list. | |
| */ | |
| err = abx500_get_register_interruptible(abreg->dev, 0, | |
| abreg->regreg, ®val); | |
| if (err) { | |
| dev_warn(®->dev, | |
| "failed to get regulator value in register %02x\n", | |
| abreg->regreg); | |
| return err; | |
| } | |
| /* The 3 highest bits index voltages */ | |
| regval &= 0xE0; | |
| regval >>= 5; | |
| if (regval >= reg->desc->n_voltages) { | |
| dev_err(®->dev, | |
| "regulator register %02x contains an illegal voltage setting\n", | |
| abreg->regreg); | |
| return -EINVAL; | |
| } | |
| return reg->desc->volt_table[regval]; | |
| } | |
| static int ab3100_set_voltage_regulator_sel(struct regulator_dev *reg, | |
| unsigned selector) | |
| { | |
| struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | |
| u8 regval; | |
| int err; | |
| err = abx500_get_register_interruptible(abreg->dev, 0, | |
| abreg->regreg, ®val); | |
| if (err) { | |
| dev_warn(®->dev, | |
| "failed to get regulator register %02x\n", | |
| abreg->regreg); | |
| return err; | |
| } | |
| /* The highest three bits control the variable regulators */ | |
| regval &= ~0xE0; | |
| regval |= (selector << 5); | |
| err = abx500_set_register_interruptible(abreg->dev, 0, | |
| abreg->regreg, regval); | |
| if (err) | |
| dev_warn(®->dev, "failed to set regulator register %02x\n", | |
| abreg->regreg); | |
| return err; | |
| } | |
| static int ab3100_set_suspend_voltage_regulator(struct regulator_dev *reg, | |
| int uV) | |
| { | |
| struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | |
| u8 regval; | |
| int err; | |
| int bestindex; | |
| u8 targetreg; | |
| if (abreg->regreg == AB3100_LDO_E) | |
| targetreg = AB3100_LDO_E_SLEEP; | |
| else if (abreg->regreg == AB3100_BUCK) | |
| targetreg = AB3100_BUCK_SLEEP; | |
| else | |
| return -EINVAL; | |
| /* LDO E and BUCK have special suspend voltages you can set */ | |
| bestindex = regulator_map_voltage_iterate(reg, uV, uV); | |
| err = abx500_get_register_interruptible(abreg->dev, 0, | |
| targetreg, ®val); | |
| if (err) { | |
| dev_warn(®->dev, | |
| "failed to get regulator register %02x\n", | |
| targetreg); | |
| return err; | |
| } | |
| /* The highest three bits control the variable regulators */ | |
| regval &= ~0xE0; | |
| regval |= (bestindex << 5); | |
| err = abx500_set_register_interruptible(abreg->dev, 0, | |
| targetreg, regval); | |
| if (err) | |
| dev_warn(®->dev, "failed to set regulator register %02x\n", | |
| abreg->regreg); | |
| return err; | |
| } | |
| /* | |
| * The external regulator can just define a fixed voltage. | |
| */ | |
| static int ab3100_get_voltage_regulator_external(struct regulator_dev *reg) | |
| { | |
| struct ab3100_regulator *abreg = rdev_get_drvdata(reg); | |
| if (abreg->plfdata) | |
| return abreg->plfdata->external_voltage; | |
| else | |
| /* TODO: encode external voltage into device tree */ | |
| return 0; | |
| } | |
| static struct regulator_ops regulator_ops_fixed = { | |
| .list_voltage = regulator_list_voltage_linear, | |
| .enable = ab3100_enable_regulator, | |
| .disable = ab3100_disable_regulator, | |
| .is_enabled = ab3100_is_enabled_regulator, | |
| }; | |
| static struct regulator_ops regulator_ops_variable = { | |
| .enable = ab3100_enable_regulator, | |
| .disable = ab3100_disable_regulator, | |
| .is_enabled = ab3100_is_enabled_regulator, | |
| .get_voltage = ab3100_get_voltage_regulator, | |
| .set_voltage_sel = ab3100_set_voltage_regulator_sel, | |
| .list_voltage = regulator_list_voltage_table, | |
| }; | |
| static struct regulator_ops regulator_ops_variable_sleepable = { | |
| .enable = ab3100_enable_regulator, | |
| .disable = ab3100_disable_regulator, | |
| .is_enabled = ab3100_is_enabled_regulator, | |
| .get_voltage = ab3100_get_voltage_regulator, | |
| .set_voltage_sel = ab3100_set_voltage_regulator_sel, | |
| .set_suspend_voltage = ab3100_set_suspend_voltage_regulator, | |
| .list_voltage = regulator_list_voltage_table, | |
| }; | |
| /* | |
| * LDO EXT is an external regulator so it is really | |
| * not possible to set any voltage locally here, AB3100 | |
| * is an on/off switch plain an simple. The external | |
| * voltage is defined in the board set-up if any. | |
| */ | |
| static struct regulator_ops regulator_ops_external = { | |
| .enable = ab3100_enable_regulator, | |
| .disable = ab3100_disable_regulator, | |
| .is_enabled = ab3100_is_enabled_regulator, | |
| .get_voltage = ab3100_get_voltage_regulator_external, | |
| }; | |
| static struct regulator_desc | |
| ab3100_regulator_desc[AB3100_NUM_REGULATORS] = { | |
| { | |
| .name = "LDO_A", | |
| .id = AB3100_LDO_A, | |
| .ops = ®ulator_ops_fixed, | |
| .n_voltages = 1, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .min_uV = LDO_A_VOLTAGE, | |
| .enable_time = 200, | |
| }, | |
| { | |
| .name = "LDO_C", | |
| .id = AB3100_LDO_C, | |
| .ops = ®ulator_ops_fixed, | |
| .n_voltages = 1, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .min_uV = LDO_C_VOLTAGE, | |
| .enable_time = 200, | |
| }, | |
| { | |
| .name = "LDO_D", | |
| .id = AB3100_LDO_D, | |
| .ops = ®ulator_ops_fixed, | |
| .n_voltages = 1, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .min_uV = LDO_D_VOLTAGE, | |
| .enable_time = 200, | |
| }, | |
| { | |
| .name = "LDO_E", | |
| .id = AB3100_LDO_E, | |
| .ops = ®ulator_ops_variable_sleepable, | |
| .n_voltages = ARRAY_SIZE(ldo_e_buck_typ_voltages), | |
| .volt_table = ldo_e_buck_typ_voltages, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .enable_time = 200, | |
| }, | |
| { | |
| .name = "LDO_F", | |
| .id = AB3100_LDO_F, | |
| .ops = ®ulator_ops_variable, | |
| .n_voltages = ARRAY_SIZE(ldo_f_typ_voltages), | |
| .volt_table = ldo_f_typ_voltages, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .enable_time = 600, | |
| }, | |
| { | |
| .name = "LDO_G", | |
| .id = AB3100_LDO_G, | |
| .ops = ®ulator_ops_variable, | |
| .n_voltages = ARRAY_SIZE(ldo_g_typ_voltages), | |
| .volt_table = ldo_g_typ_voltages, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .enable_time = 400, | |
| }, | |
| { | |
| .name = "LDO_H", | |
| .id = AB3100_LDO_H, | |
| .ops = ®ulator_ops_variable, | |
| .n_voltages = ARRAY_SIZE(ldo_h_typ_voltages), | |
| .volt_table = ldo_h_typ_voltages, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .enable_time = 200, | |
| }, | |
| { | |
| .name = "LDO_K", | |
| .id = AB3100_LDO_K, | |
| .ops = ®ulator_ops_variable, | |
| .n_voltages = ARRAY_SIZE(ldo_k_typ_voltages), | |
| .volt_table = ldo_k_typ_voltages, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .enable_time = 200, | |
| }, | |
| { | |
| .name = "LDO_EXT", | |
| .id = AB3100_LDO_EXT, | |
| .ops = ®ulator_ops_external, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| }, | |
| { | |
| .name = "BUCK", | |
| .id = AB3100_BUCK, | |
| .ops = ®ulator_ops_variable_sleepable, | |
| .n_voltages = ARRAY_SIZE(ldo_e_buck_typ_voltages), | |
| .volt_table = ldo_e_buck_typ_voltages, | |
| .type = REGULATOR_VOLTAGE, | |
| .owner = THIS_MODULE, | |
| .enable_time = 1000, | |
| }, | |
| }; | |
| static int ab3100_regulator_register(struct platform_device *pdev, | |
| struct ab3100_platform_data *plfdata, | |
| struct regulator_init_data *init_data, | |
| struct device_node *np, | |
| unsigned long id) | |
| { | |
| struct regulator_desc *desc; | |
| struct ab3100_regulator *reg; | |
| struct regulator_dev *rdev; | |
| struct regulator_config config = { }; | |
| int err, i; | |
| for (i = 0; i < AB3100_NUM_REGULATORS; i++) { | |
| desc = &ab3100_regulator_desc[i]; | |
| if (desc->id == id) | |
| break; | |
| } | |
| if (desc->id != id) | |
| return -ENODEV; | |
| /* Same index used for this array */ | |
| reg = &ab3100_regulators[i]; | |
| /* | |
| * Initialize per-regulator struct. | |
| * Inherit platform data, this comes down from the | |
| * i2c boarddata, from the machine. So if you want to | |
| * see what it looks like for a certain machine, go | |
| * into the machine I2C setup. | |
| */ | |
| reg->dev = &pdev->dev; | |
| if (plfdata) { | |
| reg->plfdata = plfdata; | |
| config.init_data = &plfdata->reg_constraints[i]; | |
| } else if (np) { | |
| config.of_node = np; | |
| config.init_data = init_data; | |
| } | |
| config.dev = &pdev->dev; | |
| config.driver_data = reg; | |
| rdev = devm_regulator_register(&pdev->dev, desc, &config); | |
| if (IS_ERR(rdev)) { | |
| err = PTR_ERR(rdev); | |
| dev_err(&pdev->dev, | |
| "%s: failed to register regulator %s err %d\n", | |
| __func__, desc->name, | |
| err); | |
| return err; | |
| } | |
| /* Then set a pointer back to the registered regulator */ | |
| reg->rdev = rdev; | |
| return 0; | |
| } | |
| static struct of_regulator_match ab3100_regulator_matches[] = { | |
| { .name = "ab3100_ldo_a", .driver_data = (void *) AB3100_LDO_A, }, | |
| { .name = "ab3100_ldo_c", .driver_data = (void *) AB3100_LDO_C, }, | |
| { .name = "ab3100_ldo_d", .driver_data = (void *) AB3100_LDO_D, }, | |
| { .name = "ab3100_ldo_e", .driver_data = (void *) AB3100_LDO_E, }, | |
| { .name = "ab3100_ldo_f", .driver_data = (void *) AB3100_LDO_F }, | |
| { .name = "ab3100_ldo_g", .driver_data = (void *) AB3100_LDO_G }, | |
| { .name = "ab3100_ldo_h", .driver_data = (void *) AB3100_LDO_H }, | |
| { .name = "ab3100_ldo_k", .driver_data = (void *) AB3100_LDO_K }, | |
| { .name = "ab3100_ext", .driver_data = (void *) AB3100_LDO_EXT }, | |
| { .name = "ab3100_buck", .driver_data = (void *) AB3100_BUCK }, | |
| }; | |
| /* | |
| * Initial settings of ab3100 registers. | |
| * Common for below LDO regulator settings are that | |
| * bit 7-5 controls voltage. Bit 4 turns regulator ON(1) or OFF(0). | |
| * Bit 3-2 controls sleep enable and bit 1-0 controls sleep mode. | |
| */ | |
| /* LDO_A 0x16: 2.75V, ON, SLEEP_A, SLEEP OFF GND */ | |
| #define LDO_A_SETTING 0x16 | |
| /* LDO_C 0x10: 2.65V, ON, SLEEP_A or B, SLEEP full power */ | |
| #define LDO_C_SETTING 0x10 | |
| /* LDO_D 0x10: 2.65V, ON, sleep mode not used */ | |
| #define LDO_D_SETTING 0x10 | |
| /* LDO_E 0x10: 1.8V, ON, SLEEP_A or B, SLEEP full power */ | |
| #define LDO_E_SETTING 0x10 | |
| /* LDO_E SLEEP 0x00: 1.8V, not used, SLEEP_A or B, not used */ | |
| #define LDO_E_SLEEP_SETTING 0x00 | |
| /* LDO_F 0xD0: 2.5V, ON, SLEEP_A or B, SLEEP full power */ | |
| #define LDO_F_SETTING 0xD0 | |
| /* LDO_G 0x00: 2.85V, OFF, SLEEP_A or B, SLEEP full power */ | |
| #define LDO_G_SETTING 0x00 | |
| /* LDO_H 0x18: 2.75V, ON, SLEEP_B, SLEEP full power */ | |
| #define LDO_H_SETTING 0x18 | |
| /* LDO_K 0x00: 2.75V, OFF, SLEEP_A or B, SLEEP full power */ | |
| #define LDO_K_SETTING 0x00 | |
| /* LDO_EXT 0x00: Voltage not set, OFF, not used, not used */ | |
| #define LDO_EXT_SETTING 0x00 | |
| /* BUCK 0x7D: 1.2V, ON, SLEEP_A and B, SLEEP low power */ | |
| #define BUCK_SETTING 0x7D | |
| /* BUCK SLEEP 0xAC: 1.05V, Not used, SLEEP_A and B, Not used */ | |
| #define BUCK_SLEEP_SETTING 0xAC | |
| static const u8 ab3100_reg_initvals[] = { | |
| LDO_A_SETTING, | |
| LDO_C_SETTING, | |
| LDO_E_SETTING, | |
| LDO_E_SLEEP_SETTING, | |
| LDO_F_SETTING, | |
| LDO_G_SETTING, | |
| LDO_H_SETTING, | |
| LDO_K_SETTING, | |
| LDO_EXT_SETTING, | |
| BUCK_SETTING, | |
| BUCK_SLEEP_SETTING, | |
| LDO_D_SETTING, | |
| }; | |
| static int ab3100_regulators_remove(struct platform_device *pdev) | |
| { | |
| int i; | |
| for (i = 0; i < AB3100_NUM_REGULATORS; i++) { | |
| struct ab3100_regulator *reg = &ab3100_regulators[i]; | |
| reg->rdev = NULL; | |
| } | |
| return 0; | |
| } | |
| static int | |
| ab3100_regulator_of_probe(struct platform_device *pdev, struct device_node *np) | |
| { | |
| int err, i; | |
| /* | |
| * Set up the regulator registers, as was previously done with | |
| * platform data. | |
| */ | |
| /* Set up regulators */ | |
| for (i = 0; i < ARRAY_SIZE(ab3100_reg_init_order); i++) { | |
| err = abx500_set_register_interruptible(&pdev->dev, 0, | |
| ab3100_reg_init_order[i], | |
| ab3100_reg_initvals[i]); | |
| if (err) { | |
| dev_err(&pdev->dev, "regulator initialization failed with error %d\n", | |
| err); | |
| return err; | |
| } | |
| } | |
| for (i = 0; i < ARRAY_SIZE(ab3100_regulator_matches); i++) { | |
| err = ab3100_regulator_register( | |
| pdev, NULL, ab3100_regulator_matches[i].init_data, | |
| ab3100_regulator_matches[i].of_node, | |
| (unsigned long)ab3100_regulator_matches[i].driver_data); | |
| if (err) { | |
| ab3100_regulators_remove(pdev); | |
| return err; | |
| } | |
| } | |
| return 0; | |
| } | |
| static int ab3100_regulators_probe(struct platform_device *pdev) | |
| { | |
| struct ab3100_platform_data *plfdata = dev_get_platdata(&pdev->dev); | |
| struct device_node *np = pdev->dev.of_node; | |
| int err = 0; | |
| u8 data; | |
| int i; | |
| /* Check chip state */ | |
| err = abx500_get_register_interruptible(&pdev->dev, 0, | |
| AB3100_LDO_D, &data); | |
| if (err) { | |
| dev_err(&pdev->dev, "could not read initial status of LDO_D\n"); | |
| return err; | |
| } | |
| if (data & 0x10) | |
| dev_notice(&pdev->dev, | |
| "chip is already in active mode (Warm start)\n"); | |
| else | |
| dev_notice(&pdev->dev, | |
| "chip is in inactive mode (Cold start)\n"); | |
| if (np) { | |
| err = of_regulator_match(&pdev->dev, np, | |
| ab3100_regulator_matches, | |
| ARRAY_SIZE(ab3100_regulator_matches)); | |
| if (err < 0) { | |
| dev_err(&pdev->dev, | |
| "Error parsing regulator init data: %d\n", err); | |
| return err; | |
| } | |
| return ab3100_regulator_of_probe(pdev, np); | |
| } | |
| /* Set up regulators */ | |
| for (i = 0; i < ARRAY_SIZE(ab3100_reg_init_order); i++) { | |
| err = abx500_set_register_interruptible(&pdev->dev, 0, | |
| ab3100_reg_init_order[i], | |
| plfdata->reg_initvals[i]); | |
| if (err) { | |
| dev_err(&pdev->dev, "regulator initialization failed with error %d\n", | |
| err); | |
| return err; | |
| } | |
| } | |
| /* Register the regulators */ | |
| for (i = 0; i < AB3100_NUM_REGULATORS; i++) { | |
| struct regulator_desc *desc = &ab3100_regulator_desc[i]; | |
| err = ab3100_regulator_register(pdev, plfdata, NULL, NULL, | |
| desc->id); | |
| if (err) { | |
| ab3100_regulators_remove(pdev); | |
| return err; | |
| } | |
| } | |
| return 0; | |
| } | |
| static struct platform_driver ab3100_regulators_driver = { | |
| .driver = { | |
| .name = "ab3100-regulators", | |
| }, | |
| .probe = ab3100_regulators_probe, | |
| .remove = ab3100_regulators_remove, | |
| }; | |
| static __init int ab3100_regulators_init(void) | |
| { | |
| return platform_driver_register(&ab3100_regulators_driver); | |
| } | |
| static __exit void ab3100_regulators_exit(void) | |
| { | |
| platform_driver_unregister(&ab3100_regulators_driver); | |
| } | |
| subsys_initcall(ab3100_regulators_init); | |
| module_exit(ab3100_regulators_exit); | |
| MODULE_AUTHOR("Mattias Wallin <mattias.wallin@stericsson.com>"); | |
| MODULE_DESCRIPTION("AB3100 Regulator driver"); | |
| MODULE_LICENSE("GPL"); | |
| MODULE_ALIAS("platform:ab3100-regulators"); |