Platform: OLPC: Add a regulator for the DCON
All OLPC ECs are able to turn the power to the DCON on an off. Use the regulator framework to expose the functionality. Signed-off-by: Lubomir Rintel <lkundrak@v3.sk> Signed-off-by: Andy Shevchenko <andriy.shevchenko@linux.intel.com>
This commit is contained in:
parent
0c3d931b3a
commit
231c0c2161
2 changed files with 68 additions and 0 deletions
|
@ -1,4 +1,5 @@
|
||||||
config OLPC_EC
|
config OLPC_EC
|
||||||
|
select REGULATOR
|
||||||
bool
|
bool
|
||||||
|
|
||||||
config OLPC_XO175_EC
|
config OLPC_XO175_EC
|
||||||
|
|
|
@ -16,6 +16,7 @@
|
||||||
#include <linux/workqueue.h>
|
#include <linux/workqueue.h>
|
||||||
#include <linux/init.h>
|
#include <linux/init.h>
|
||||||
#include <linux/list.h>
|
#include <linux/list.h>
|
||||||
|
#include <linux/regulator/driver.h>
|
||||||
#include <linux/olpc-ec.h>
|
#include <linux/olpc-ec.h>
|
||||||
|
|
||||||
struct ec_cmd_desc {
|
struct ec_cmd_desc {
|
||||||
|
@ -36,6 +37,10 @@ struct olpc_ec_priv {
|
||||||
struct work_struct worker;
|
struct work_struct worker;
|
||||||
struct mutex cmd_lock;
|
struct mutex cmd_lock;
|
||||||
|
|
||||||
|
/* DCON regulator */
|
||||||
|
struct regulator_dev *dcon_rdev;
|
||||||
|
bool dcon_enabled;
|
||||||
|
|
||||||
/* Pending EC commands */
|
/* Pending EC commands */
|
||||||
struct list_head cmd_q;
|
struct list_head cmd_q;
|
||||||
spinlock_t cmd_q_lock;
|
spinlock_t cmd_q_lock;
|
||||||
|
@ -346,9 +351,61 @@ static struct dentry *olpc_ec_setup_debugfs(void)
|
||||||
|
|
||||||
#endif /* CONFIG_DEBUG_FS */
|
#endif /* CONFIG_DEBUG_FS */
|
||||||
|
|
||||||
|
static int olpc_ec_set_dcon_power(struct olpc_ec_priv *ec, bool state)
|
||||||
|
{
|
||||||
|
unsigned char ec_byte = state;
|
||||||
|
int ret;
|
||||||
|
|
||||||
|
if (ec->dcon_enabled == state)
|
||||||
|
return 0;
|
||||||
|
|
||||||
|
ret = olpc_ec_cmd(EC_DCON_POWER_MODE, &ec_byte, 1, NULL, 0);
|
||||||
|
if (ret)
|
||||||
|
return ret;
|
||||||
|
|
||||||
|
ec->dcon_enabled = state;
|
||||||
|
return 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static int dcon_regulator_enable(struct regulator_dev *rdev)
|
||||||
|
{
|
||||||
|
struct olpc_ec_priv *ec = rdev_get_drvdata(rdev);
|
||||||
|
|
||||||
|
return olpc_ec_set_dcon_power(ec, true);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int dcon_regulator_disable(struct regulator_dev *rdev)
|
||||||
|
{
|
||||||
|
struct olpc_ec_priv *ec = rdev_get_drvdata(rdev);
|
||||||
|
|
||||||
|
return olpc_ec_set_dcon_power(ec, false);
|
||||||
|
}
|
||||||
|
|
||||||
|
static int dcon_regulator_is_enabled(struct regulator_dev *rdev)
|
||||||
|
{
|
||||||
|
struct olpc_ec_priv *ec = rdev_get_drvdata(rdev);
|
||||||
|
|
||||||
|
return ec->dcon_enabled ? 1 : 0;
|
||||||
|
}
|
||||||
|
|
||||||
|
static struct regulator_ops dcon_regulator_ops = {
|
||||||
|
.enable = dcon_regulator_enable,
|
||||||
|
.disable = dcon_regulator_disable,
|
||||||
|
.is_enabled = dcon_regulator_is_enabled,
|
||||||
|
};
|
||||||
|
|
||||||
|
static const struct regulator_desc dcon_desc = {
|
||||||
|
.name = "dcon",
|
||||||
|
.id = 0,
|
||||||
|
.ops = &dcon_regulator_ops,
|
||||||
|
.type = REGULATOR_VOLTAGE,
|
||||||
|
.owner = THIS_MODULE,
|
||||||
|
};
|
||||||
|
|
||||||
static int olpc_ec_probe(struct platform_device *pdev)
|
static int olpc_ec_probe(struct platform_device *pdev)
|
||||||
{
|
{
|
||||||
struct olpc_ec_priv *ec;
|
struct olpc_ec_priv *ec;
|
||||||
|
struct regulator_config config = { };
|
||||||
int err;
|
int err;
|
||||||
|
|
||||||
if (!ec_driver)
|
if (!ec_driver)
|
||||||
|
@ -376,6 +433,16 @@ static int olpc_ec_probe(struct platform_device *pdev)
|
||||||
return err;
|
return err;
|
||||||
}
|
}
|
||||||
|
|
||||||
|
config.dev = pdev->dev.parent;
|
||||||
|
config.driver_data = ec;
|
||||||
|
ec->dcon_enabled = true;
|
||||||
|
ec->dcon_rdev = devm_regulator_register(&pdev->dev, &dcon_desc,
|
||||||
|
&config);
|
||||||
|
if (IS_ERR(ec->dcon_rdev)) {
|
||||||
|
dev_err(&pdev->dev, "failed to register DCON regulator\n");
|
||||||
|
return PTR_ERR(ec->dcon_rdev);
|
||||||
|
}
|
||||||
|
|
||||||
ec->dbgfs_dir = olpc_ec_setup_debugfs();
|
ec->dbgfs_dir = olpc_ec_setup_debugfs();
|
||||||
|
|
||||||
return err;
|
return err;
|
||||||
|
|
Loading…
Add table
Reference in a new issue