| /* |
| * Copyright (C) ST-Ericsson SA 2010 |
| * |
| * License Terms: GNU General Public License v2 |
| * |
| * Authors: Bengt Jonsson <bengt.g.jonsson@stericsson.com> |
| * |
| * This file is based on drivers/regulator/ab8500.c |
| * |
| * AB8500 external regulators |
| * |
| * ab8500-ext supports the following regulators: |
| * - VextSupply3 |
| */ |
| #include <linux/init.h> |
| #include <linux/kernel.h> |
| #include <linux/err.h> |
| #include <linux/module.h> |
| #include <linux/platform_device.h> |
| #include <linux/regulator/driver.h> |
| #include <linux/regulator/machine.h> |
| #include <linux/mfd/abx500.h> |
| #include <linux/mfd/abx500/ab8500.h> |
| #include <linux/regulator/ab8500.h> |
| |
| /** |
| * struct ab8500_ext_regulator_info - ab8500 regulator information |
| * @dev: device pointer |
| * @desc: regulator description |
| * @rdev: regulator device |
| * @cfg: regulator configuration (extension of regulator FW configuration) |
| * @update_bank: bank to control on/off |
| * @update_reg: register to control on/off |
| * @update_mask: mask to enable/disable and set mode of regulator |
| * @update_val: bits holding the regulator current mode |
| * @update_val_hp: bits to set EN pin active (LPn pin deactive) |
| * normally this means high power mode |
| * @update_val_lp: bits to set EN pin active and LPn pin active |
| * normally this means low power mode |
| * @update_val_hw: bits to set regulator pins in HW control |
| * SysClkReq pins and logic will choose mode |
| */ |
| struct ab8500_ext_regulator_info { |
| struct device *dev; |
| struct regulator_desc desc; |
| struct regulator_dev *rdev; |
| struct ab8500_ext_regulator_cfg *cfg; |
| u8 update_bank; |
| u8 update_reg; |
| u8 update_mask; |
| u8 update_val; |
| u8 update_val_hp; |
| u8 update_val_lp; |
| u8 update_val_hw; |
| }; |
| |
| static int ab8500_ext_regulator_enable(struct regulator_dev *rdev) |
| { |
| int ret; |
| struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev); |
| u8 regval; |
| |
| if (info == NULL) { |
| dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); |
| return -EINVAL; |
| } |
| |
| /* |
| * To satisfy both HW high power request and SW request, the regulator |
| * must be on in high power. |
| */ |
| if (info->cfg && info->cfg->hwreq) |
| regval = info->update_val_hp; |
| else |
| regval = info->update_val; |
| |
| ret = abx500_mask_and_set_register_interruptible(info->dev, |
| info->update_bank, info->update_reg, |
| info->update_mask, regval); |
| if (ret < 0) { |
| dev_err(rdev_get_dev(info->rdev), |
| "couldn't set enable bits for regulator\n"); |
| return ret; |
| } |
| |
| dev_dbg(rdev_get_dev(rdev), |
| "%s-enable (bank, reg, mask, value): 0x%02x, 0x%02x, 0x%02x, 0x%02x\n", |
| info->desc.name, info->update_bank, info->update_reg, |
| info->update_mask, regval); |
| |
| return 0; |
| } |
| |
| static int ab8500_ext_regulator_disable(struct regulator_dev *rdev) |
| { |
| int ret; |
| struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev); |
| u8 regval; |
| |
| if (info == NULL) { |
| dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); |
| return -EINVAL; |
| } |
| |
| /* |
| * Set the regulator in HW request mode if configured |
| */ |
| if (info->cfg && info->cfg->hwreq) |
| regval = info->update_val_hw; |
| else |
| regval = 0; |
| |
| ret = abx500_mask_and_set_register_interruptible(info->dev, |
| info->update_bank, info->update_reg, |
| info->update_mask, regval); |
| if (ret < 0) { |
| dev_err(rdev_get_dev(info->rdev), |
| "couldn't set disable bits for regulator\n"); |
| return ret; |
| } |
| |
| dev_dbg(rdev_get_dev(rdev), "%s-disable (bank, reg, mask, value):" |
| " 0x%02x, 0x%02x, 0x%02x, 0x%02x\n", |
| info->desc.name, info->update_bank, info->update_reg, |
| info->update_mask, regval); |
| |
| return 0; |
| } |
| |
| static int ab8500_ext_regulator_is_enabled(struct regulator_dev *rdev) |
| { |
| int ret; |
| struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev); |
| u8 regval; |
| |
| if (info == NULL) { |
| dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); |
| return -EINVAL; |
| } |
| |
| ret = abx500_get_register_interruptible(info->dev, |
| info->update_bank, info->update_reg, ®val); |
| if (ret < 0) { |
| dev_err(rdev_get_dev(rdev), |
| "couldn't read 0x%x register\n", info->update_reg); |
| return ret; |
| } |
| |
| dev_dbg(rdev_get_dev(rdev), "%s-is_enabled (bank, reg, mask, value):" |
| " 0x%02x, 0x%02x, 0x%02x, 0x%02x\n", |
| info->desc.name, info->update_bank, info->update_reg, |
| info->update_mask, regval); |
| |
| if (((regval & info->update_mask) == info->update_val_lp) || |
| ((regval & info->update_mask) == info->update_val_hp)) |
| return 1; |
| else |
| return 0; |
| } |
| |
| static int ab8500_ext_regulator_set_mode(struct regulator_dev *rdev, |
| unsigned int mode) |
| { |
| int ret = 0; |
| struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev); |
| u8 regval; |
| |
| if (info == NULL) { |
| dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); |
| return -EINVAL; |
| } |
| |
| switch (mode) { |
| case REGULATOR_MODE_NORMAL: |
| regval = info->update_val_hp; |
| break; |
| case REGULATOR_MODE_IDLE: |
| regval = info->update_val_lp; |
| break; |
| |
| default: |
| return -EINVAL; |
| } |
| |
| /* If regulator is enabled and info->cfg->hwreq is set, the regulator |
| must be on in high power, so we don't need to write the register with |
| the same value. |
| */ |
| if (ab8500_ext_regulator_is_enabled(rdev) && |
| !(info->cfg && info->cfg->hwreq)) { |
| ret = abx500_mask_and_set_register_interruptible(info->dev, |
| info->update_bank, info->update_reg, |
| info->update_mask, regval); |
| if (ret < 0) { |
| dev_err(rdev_get_dev(rdev), |
| "Could not set regulator mode.\n"); |
| return ret; |
| } |
| |
| dev_dbg(rdev_get_dev(rdev), |
| "%s-set_mode (bank, reg, mask, value): " |
| "0x%x, 0x%x, 0x%x, 0x%x\n", |
| info->desc.name, info->update_bank, info->update_reg, |
| info->update_mask, regval); |
| } |
| |
| info->update_val = regval; |
| |
| return 0; |
| } |
| |
| static unsigned int ab8500_ext_regulator_get_mode(struct regulator_dev *rdev) |
| { |
| struct ab8500_ext_regulator_info *info = rdev_get_drvdata(rdev); |
| int ret; |
| |
| if (info == NULL) { |
| dev_err(rdev_get_dev(rdev), "regulator info null pointer\n"); |
| return -EINVAL; |
| } |
| |
| if (info->update_val == info->update_val_hp) |
| ret = REGULATOR_MODE_NORMAL; |
| else if (info->update_val == info->update_val_lp) |
| ret = REGULATOR_MODE_IDLE; |
| else |
| ret = -EINVAL; |
| |
| return ret; |
| } |
| |
| static int ab8500_ext_list_voltage(struct regulator_dev *rdev, |
| unsigned selector) |
| { |
| struct regulation_constraints *regu_constraints = rdev->constraints; |
| |
| if (regu_constraints == NULL) { |
| dev_err(rdev_get_dev(rdev), "regulator constraints null pointer\n"); |
| return -EINVAL; |
| } |
| /* return the uV for the fixed regulators */ |
| if (regu_constraints->min_uV && regu_constraints->max_uV) { |
| if (regu_constraints->min_uV == regu_constraints->max_uV) |
| return regu_constraints->min_uV; |
| } |
| return -EINVAL; |
| } |
| |
| static struct regulator_ops ab8500_ext_regulator_ops = { |
| .enable = ab8500_ext_regulator_enable, |
| .disable = ab8500_ext_regulator_disable, |
| .is_enabled = ab8500_ext_regulator_is_enabled, |
| .set_mode = ab8500_ext_regulator_set_mode, |
| .get_mode = ab8500_ext_regulator_get_mode, |
| .list_voltage = ab8500_ext_list_voltage, |
| }; |
| |
| static struct ab8500_ext_regulator_info |
| ab8500_ext_regulator_info[AB8500_NUM_EXT_REGULATORS] = { |
| [AB8500_EXT_SUPPLY1] = { |
| .desc = { |
| .name = "VEXTSUPPLY1", |
| .ops = &ab8500_ext_regulator_ops, |
| .type = REGULATOR_VOLTAGE, |
| .id = AB8500_EXT_SUPPLY1, |
| .owner = THIS_MODULE, |
| .n_voltages = 1, |
| }, |
| .update_bank = 0x04, |
| .update_reg = 0x08, |
| .update_mask = 0x03, |
| .update_val = 0x01, |
| .update_val_hp = 0x01, |
| .update_val_lp = 0x03, |
| .update_val_hw = 0x02, |
| }, |
| [AB8500_EXT_SUPPLY2] = { |
| .desc = { |
| .name = "VEXTSUPPLY2", |
| .ops = &ab8500_ext_regulator_ops, |
| .type = REGULATOR_VOLTAGE, |
| .id = AB8500_EXT_SUPPLY2, |
| .owner = THIS_MODULE, |
| .n_voltages = 1, |
| }, |
| .update_bank = 0x04, |
| .update_reg = 0x08, |
| .update_mask = 0x0c, |
| .update_val = 0x04, |
| .update_val_hp = 0x04, |
| .update_val_lp = 0x0c, |
| .update_val_hw = 0x08, |
| }, |
| [AB8500_EXT_SUPPLY3] = { |
| .desc = { |
| .name = "VEXTSUPPLY3", |
| .ops = &ab8500_ext_regulator_ops, |
| .type = REGULATOR_VOLTAGE, |
| .id = AB8500_EXT_SUPPLY3, |
| .owner = THIS_MODULE, |
| .n_voltages = 1, |
| }, |
| .update_bank = 0x04, |
| .update_reg = 0x08, |
| .update_mask = 0x30, |
| .update_val = 0x10, |
| .update_val_hp = 0x10, |
| .update_val_lp = 0x30, |
| .update_val_hw = 0x20, |
| }, |
| }; |
| |
| int ab8500_ext_regulator_init(struct platform_device *pdev) |
| { |
| struct ab8500 *ab8500 = dev_get_drvdata(pdev->dev.parent); |
| struct ab8500_platform_data *ppdata; |
| struct ab8500_regulator_platform_data *pdata; |
| struct regulator_config config = { }; |
| int i, err; |
| |
| if (!ab8500) { |
| dev_err(&pdev->dev, "null mfd parent\n"); |
| return -EINVAL; |
| } |
| ppdata = dev_get_platdata(ab8500->dev); |
| if (!ppdata) { |
| dev_err(&pdev->dev, "null parent pdata\n"); |
| return -EINVAL; |
| } |
| |
| pdata = ppdata->regulator; |
| if (!pdata) { |
| dev_err(&pdev->dev, "null pdata\n"); |
| return -EINVAL; |
| } |
| |
| /* make sure the platform data has the correct size */ |
| if (pdata->num_ext_regulator != ARRAY_SIZE(ab8500_ext_regulator_info)) { |
| dev_err(&pdev->dev, "Configuration error: size mismatch.\n"); |
| return -EINVAL; |
| } |
| |
| /* check for AB8500 2.x */ |
| if (is_ab8500_2p0_or_earlier(ab8500)) { |
| struct ab8500_ext_regulator_info *info; |
| |
| /* VextSupply3LPn is inverted on AB8500 2.x */ |
| info = &ab8500_ext_regulator_info[AB8500_EXT_SUPPLY3]; |
| info->update_val = 0x30; |
| info->update_val_hp = 0x30; |
| info->update_val_lp = 0x10; |
| } |
| |
| /* register all regulators */ |
| for (i = 0; i < ARRAY_SIZE(ab8500_ext_regulator_info); i++) { |
| struct ab8500_ext_regulator_info *info = NULL; |
| |
| /* assign per-regulator data */ |
| info = &ab8500_ext_regulator_info[i]; |
| info->dev = &pdev->dev; |
| info->cfg = (struct ab8500_ext_regulator_cfg *) |
| pdata->ext_regulator[i].driver_data; |
| |
| config.dev = &pdev->dev; |
| config.init_data = &pdata->ext_regulator[i]; |
| config.driver_data = info; |
| |
| /* register regulator with framework */ |
| info->rdev = regulator_register(&info->desc, &config); |
| if (IS_ERR(info->rdev)) { |
| err = PTR_ERR(info->rdev); |
| dev_err(&pdev->dev, "failed to register regulator %s\n", |
| info->desc.name); |
| /* when we fail, un-register all earlier regulators */ |
| while (--i >= 0) { |
| info = &ab8500_ext_regulator_info[i]; |
| regulator_unregister(info->rdev); |
| } |
| return err; |
| } |
| |
| dev_dbg(rdev_get_dev(info->rdev), |
| "%s-probed\n", info->desc.name); |
| } |
| |
| return 0; |
| } |
| |
| void ab8500_ext_regulator_exit(struct platform_device *pdev) |
| { |
| int i; |
| |
| for (i = 0; i < ARRAY_SIZE(ab8500_ext_regulator_info); i++) { |
| struct ab8500_ext_regulator_info *info = NULL; |
| info = &ab8500_ext_regulator_info[i]; |
| |
| dev_vdbg(rdev_get_dev(info->rdev), |
| "%s-remove\n", info->desc.name); |
| |
| regulator_unregister(info->rdev); |
| } |
| } |
| |
| MODULE_LICENSE("GPL v2"); |
| MODULE_AUTHOR("Bengt Jonsson <bengt.g.jonsson@stericsson.com>"); |
| MODULE_DESCRIPTION("AB8500 external regulator driver"); |
| MODULE_ALIAS("platform:ab8500-ext-regulator"); |