1e3e5aff7SYing-Chun Liu (PaulLiu) /* 2e3e5aff7SYing-Chun Liu (PaulLiu) * Copyright (C) 2011 Freescale Semiconductor, Inc. All Rights Reserved. 3e3e5aff7SYing-Chun Liu (PaulLiu) */ 4e3e5aff7SYing-Chun Liu (PaulLiu) 5e3e5aff7SYing-Chun Liu (PaulLiu) /* 6e3e5aff7SYing-Chun Liu (PaulLiu) * This program is free software; you can redistribute it and/or modify 7e3e5aff7SYing-Chun Liu (PaulLiu) * it under the terms of the GNU General Public License as published by 8e3e5aff7SYing-Chun Liu (PaulLiu) * the Free Software Foundation; either version 2 of the License, or 9e3e5aff7SYing-Chun Liu (PaulLiu) * (at your option) any later version. 10e3e5aff7SYing-Chun Liu (PaulLiu) 11e3e5aff7SYing-Chun Liu (PaulLiu) * This program is distributed in the hope that it will be useful, 12e3e5aff7SYing-Chun Liu (PaulLiu) * but WITHOUT ANY WARRANTY; without even the implied warranty of 13e3e5aff7SYing-Chun Liu (PaulLiu) * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 14e3e5aff7SYing-Chun Liu (PaulLiu) * GNU General Public License for more details. 15e3e5aff7SYing-Chun Liu (PaulLiu) 16e3e5aff7SYing-Chun Liu (PaulLiu) * You should have received a copy of the GNU General Public License along 17e3e5aff7SYing-Chun Liu (PaulLiu) * with this program; if not, write to the Free Software Foundation, Inc., 18e3e5aff7SYing-Chun Liu (PaulLiu) * 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA. 19e3e5aff7SYing-Chun Liu (PaulLiu) */ 20e3e5aff7SYing-Chun Liu (PaulLiu) 21e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/slab.h> 22e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/device.h> 23e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/module.h> 24e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/err.h> 25e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/io.h> 26e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/platform_device.h> 27e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/of.h> 28e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/of_address.h> 29e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/mfd/anatop.h> 30e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/regulator/driver.h> 31e3e5aff7SYing-Chun Liu (PaulLiu) #include <linux/regulator/of_regulator.h> 32e3e5aff7SYing-Chun Liu (PaulLiu) 33e3e5aff7SYing-Chun Liu (PaulLiu) struct anatop_regulator { 34e3e5aff7SYing-Chun Liu (PaulLiu) const char *name; 35e3e5aff7SYing-Chun Liu (PaulLiu) u32 control_reg; 36e3e5aff7SYing-Chun Liu (PaulLiu) struct anatop *mfd; 37e3e5aff7SYing-Chun Liu (PaulLiu) int vol_bit_shift; 38e3e5aff7SYing-Chun Liu (PaulLiu) int vol_bit_width; 39e3e5aff7SYing-Chun Liu (PaulLiu) int min_bit_val; 40e3e5aff7SYing-Chun Liu (PaulLiu) int min_voltage; 41e3e5aff7SYing-Chun Liu (PaulLiu) int max_voltage; 42e3e5aff7SYing-Chun Liu (PaulLiu) struct regulator_desc rdesc; 43e3e5aff7SYing-Chun Liu (PaulLiu) struct regulator_init_data *initdata; 44e3e5aff7SYing-Chun Liu (PaulLiu) }; 45e3e5aff7SYing-Chun Liu (PaulLiu) 46e3e5aff7SYing-Chun Liu (PaulLiu) static int anatop_set_voltage(struct regulator_dev *reg, int min_uV, 47e3e5aff7SYing-Chun Liu (PaulLiu) int max_uV, unsigned *selector) 48e3e5aff7SYing-Chun Liu (PaulLiu) { 49e3e5aff7SYing-Chun Liu (PaulLiu) struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg); 50b09530efSRichard Zhao u32 val, sel, mask; 51e3e5aff7SYing-Chun Liu (PaulLiu) int uv; 52e3e5aff7SYing-Chun Liu (PaulLiu) 53e3e5aff7SYing-Chun Liu (PaulLiu) uv = min_uV; 54e3e5aff7SYing-Chun Liu (PaulLiu) dev_dbg(®->dev, "%s: uv %d, min %d, max %d\n", __func__, 55e3e5aff7SYing-Chun Liu (PaulLiu) uv, anatop_reg->min_voltage, 56e3e5aff7SYing-Chun Liu (PaulLiu) anatop_reg->max_voltage); 57e3e5aff7SYing-Chun Liu (PaulLiu) 58e3e5aff7SYing-Chun Liu (PaulLiu) if (uv < anatop_reg->min_voltage) { 59e3e5aff7SYing-Chun Liu (PaulLiu) if (max_uV > anatop_reg->min_voltage) 60e3e5aff7SYing-Chun Liu (PaulLiu) uv = anatop_reg->min_voltage; 61e3e5aff7SYing-Chun Liu (PaulLiu) else 62e3e5aff7SYing-Chun Liu (PaulLiu) return -EINVAL; 63e3e5aff7SYing-Chun Liu (PaulLiu) } 64e3e5aff7SYing-Chun Liu (PaulLiu) 65e3e5aff7SYing-Chun Liu (PaulLiu) if (!anatop_reg->control_reg) 66e3e5aff7SYing-Chun Liu (PaulLiu) return -ENOTSUPP; 67e3e5aff7SYing-Chun Liu (PaulLiu) 68e3e5aff7SYing-Chun Liu (PaulLiu) sel = DIV_ROUND_UP(uv - anatop_reg->min_voltage, 25000); 69e3e5aff7SYing-Chun Liu (PaulLiu) if (sel * 25000 + anatop_reg->min_voltage > anatop_reg->max_voltage) 70e3e5aff7SYing-Chun Liu (PaulLiu) return -EINVAL; 71e3e5aff7SYing-Chun Liu (PaulLiu) val = anatop_reg->min_bit_val + sel; 72e3e5aff7SYing-Chun Liu (PaulLiu) *selector = sel; 73e3e5aff7SYing-Chun Liu (PaulLiu) dev_dbg(®->dev, "%s: calculated val %d\n", __func__, val); 74b09530efSRichard Zhao mask = ((1 << anatop_reg->vol_bit_width) - 1) << 75b09530efSRichard Zhao anatop_reg->vol_bit_shift; 76b09530efSRichard Zhao val <<= anatop_reg->vol_bit_shift; 77b09530efSRichard Zhao anatop_write_reg(anatop_reg->mfd, anatop_reg->control_reg, val, mask); 78e3e5aff7SYing-Chun Liu (PaulLiu) 79e3e5aff7SYing-Chun Liu (PaulLiu) return 0; 80e3e5aff7SYing-Chun Liu (PaulLiu) } 81e3e5aff7SYing-Chun Liu (PaulLiu) 82e3e5aff7SYing-Chun Liu (PaulLiu) static int anatop_get_voltage_sel(struct regulator_dev *reg) 83e3e5aff7SYing-Chun Liu (PaulLiu) { 84e3e5aff7SYing-Chun Liu (PaulLiu) struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg); 85e3e5aff7SYing-Chun Liu (PaulLiu) u32 val; 86e3e5aff7SYing-Chun Liu (PaulLiu) 87e3e5aff7SYing-Chun Liu (PaulLiu) if (!anatop_reg->control_reg) 88e3e5aff7SYing-Chun Liu (PaulLiu) return -ENOTSUPP; 89e3e5aff7SYing-Chun Liu (PaulLiu) 90b09530efSRichard Zhao val = anatop_read_reg(anatop_reg->mfd, anatop_reg->control_reg); 91b09530efSRichard Zhao val = (val & ((1 << anatop_reg->vol_bit_width) - 1)) >> 92b09530efSRichard Zhao anatop_reg->vol_bit_shift; 93e3e5aff7SYing-Chun Liu (PaulLiu) 94e3e5aff7SYing-Chun Liu (PaulLiu) return val - anatop_reg->min_bit_val; 95e3e5aff7SYing-Chun Liu (PaulLiu) } 96e3e5aff7SYing-Chun Liu (PaulLiu) 97e3e5aff7SYing-Chun Liu (PaulLiu) static int anatop_list_voltage(struct regulator_dev *reg, unsigned selector) 98e3e5aff7SYing-Chun Liu (PaulLiu) { 99e3e5aff7SYing-Chun Liu (PaulLiu) struct anatop_regulator *anatop_reg = rdev_get_drvdata(reg); 100e3e5aff7SYing-Chun Liu (PaulLiu) int uv; 101e3e5aff7SYing-Chun Liu (PaulLiu) 102e3e5aff7SYing-Chun Liu (PaulLiu) uv = anatop_reg->min_voltage + selector * 25000; 103e3e5aff7SYing-Chun Liu (PaulLiu) dev_dbg(®->dev, "vddio = %d, selector = %u\n", uv, selector); 104e3e5aff7SYing-Chun Liu (PaulLiu) 105e3e5aff7SYing-Chun Liu (PaulLiu) return uv; 106e3e5aff7SYing-Chun Liu (PaulLiu) } 107e3e5aff7SYing-Chun Liu (PaulLiu) 108e3e5aff7SYing-Chun Liu (PaulLiu) static struct regulator_ops anatop_rops = { 109e3e5aff7SYing-Chun Liu (PaulLiu) .set_voltage = anatop_set_voltage, 110e3e5aff7SYing-Chun Liu (PaulLiu) .get_voltage_sel = anatop_get_voltage_sel, 111e3e5aff7SYing-Chun Liu (PaulLiu) .list_voltage = anatop_list_voltage, 112e3e5aff7SYing-Chun Liu (PaulLiu) }; 113e3e5aff7SYing-Chun Liu (PaulLiu) 114e3e5aff7SYing-Chun Liu (PaulLiu) static int __devinit anatop_regulator_probe(struct platform_device *pdev) 115e3e5aff7SYing-Chun Liu (PaulLiu) { 116e3e5aff7SYing-Chun Liu (PaulLiu) struct device *dev = &pdev->dev; 117e3e5aff7SYing-Chun Liu (PaulLiu) struct device_node *np = dev->of_node; 118e3e5aff7SYing-Chun Liu (PaulLiu) struct regulator_desc *rdesc; 119e3e5aff7SYing-Chun Liu (PaulLiu) struct regulator_dev *rdev; 120e3e5aff7SYing-Chun Liu (PaulLiu) struct anatop_regulator *sreg; 121e3e5aff7SYing-Chun Liu (PaulLiu) struct regulator_init_data *initdata; 122e3e5aff7SYing-Chun Liu (PaulLiu) struct anatop *anatopmfd = dev_get_drvdata(pdev->dev.parent); 123d914d81bSAxel Lin struct regulator_config config = { }; 124e3e5aff7SYing-Chun Liu (PaulLiu) int ret = 0; 125e3e5aff7SYing-Chun Liu (PaulLiu) 126e3e5aff7SYing-Chun Liu (PaulLiu) initdata = of_get_regulator_init_data(dev, np); 127e3e5aff7SYing-Chun Liu (PaulLiu) sreg = devm_kzalloc(dev, sizeof(*sreg), GFP_KERNEL); 128e3e5aff7SYing-Chun Liu (PaulLiu) if (!sreg) 129e3e5aff7SYing-Chun Liu (PaulLiu) return -ENOMEM; 130e3e5aff7SYing-Chun Liu (PaulLiu) sreg->initdata = initdata; 131e3e5aff7SYing-Chun Liu (PaulLiu) sreg->name = kstrdup(of_get_property(np, "regulator-name", NULL), 132e3e5aff7SYing-Chun Liu (PaulLiu) GFP_KERNEL); 133e3e5aff7SYing-Chun Liu (PaulLiu) rdesc = &sreg->rdesc; 134e3e5aff7SYing-Chun Liu (PaulLiu) memset(rdesc, 0, sizeof(*rdesc)); 135e3e5aff7SYing-Chun Liu (PaulLiu) rdesc->name = sreg->name; 136e3e5aff7SYing-Chun Liu (PaulLiu) rdesc->ops = &anatop_rops; 137e3e5aff7SYing-Chun Liu (PaulLiu) rdesc->type = REGULATOR_VOLTAGE; 138e3e5aff7SYing-Chun Liu (PaulLiu) rdesc->owner = THIS_MODULE; 139e3e5aff7SYing-Chun Liu (PaulLiu) sreg->mfd = anatopmfd; 1402f2cc27fSYing-Chun Liu (PaulLiu) ret = of_property_read_u32(np, "anatop-reg-offset", 1412f2cc27fSYing-Chun Liu (PaulLiu) &sreg->control_reg); 142e3e5aff7SYing-Chun Liu (PaulLiu) if (ret) { 1432f2cc27fSYing-Chun Liu (PaulLiu) dev_err(dev, "no anatop-reg-offset property set\n"); 144e3e5aff7SYing-Chun Liu (PaulLiu) goto anatop_probe_end; 145e3e5aff7SYing-Chun Liu (PaulLiu) } 146e3e5aff7SYing-Chun Liu (PaulLiu) ret = of_property_read_u32(np, "anatop-vol-bit-width", 147e3e5aff7SYing-Chun Liu (PaulLiu) &sreg->vol_bit_width); 148e3e5aff7SYing-Chun Liu (PaulLiu) if (ret) { 149e3e5aff7SYing-Chun Liu (PaulLiu) dev_err(dev, "no anatop-vol-bit-width property set\n"); 150e3e5aff7SYing-Chun Liu (PaulLiu) goto anatop_probe_end; 151e3e5aff7SYing-Chun Liu (PaulLiu) } 152e3e5aff7SYing-Chun Liu (PaulLiu) ret = of_property_read_u32(np, "anatop-vol-bit-shift", 153e3e5aff7SYing-Chun Liu (PaulLiu) &sreg->vol_bit_shift); 154e3e5aff7SYing-Chun Liu (PaulLiu) if (ret) { 155e3e5aff7SYing-Chun Liu (PaulLiu) dev_err(dev, "no anatop-vol-bit-shift property set\n"); 156e3e5aff7SYing-Chun Liu (PaulLiu) goto anatop_probe_end; 157e3e5aff7SYing-Chun Liu (PaulLiu) } 158e3e5aff7SYing-Chun Liu (PaulLiu) ret = of_property_read_u32(np, "anatop-min-bit-val", 159e3e5aff7SYing-Chun Liu (PaulLiu) &sreg->min_bit_val); 160e3e5aff7SYing-Chun Liu (PaulLiu) if (ret) { 161e3e5aff7SYing-Chun Liu (PaulLiu) dev_err(dev, "no anatop-min-bit-val property set\n"); 162e3e5aff7SYing-Chun Liu (PaulLiu) goto anatop_probe_end; 163e3e5aff7SYing-Chun Liu (PaulLiu) } 164e3e5aff7SYing-Chun Liu (PaulLiu) ret = of_property_read_u32(np, "anatop-min-voltage", 165e3e5aff7SYing-Chun Liu (PaulLiu) &sreg->min_voltage); 166e3e5aff7SYing-Chun Liu (PaulLiu) if (ret) { 167e3e5aff7SYing-Chun Liu (PaulLiu) dev_err(dev, "no anatop-min-voltage property set\n"); 168e3e5aff7SYing-Chun Liu (PaulLiu) goto anatop_probe_end; 169e3e5aff7SYing-Chun Liu (PaulLiu) } 170e3e5aff7SYing-Chun Liu (PaulLiu) ret = of_property_read_u32(np, "anatop-max-voltage", 171e3e5aff7SYing-Chun Liu (PaulLiu) &sreg->max_voltage); 172e3e5aff7SYing-Chun Liu (PaulLiu) if (ret) { 173e3e5aff7SYing-Chun Liu (PaulLiu) dev_err(dev, "no anatop-max-voltage property set\n"); 174e3e5aff7SYing-Chun Liu (PaulLiu) goto anatop_probe_end; 175e3e5aff7SYing-Chun Liu (PaulLiu) } 176e3e5aff7SYing-Chun Liu (PaulLiu) 177e3e5aff7SYing-Chun Liu (PaulLiu) rdesc->n_voltages = (sreg->max_voltage - sreg->min_voltage) 178e3e5aff7SYing-Chun Liu (PaulLiu) / 25000 + 1; 179e3e5aff7SYing-Chun Liu (PaulLiu) 180d914d81bSAxel Lin config.dev = &pdev->dev; 181d914d81bSAxel Lin config.init_data = initdata; 182d914d81bSAxel Lin config.driver_data = sreg; 183d914d81bSAxel Lin config.of_node = pdev->dev.of_node; 184d914d81bSAxel Lin 185e3e5aff7SYing-Chun Liu (PaulLiu) /* register regulator */ 186d914d81bSAxel Lin rdev = regulator_register(rdesc, &config); 187e3e5aff7SYing-Chun Liu (PaulLiu) if (IS_ERR(rdev)) { 188e3e5aff7SYing-Chun Liu (PaulLiu) dev_err(dev, "failed to register %s\n", 189e3e5aff7SYing-Chun Liu (PaulLiu) rdesc->name); 190e3e5aff7SYing-Chun Liu (PaulLiu) ret = PTR_ERR(rdev); 191e3e5aff7SYing-Chun Liu (PaulLiu) goto anatop_probe_end; 192e3e5aff7SYing-Chun Liu (PaulLiu) } 193e3e5aff7SYing-Chun Liu (PaulLiu) 194e3e5aff7SYing-Chun Liu (PaulLiu) platform_set_drvdata(pdev, rdev); 195e3e5aff7SYing-Chun Liu (PaulLiu) 196e3e5aff7SYing-Chun Liu (PaulLiu) anatop_probe_end: 197e3e5aff7SYing-Chun Liu (PaulLiu) if (ret) 198e3e5aff7SYing-Chun Liu (PaulLiu) kfree(sreg->name); 199e3e5aff7SYing-Chun Liu (PaulLiu) 200e3e5aff7SYing-Chun Liu (PaulLiu) return ret; 201e3e5aff7SYing-Chun Liu (PaulLiu) } 202e3e5aff7SYing-Chun Liu (PaulLiu) 203e3e5aff7SYing-Chun Liu (PaulLiu) static int __devexit anatop_regulator_remove(struct platform_device *pdev) 204e3e5aff7SYing-Chun Liu (PaulLiu) { 205e3e5aff7SYing-Chun Liu (PaulLiu) struct regulator_dev *rdev = platform_get_drvdata(pdev); 206e3e5aff7SYing-Chun Liu (PaulLiu) struct anatop_regulator *sreg = rdev_get_drvdata(rdev); 207e3e5aff7SYing-Chun Liu (PaulLiu) const char *name = sreg->name; 208e3e5aff7SYing-Chun Liu (PaulLiu) 209e3e5aff7SYing-Chun Liu (PaulLiu) regulator_unregister(rdev); 210e3e5aff7SYing-Chun Liu (PaulLiu) kfree(name); 211e3e5aff7SYing-Chun Liu (PaulLiu) 212e3e5aff7SYing-Chun Liu (PaulLiu) return 0; 213e3e5aff7SYing-Chun Liu (PaulLiu) } 214e3e5aff7SYing-Chun Liu (PaulLiu) 215e3e5aff7SYing-Chun Liu (PaulLiu) static struct of_device_id __devinitdata of_anatop_regulator_match_tbl[] = { 216e3e5aff7SYing-Chun Liu (PaulLiu) { .compatible = "fsl,anatop-regulator", }, 217e3e5aff7SYing-Chun Liu (PaulLiu) { /* end */ } 218e3e5aff7SYing-Chun Liu (PaulLiu) }; 219e3e5aff7SYing-Chun Liu (PaulLiu) 220c0d78c23SShawn Guo static struct platform_driver anatop_regulator_driver = { 221e3e5aff7SYing-Chun Liu (PaulLiu) .driver = { 222e3e5aff7SYing-Chun Liu (PaulLiu) .name = "anatop_regulator", 223e3e5aff7SYing-Chun Liu (PaulLiu) .owner = THIS_MODULE, 224e3e5aff7SYing-Chun Liu (PaulLiu) .of_match_table = of_anatop_regulator_match_tbl, 225e3e5aff7SYing-Chun Liu (PaulLiu) }, 226e3e5aff7SYing-Chun Liu (PaulLiu) .probe = anatop_regulator_probe, 2270c09d315SAxel Lin .remove = __devexit_p(anatop_regulator_remove), 228e3e5aff7SYing-Chun Liu (PaulLiu) }; 229e3e5aff7SYing-Chun Liu (PaulLiu) 230e3e5aff7SYing-Chun Liu (PaulLiu) static int __init anatop_regulator_init(void) 231e3e5aff7SYing-Chun Liu (PaulLiu) { 232c0d78c23SShawn Guo return platform_driver_register(&anatop_regulator_driver); 233e3e5aff7SYing-Chun Liu (PaulLiu) } 234e3e5aff7SYing-Chun Liu (PaulLiu) postcore_initcall(anatop_regulator_init); 235e3e5aff7SYing-Chun Liu (PaulLiu) 236e3e5aff7SYing-Chun Liu (PaulLiu) static void __exit anatop_regulator_exit(void) 237e3e5aff7SYing-Chun Liu (PaulLiu) { 238c0d78c23SShawn Guo platform_driver_unregister(&anatop_regulator_driver); 239e3e5aff7SYing-Chun Liu (PaulLiu) } 240e3e5aff7SYing-Chun Liu (PaulLiu) module_exit(anatop_regulator_exit); 241e3e5aff7SYing-Chun Liu (PaulLiu) 242e3e5aff7SYing-Chun Liu (PaulLiu) MODULE_AUTHOR("Nancy Chen <Nancy.Chen@freescale.com>, " 243e3e5aff7SYing-Chun Liu (PaulLiu) "Ying-Chun Liu (PaulLiu) <paul.liu@linaro.org>"); 244e3e5aff7SYing-Chun Liu (PaulLiu) MODULE_DESCRIPTION("ANATOP Regulator driver"); 245e3e5aff7SYing-Chun Liu (PaulLiu) MODULE_LICENSE("GPL v2"); 246