/* * Freescale STMP378X voltage regulators * * Embedded Alley Solutions, Inc * * Copyright (C) 2010 Freescale Semiconductor, Inc. * Copyright 2008 Embedded Alley Solutions, Inc All Rights Reserved. */ /* * 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 static int mxs_set_voltage(struct regulator_dev *reg, int MiniV, int uv) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); if (mxs_reg->rdata->set_voltage) return mxs_reg->rdata->set_voltage(mxs_reg, uv); else return -ENOTSUPP; } static int mxs_get_voltage(struct regulator_dev *reg) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); if (mxs_reg->rdata->get_voltage) return mxs_reg->rdata->get_voltage(mxs_reg); else return -ENOTSUPP; } static int mxs_set_current(struct regulator_dev *reg, int min_uA, int uA) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); if (mxs_reg->rdata->set_current) return mxs_reg->rdata->set_current(mxs_reg, uA); else return -ENOTSUPP; } static int mxs_get_current(struct regulator_dev *reg) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); if (mxs_reg->rdata->get_current) return mxs_reg->rdata->get_current(mxs_reg); else return -ENOTSUPP; } static int mxs_enable(struct regulator_dev *reg) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); return mxs_reg->rdata->enable(mxs_reg); } static int mxs_disable(struct regulator_dev *reg) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); return mxs_reg->rdata->disable(mxs_reg); } static int mxs_is_enabled(struct regulator_dev *reg) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); return mxs_reg->rdata->is_enabled(mxs_reg); } static int mxs_set_mode(struct regulator_dev *reg, unsigned int mode) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); return mxs_reg->rdata->set_mode(mxs_reg, mode); } static unsigned int mxs_get_mode(struct regulator_dev *reg) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); return mxs_reg->rdata->get_mode(mxs_reg); } static unsigned int mxs_get_optimum_mode(struct regulator_dev *reg, int input_uV, int output_uV, int load_uA) { struct mxs_regulator *mxs_reg = rdev_get_drvdata(reg); if (mxs_reg->rdata->get_optimum_mode) return mxs_reg->rdata->get_optimum_mode(mxs_reg, input_uV, output_uV, load_uA); else return -ENOTSUPP; } static struct regulator_ops mxs_rops = { .set_voltage = mxs_set_voltage, .get_voltage = mxs_get_voltage, .set_current_limit = mxs_set_current, .get_current_limit = mxs_get_current, .enable = mxs_enable, .disable = mxs_disable, .is_enabled = mxs_is_enabled, .set_mode = mxs_set_mode, .get_mode = mxs_get_mode, .get_optimum_mode = mxs_get_optimum_mode, }; static struct regulator_desc mxs_reg_desc[] = { { .name = "vddd", .id = MXS_VDDD, .ops = &mxs_rops, .irq = 0, .type = REGULATOR_VOLTAGE, .owner = THIS_MODULE }, { .name = "vdda", .id = MXS_VDDA, .ops = &mxs_rops, .irq = 0, .type = REGULATOR_VOLTAGE, .owner = THIS_MODULE }, { .name = "vddio", .id = MXS_VDDIO, .ops = &mxs_rops, .irq = 0, .type = REGULATOR_VOLTAGE, .owner = THIS_MODULE }, { .name = "vddd_bo", .id = MXS_VDDDBO, .ops = &mxs_rops, .irq = 0, .type = REGULATOR_VOLTAGE, .owner = THIS_MODULE }, { .name = "overall_current", .id = MXS_OVERALL_CUR, .ops = &mxs_rops, .irq = 0, .type = REGULATOR_CURRENT, .owner = THIS_MODULE }, }; static int reg_callback(struct notifier_block *self, unsigned long event, void *data) { unsigned long flags; struct mxs_regulator *sreg = container_of(self, struct mxs_regulator , nb); switch (event) { case MXS_REG5V_IS_USB: spin_lock_irqsave(&sreg->lock, flags); sreg->rdata->max_current = 500000; spin_unlock_irqrestore(&sreg->lock, flags); break; case MXS_REG5V_NOT_USB: spin_lock_irqsave(&sreg->lock, flags); sreg->rdata->max_current = 0x7fffffff; spin_unlock_irqrestore(&sreg->lock, flags); break; } return 0; } int mxs_regulator_probe(struct platform_device *pdev) { struct regulator_desc *rdesc; struct regulator_dev *rdev; struct mxs_regulator *sreg; struct regulator_init_data *initdata; sreg = platform_get_drvdata(pdev); initdata = pdev->dev.platform_data; sreg->cur_current = 0; sreg->next_current = 0; sreg->cur_voltage = 0; init_waitqueue_head(&sreg->wait_q); spin_lock_init(&sreg->lock); if (pdev->id > MXS_OVERALL_CUR) { rdesc = kzalloc(sizeof(struct regulator_desc), GFP_KERNEL); memcpy(rdesc, &mxs_reg_desc[MXS_OVERALL_CUR], sizeof(struct regulator_desc)); rdesc->name = kstrdup(sreg->rdata->name, GFP_KERNEL); } else rdesc = &mxs_reg_desc[pdev->id]; pr_debug("probing regulator %s %s %d\n", sreg->rdata->name, rdesc->name, pdev->id); /* register regulator */ rdev = regulator_register(rdesc, &pdev->dev, initdata, sreg); if (IS_ERR(rdev)) { dev_err(&pdev->dev, "failed to register %s\n", rdesc->name); return PTR_ERR(rdev); } if (sreg->rdata->max_current) { struct regulator *regu; regu = regulator_get(NULL, sreg->rdata->name); sreg->nb.notifier_call = reg_callback; regulator_register_notifier(regu, &sreg->nb); } return 0; } int mxs_regulator_remove(struct platform_device *pdev) { struct regulator_dev *rdev = platform_get_drvdata(pdev); regulator_unregister(rdev); return 0; } int mxs_register_regulator( struct mxs_regulator *reg_data, int reg, struct regulator_init_data *initdata) { struct platform_device *pdev; int ret; pdev = platform_device_alloc("mxs_reg", reg); if (!pdev) return -ENOMEM; pdev->dev.platform_data = initdata; platform_set_drvdata(pdev, reg_data); ret = platform_device_add(pdev); if (ret != 0) { pr_debug("Failed to register regulator %d: %d\n", reg, ret); platform_device_del(pdev); } pr_debug("register regulator %s, %d: %d\n", reg_data->rdata->name, reg, ret); return ret; } EXPORT_SYMBOL_GPL(mxs_register_regulator); struct platform_driver mxs_reg = { .driver = { .name = "mxs_reg", }, .probe = mxs_regulator_probe, .remove = mxs_regulator_remove, }; int mxs_regulator_init(void) { return platform_driver_register(&mxs_reg); } void mxs_regulator_exit(void) { platform_driver_unregister(&mxs_reg); } postcore_initcall(mxs_regulator_init); module_exit(mxs_regulator_exit);