581 строка
14 KiB
C
581 строка
14 KiB
C
/*
|
|
* Copyright (C) ST-Ericsson SA 2010
|
|
*
|
|
* License Terms: GNU General Public License v2
|
|
* Authors: Sundar Iyer <sundar.iyer@stericsson.com> for ST-Ericsson
|
|
* Bengt Jonsson <bengt.g.jonsson@stericsson.com> for ST-Ericsson
|
|
*
|
|
* Power domain regulators on DB8500
|
|
*/
|
|
|
|
#include <linux/kernel.h>
|
|
#include <linux/init.h>
|
|
#include <linux/err.h>
|
|
#include <linux/spinlock.h>
|
|
#include <linux/platform_device.h>
|
|
#include <linux/mfd/dbx500-prcmu.h>
|
|
#include <linux/regulator/driver.h>
|
|
#include <linux/regulator/machine.h>
|
|
#include <linux/regulator/db8500-prcmu.h>
|
|
#include <linux/regulator/of_regulator.h>
|
|
#include <linux/of.h>
|
|
#include <linux/module.h>
|
|
#include "dbx500-prcmu.h"
|
|
|
|
static int db8500_regulator_enable(struct regulator_dev *rdev)
|
|
{
|
|
struct dbx500_regulator_info *info = rdev_get_drvdata(rdev);
|
|
|
|
if (info == NULL)
|
|
return -EINVAL;
|
|
|
|
dev_vdbg(rdev_get_dev(rdev), "regulator-%s-enable\n",
|
|
info->desc.name);
|
|
|
|
if (!info->is_enabled) {
|
|
info->is_enabled = true;
|
|
if (!info->exclude_from_power_state)
|
|
power_state_active_enable();
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int db8500_regulator_disable(struct regulator_dev *rdev)
|
|
{
|
|
struct dbx500_regulator_info *info = rdev_get_drvdata(rdev);
|
|
int ret = 0;
|
|
|
|
if (info == NULL)
|
|
return -EINVAL;
|
|
|
|
dev_vdbg(rdev_get_dev(rdev), "regulator-%s-disable\n",
|
|
info->desc.name);
|
|
|
|
if (info->is_enabled) {
|
|
info->is_enabled = false;
|
|
if (!info->exclude_from_power_state)
|
|
ret = power_state_active_disable();
|
|
}
|
|
|
|
return ret;
|
|
}
|
|
|
|
static int db8500_regulator_is_enabled(struct regulator_dev *rdev)
|
|
{
|
|
struct dbx500_regulator_info *info = rdev_get_drvdata(rdev);
|
|
|
|
if (info == NULL)
|
|
return -EINVAL;
|
|
|
|
dev_vdbg(rdev_get_dev(rdev), "regulator-%s-is_enabled (is_enabled):"
|
|
" %i\n", info->desc.name, info->is_enabled);
|
|
|
|
return info->is_enabled;
|
|
}
|
|
|
|
/* db8500 regulator operations */
|
|
static struct regulator_ops db8500_regulator_ops = {
|
|
.enable = db8500_regulator_enable,
|
|
.disable = db8500_regulator_disable,
|
|
.is_enabled = db8500_regulator_is_enabled,
|
|
};
|
|
|
|
/*
|
|
* EPOD control
|
|
*/
|
|
static bool epod_on[NUM_EPOD_ID];
|
|
static bool epod_ramret[NUM_EPOD_ID];
|
|
|
|
static int enable_epod(u16 epod_id, bool ramret)
|
|
{
|
|
int ret;
|
|
|
|
if (ramret) {
|
|
if (!epod_on[epod_id]) {
|
|
ret = prcmu_set_epod(epod_id, EPOD_STATE_RAMRET);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
epod_ramret[epod_id] = true;
|
|
} else {
|
|
ret = prcmu_set_epod(epod_id, EPOD_STATE_ON);
|
|
if (ret < 0)
|
|
return ret;
|
|
epod_on[epod_id] = true;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int disable_epod(u16 epod_id, bool ramret)
|
|
{
|
|
int ret;
|
|
|
|
if (ramret) {
|
|
if (!epod_on[epod_id]) {
|
|
ret = prcmu_set_epod(epod_id, EPOD_STATE_OFF);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
epod_ramret[epod_id] = false;
|
|
} else {
|
|
if (epod_ramret[epod_id]) {
|
|
ret = prcmu_set_epod(epod_id, EPOD_STATE_RAMRET);
|
|
if (ret < 0)
|
|
return ret;
|
|
} else {
|
|
ret = prcmu_set_epod(epod_id, EPOD_STATE_OFF);
|
|
if (ret < 0)
|
|
return ret;
|
|
}
|
|
epod_on[epod_id] = false;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
/*
|
|
* Regulator switch
|
|
*/
|
|
static int db8500_regulator_switch_enable(struct regulator_dev *rdev)
|
|
{
|
|
struct dbx500_regulator_info *info = rdev_get_drvdata(rdev);
|
|
int ret;
|
|
|
|
if (info == NULL)
|
|
return -EINVAL;
|
|
|
|
dev_vdbg(rdev_get_dev(rdev), "regulator-switch-%s-enable\n",
|
|
info->desc.name);
|
|
|
|
ret = enable_epod(info->epod_id, info->is_ramret);
|
|
if (ret < 0) {
|
|
dev_err(rdev_get_dev(rdev),
|
|
"regulator-switch-%s-enable: prcmu call failed\n",
|
|
info->desc.name);
|
|
goto out;
|
|
}
|
|
|
|
info->is_enabled = true;
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static int db8500_regulator_switch_disable(struct regulator_dev *rdev)
|
|
{
|
|
struct dbx500_regulator_info *info = rdev_get_drvdata(rdev);
|
|
int ret;
|
|
|
|
if (info == NULL)
|
|
return -EINVAL;
|
|
|
|
dev_vdbg(rdev_get_dev(rdev), "regulator-switch-%s-disable\n",
|
|
info->desc.name);
|
|
|
|
ret = disable_epod(info->epod_id, info->is_ramret);
|
|
if (ret < 0) {
|
|
dev_err(rdev_get_dev(rdev),
|
|
"regulator_switch-%s-disable: prcmu call failed\n",
|
|
info->desc.name);
|
|
goto out;
|
|
}
|
|
|
|
info->is_enabled = 0;
|
|
out:
|
|
return ret;
|
|
}
|
|
|
|
static int db8500_regulator_switch_is_enabled(struct regulator_dev *rdev)
|
|
{
|
|
struct dbx500_regulator_info *info = rdev_get_drvdata(rdev);
|
|
|
|
if (info == NULL)
|
|
return -EINVAL;
|
|
|
|
dev_vdbg(rdev_get_dev(rdev),
|
|
"regulator-switch-%s-is_enabled (is_enabled): %i\n",
|
|
info->desc.name, info->is_enabled);
|
|
|
|
return info->is_enabled;
|
|
}
|
|
|
|
static struct regulator_ops db8500_regulator_switch_ops = {
|
|
.enable = db8500_regulator_switch_enable,
|
|
.disable = db8500_regulator_switch_disable,
|
|
.is_enabled = db8500_regulator_switch_is_enabled,
|
|
};
|
|
|
|
/*
|
|
* Regulator information
|
|
*/
|
|
static struct dbx500_regulator_info
|
|
dbx500_regulator_info[DB8500_NUM_REGULATORS] = {
|
|
[DB8500_REGULATOR_VAPE] = {
|
|
.desc = {
|
|
.name = "db8500-vape",
|
|
.id = DB8500_REGULATOR_VAPE,
|
|
.ops = &db8500_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
},
|
|
[DB8500_REGULATOR_VARM] = {
|
|
.desc = {
|
|
.name = "db8500-varm",
|
|
.id = DB8500_REGULATOR_VARM,
|
|
.ops = &db8500_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
},
|
|
[DB8500_REGULATOR_VMODEM] = {
|
|
.desc = {
|
|
.name = "db8500-vmodem",
|
|
.id = DB8500_REGULATOR_VMODEM,
|
|
.ops = &db8500_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
},
|
|
[DB8500_REGULATOR_VPLL] = {
|
|
.desc = {
|
|
.name = "db8500-vpll",
|
|
.id = DB8500_REGULATOR_VPLL,
|
|
.ops = &db8500_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
},
|
|
[DB8500_REGULATOR_VSMPS1] = {
|
|
.desc = {
|
|
.name = "db8500-vsmps1",
|
|
.id = DB8500_REGULATOR_VSMPS1,
|
|
.ops = &db8500_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
},
|
|
[DB8500_REGULATOR_VSMPS2] = {
|
|
.desc = {
|
|
.name = "db8500-vsmps2",
|
|
.id = DB8500_REGULATOR_VSMPS2,
|
|
.ops = &db8500_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.exclude_from_power_state = true,
|
|
},
|
|
[DB8500_REGULATOR_VSMPS3] = {
|
|
.desc = {
|
|
.name = "db8500-vsmps3",
|
|
.id = DB8500_REGULATOR_VSMPS3,
|
|
.ops = &db8500_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
},
|
|
[DB8500_REGULATOR_VRF1] = {
|
|
.desc = {
|
|
.name = "db8500-vrf1",
|
|
.id = DB8500_REGULATOR_VRF1,
|
|
.ops = &db8500_regulator_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_SVAMMDSP] = {
|
|
.desc = {
|
|
.name = "db8500-sva-mmdsp",
|
|
.id = DB8500_REGULATOR_SWITCH_SVAMMDSP,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_SVAMMDSP,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_SVAMMDSPRET] = {
|
|
.desc = {
|
|
.name = "db8500-sva-mmdsp-ret",
|
|
.id = DB8500_REGULATOR_SWITCH_SVAMMDSPRET,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_SVAMMDSP,
|
|
.is_ramret = true,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_SVAPIPE] = {
|
|
.desc = {
|
|
.name = "db8500-sva-pipe",
|
|
.id = DB8500_REGULATOR_SWITCH_SVAPIPE,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_SVAPIPE,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_SIAMMDSP] = {
|
|
.desc = {
|
|
.name = "db8500-sia-mmdsp",
|
|
.id = DB8500_REGULATOR_SWITCH_SIAMMDSP,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_SIAMMDSP,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_SIAMMDSPRET] = {
|
|
.desc = {
|
|
.name = "db8500-sia-mmdsp-ret",
|
|
.id = DB8500_REGULATOR_SWITCH_SIAMMDSPRET,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_SIAMMDSP,
|
|
.is_ramret = true,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_SIAPIPE] = {
|
|
.desc = {
|
|
.name = "db8500-sia-pipe",
|
|
.id = DB8500_REGULATOR_SWITCH_SIAPIPE,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_SIAPIPE,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_SGA] = {
|
|
.desc = {
|
|
.name = "db8500-sga",
|
|
.id = DB8500_REGULATOR_SWITCH_SGA,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_SGA,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_B2R2_MCDE] = {
|
|
.desc = {
|
|
.name = "db8500-b2r2-mcde",
|
|
.id = DB8500_REGULATOR_SWITCH_B2R2_MCDE,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_B2R2_MCDE,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_ESRAM12] = {
|
|
.desc = {
|
|
.name = "db8500-esram12",
|
|
.id = DB8500_REGULATOR_SWITCH_ESRAM12,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_ESRAM12,
|
|
.is_enabled = true,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_ESRAM12RET] = {
|
|
.desc = {
|
|
.name = "db8500-esram12-ret",
|
|
.id = DB8500_REGULATOR_SWITCH_ESRAM12RET,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_ESRAM12,
|
|
.is_ramret = true,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_ESRAM34] = {
|
|
.desc = {
|
|
.name = "db8500-esram34",
|
|
.id = DB8500_REGULATOR_SWITCH_ESRAM34,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_ESRAM34,
|
|
.is_enabled = true,
|
|
},
|
|
[DB8500_REGULATOR_SWITCH_ESRAM34RET] = {
|
|
.desc = {
|
|
.name = "db8500-esram34-ret",
|
|
.id = DB8500_REGULATOR_SWITCH_ESRAM34RET,
|
|
.ops = &db8500_regulator_switch_ops,
|
|
.type = REGULATOR_VOLTAGE,
|
|
.owner = THIS_MODULE,
|
|
},
|
|
.epod_id = EPOD_ID_ESRAM34,
|
|
.is_ramret = true,
|
|
},
|
|
};
|
|
|
|
static __devinit int db8500_regulator_register(struct platform_device *pdev,
|
|
struct regulator_init_data *init_data,
|
|
int id,
|
|
struct device_node *np)
|
|
{
|
|
struct dbx500_regulator_info *info;
|
|
struct regulator_config config = { };
|
|
int err;
|
|
|
|
/* assign per-regulator data */
|
|
info = &dbx500_regulator_info[id];
|
|
info->dev = &pdev->dev;
|
|
|
|
config.dev = &pdev->dev;
|
|
config.init_data = init_data;
|
|
config.driver_data = info;
|
|
config.of_node = np;
|
|
|
|
/* register with the regulator 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 %s: err %i\n",
|
|
info->desc.name, err);
|
|
|
|
/* if failing, unregister all earlier regulators */
|
|
while (--id >= 0) {
|
|
info = &dbx500_regulator_info[id];
|
|
regulator_unregister(info->rdev);
|
|
}
|
|
return err;
|
|
}
|
|
|
|
dev_dbg(rdev_get_dev(info->rdev),
|
|
"regulator-%s-probed\n", info->desc.name);
|
|
|
|
return 0;
|
|
}
|
|
|
|
static struct of_regulator_match db8500_regulator_matches[] = {
|
|
{ .name = "db8500_vape", .driver_data = (void *) DB8500_REGULATOR_VAPE, },
|
|
{ .name = "db8500_varm", .driver_data = (void *) DB8500_REGULATOR_VARM, },
|
|
{ .name = "db8500_vmodem", .driver_data = (void *) DB8500_REGULATOR_VMODEM, },
|
|
{ .name = "db8500_vpll", .driver_data = (void *) DB8500_REGULATOR_VPLL, },
|
|
{ .name = "db8500_vsmps1", .driver_data = (void *) DB8500_REGULATOR_VSMPS1, },
|
|
{ .name = "db8500_vsmps2", .driver_data = (void *) DB8500_REGULATOR_VSMPS2, },
|
|
{ .name = "db8500_vsmps3", .driver_data = (void *) DB8500_REGULATOR_VSMPS3, },
|
|
{ .name = "db8500_vrf1", .driver_data = (void *) DB8500_REGULATOR_VRF1, },
|
|
{ .name = "db8500_sva_mmdsp", .driver_data = (void *) DB8500_REGULATOR_SWITCH_SVAMMDSP, },
|
|
{ .name = "db8500_sva_mmdsp_ret", .driver_data = (void *) DB8500_REGULATOR_SWITCH_SVAMMDSPRET, },
|
|
{ .name = "db8500_sva_pipe", .driver_data = (void *) DB8500_REGULATOR_SWITCH_SVAPIPE, },
|
|
{ .name = "db8500_sia_mmdsp", .driver_data = (void *) DB8500_REGULATOR_SWITCH_SIAMMDSP, },
|
|
{ .name = "db8500_sia_mmdsp_ret", .driver_data = (void *) DB8500_REGULATOR_SWITCH_SIAMMDSPRET, },
|
|
{ .name = "db8500_sia_pipe", .driver_data = (void *) DB8500_REGULATOR_SWITCH_SIAPIPE, },
|
|
{ .name = "db8500_sga", .driver_data = (void *) DB8500_REGULATOR_SWITCH_SGA, },
|
|
{ .name = "db8500_b2r2_mcde", .driver_data = (void *) DB8500_REGULATOR_SWITCH_B2R2_MCDE, },
|
|
{ .name = "db8500_esram12", .driver_data = (void *) DB8500_REGULATOR_SWITCH_ESRAM12, },
|
|
{ .name = "db8500_esram12_ret", .driver_data = (void *) DB8500_REGULATOR_SWITCH_ESRAM12RET, },
|
|
{ .name = "db8500_esram34", .driver_data = (void *) DB8500_REGULATOR_SWITCH_ESRAM34, },
|
|
{ .name = "db8500_esram34_ret", .driver_data = (void *) DB8500_REGULATOR_SWITCH_ESRAM34RET, },
|
|
};
|
|
|
|
static __devinit int
|
|
db8500_regulator_of_probe(struct platform_device *pdev,
|
|
struct device_node *np)
|
|
{
|
|
int i, err;
|
|
|
|
for (i = 0; i < ARRAY_SIZE(dbx500_regulator_info); i++) {
|
|
err = db8500_regulator_register(
|
|
pdev, db8500_regulator_matches[i].init_data,
|
|
i, db8500_regulator_matches[i].of_node);
|
|
if (err)
|
|
return err;
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static int __devinit db8500_regulator_probe(struct platform_device *pdev)
|
|
{
|
|
struct regulator_init_data *db8500_init_data =
|
|
dev_get_platdata(&pdev->dev);
|
|
struct device_node *np = pdev->dev.of_node;
|
|
int i, err;
|
|
|
|
/* register all regulators */
|
|
if (np) {
|
|
err = of_regulator_match(&pdev->dev, np,
|
|
db8500_regulator_matches,
|
|
ARRAY_SIZE(db8500_regulator_matches));
|
|
if (err < 0) {
|
|
dev_err(&pdev->dev,
|
|
"Error parsing regulator init data: %d\n", err);
|
|
return err;
|
|
}
|
|
|
|
err = db8500_regulator_of_probe(pdev, np);
|
|
if (err)
|
|
return err;
|
|
} else {
|
|
for (i = 0; i < ARRAY_SIZE(dbx500_regulator_info); i++) {
|
|
err = db8500_regulator_register(pdev,
|
|
&db8500_init_data[i],
|
|
i, NULL);
|
|
if (err)
|
|
return err;
|
|
}
|
|
}
|
|
|
|
err = ux500_regulator_debug_init(pdev,
|
|
dbx500_regulator_info,
|
|
ARRAY_SIZE(dbx500_regulator_info));
|
|
return 0;
|
|
}
|
|
|
|
static int __exit db8500_regulator_remove(struct platform_device *pdev)
|
|
{
|
|
int i;
|
|
|
|
ux500_regulator_debug_exit();
|
|
|
|
for (i = 0; i < ARRAY_SIZE(dbx500_regulator_info); i++) {
|
|
struct dbx500_regulator_info *info;
|
|
info = &dbx500_regulator_info[i];
|
|
|
|
dev_vdbg(rdev_get_dev(info->rdev),
|
|
"regulator-%s-remove\n", info->desc.name);
|
|
|
|
regulator_unregister(info->rdev);
|
|
}
|
|
|
|
return 0;
|
|
}
|
|
|
|
static const struct of_device_id db8500_prcmu_regulator_match[] = {
|
|
{ .compatible = "stericsson,db8500-prcmu-regulator", },
|
|
{}
|
|
};
|
|
|
|
static struct platform_driver db8500_regulator_driver = {
|
|
.driver = {
|
|
.name = "db8500-prcmu-regulators",
|
|
.owner = THIS_MODULE,
|
|
.of_match_table = db8500_prcmu_regulator_match,
|
|
},
|
|
.probe = db8500_regulator_probe,
|
|
.remove = __exit_p(db8500_regulator_remove),
|
|
};
|
|
|
|
static int __init db8500_regulator_init(void)
|
|
{
|
|
return platform_driver_register(&db8500_regulator_driver);
|
|
}
|
|
|
|
static void __exit db8500_regulator_exit(void)
|
|
{
|
|
platform_driver_unregister(&db8500_regulator_driver);
|
|
}
|
|
|
|
arch_initcall(db8500_regulator_init);
|
|
module_exit(db8500_regulator_exit);
|
|
|
|
MODULE_AUTHOR("STMicroelectronics/ST-Ericsson");
|
|
MODULE_DESCRIPTION("DB8500 regulator driver");
|
|
MODULE_LICENSE("GPL v2");
|