--- a/drivers/power/Kconfig +++ b/drivers/power/Kconfig @@ -43,6 +43,14 @@ config MAX8925_POWER Say Y here to enable support for the battery charger in the Maxim MAX8925 PMIC. +config MXS_POWER + tristate "Freescale MXS power subsystem support" + depends on ARCH_MXS || COMPILE_TEST + help + Say Y here to enable support for the Freescale i.MX23/i.MX28 + power subsystem. This is a requirement to get access to on-chip + regulators, battery charger and many more. + config WM831X_BACKUP tristate "WM831X backup battery charger support" depends on MFD_WM831X --- a/drivers/power/Makefile +++ b/drivers/power/Makefile @@ -10,6 +10,7 @@ obj-$(CONFIG_GENERIC_ADC_BATTERY) += gen obj-$(CONFIG_PDA_POWER) += pda_power.o obj-$(CONFIG_APM_POWER) += apm_power.o obj-$(CONFIG_MAX8925_POWER) += max8925_power.o +obj-$(CONFIG_MXS_POWER) += mxs_power.o obj-$(CONFIG_WM831X_BACKUP) += wm831x_backup.o obj-$(CONFIG_WM831X_POWER) += wm831x_power.o obj-$(CONFIG_WM8350_POWER) += wm8350_power.o --- /dev/null +++ b/drivers/power/mxs_power.c @@ -0,0 +1,136 @@ +/* + * Freescale MXS power subsystem + * + * Copyright (C) 2014 Stefan Wahren + * + * Inspired by imx-bootlets + */ + +/* + * The code contained herein is licensed under the GNU General Public + * License. You may obtain a copy of the GNU General Public License + * Version 2 or later at the following locations: + * + * http://www.opensource.org/licenses/gpl-license.html + * http://www.gnu.org/copyleft/gpl.html + */ + +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include +#include + +#define BM_POWER_CTRL_POLARITY_VBUSVALID BIT(5) +#define BM_POWER_CTRL_VBUSVALID_IRQ BIT(4) +#define BM_POWER_CTRL_ENIRQ_VBUS_VALID BIT(3) + +#define HW_POWER_5VCTRL_OFFSET 0x10 + +#define BM_POWER_5VCTRL_VBUSVALID_THRESH (7 << 8) +#define BM_POWER_5VCTRL_PWDN_5VBRNOUT BIT(7) +#define BM_POWER_5VCTRL_ENABLE_LINREG_ILIMIT BIT(6) +#define BM_POWER_5VCTRL_VBUSVALID_5VDETECT BIT(4) + +#define HW_POWER_5VCTRL_VBUSVALID_THRESH_4_40V (5 << 8) + +struct mxs_power_data { + void __iomem *base_addr; + struct power_supply *ac; +}; + +static enum power_supply_property mxs_power_ac_props[] = { + POWER_SUPPLY_PROP_ONLINE, +}; + +static int mxs_power_ac_get_property(struct power_supply *psy, + enum power_supply_property psp, + union power_supply_propval *val) +{ + int ret = 0; + + switch (psp) { + case POWER_SUPPLY_PROP_ONLINE: + val->intval = 1; + break; + default: + ret = -EINVAL; + break; + } + return ret; +} + +static const struct of_device_id of_mxs_power_match[] = { + { .compatible = "fsl,imx23-power" }, + { .compatible = "fsl,imx28-power" }, + { /* end */ } +}; +MODULE_DEVICE_TABLE(of, of_mxs_power_match); + +static const struct power_supply_desc ac_desc = { + .properties = mxs_power_ac_props, + .num_properties = ARRAY_SIZE(mxs_power_ac_props), + .get_property = mxs_power_ac_get_property, + .name = "ac", + .type = POWER_SUPPLY_TYPE_MAINS, +}; + +static int mxs_power_probe(struct platform_device *pdev) +{ + struct device *dev = &pdev->dev; + struct device_node *np = dev->of_node; + struct resource *res; + struct mxs_power_data *data; + struct power_supply_config psy_cfg = {}; + void __iomem *v5ctrl_addr; + + if (!np) { + dev_err(dev, "missing device tree\n"); + return -EINVAL; + } + + data = devm_kzalloc(dev, sizeof(*data), GFP_KERNEL); + if (!data) + return -ENOMEM; + + res = platform_get_resource(pdev, IORESOURCE_MEM, 0); + data->base_addr = devm_ioremap_resource(dev, res); + if (IS_ERR(data->base_addr)) + return PTR_ERR(data->base_addr); + + psy_cfg.drv_data = data; + + data->ac = devm_power_supply_register(dev, &ac_desc, &psy_cfg); + if (IS_ERR(data->ac)) + return PTR_ERR(data->ac); + + platform_set_drvdata(pdev, data); + + v5ctrl_addr = data->base_addr + HW_POWER_5VCTRL_OFFSET; + + /* Make sure the current limit of the linregs are disabled. */ + writel(BM_POWER_5VCTRL_ENABLE_LINREG_ILIMIT, + v5ctrl_addr + STMP_OFFSET_REG_CLR); + + return of_platform_populate(np, NULL, NULL, dev); +} + +static struct platform_driver mxs_power_driver = { + .driver = { + .name = "mxs_power", + .of_match_table = of_mxs_power_match, + }, + .probe = mxs_power_probe, +}; + +module_platform_driver(mxs_power_driver); + +MODULE_AUTHOR("Stefan Wahren "); +MODULE_DESCRIPTION("Freescale MXS power subsystem"); +MODULE_LICENSE("GPL v2");