1d4d6b722SMark Brown /* 2d4d6b722SMark Brown * wm831x-isink.c -- Current sink driver for the WM831x series 3d4d6b722SMark Brown * 4d4d6b722SMark Brown * Copyright 2009 Wolfson Microelectronics PLC. 5d4d6b722SMark Brown * 6d4d6b722SMark Brown * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> 7d4d6b722SMark Brown * 8d4d6b722SMark Brown * This program is free software; you can redistribute it and/or modify it 9d4d6b722SMark Brown * under the terms of the GNU General Public License as published by the 10d4d6b722SMark Brown * Free Software Foundation; either version 2 of the License, or (at your 11d4d6b722SMark Brown * option) any later version. 12d4d6b722SMark Brown */ 13d4d6b722SMark Brown 14d4d6b722SMark Brown #include <linux/module.h> 15d4d6b722SMark Brown #include <linux/moduleparam.h> 16d4d6b722SMark Brown #include <linux/init.h> 17d4d6b722SMark Brown #include <linux/bitops.h> 18d4d6b722SMark Brown #include <linux/err.h> 19d4d6b722SMark Brown #include <linux/i2c.h> 20d4d6b722SMark Brown #include <linux/platform_device.h> 21d4d6b722SMark Brown #include <linux/regulator/driver.h> 225a0e3ad6STejun Heo #include <linux/slab.h> 23d4d6b722SMark Brown 24d4d6b722SMark Brown #include <linux/mfd/wm831x/core.h> 25d4d6b722SMark Brown #include <linux/mfd/wm831x/regulator.h> 26d4d6b722SMark Brown #include <linux/mfd/wm831x/pdata.h> 27d4d6b722SMark Brown 28d4d6b722SMark Brown #define WM831X_ISINK_MAX_NAME 7 29d4d6b722SMark Brown 30d4d6b722SMark Brown struct wm831x_isink { 31d4d6b722SMark Brown char name[WM831X_ISINK_MAX_NAME]; 32d4d6b722SMark Brown struct regulator_desc desc; 33d4d6b722SMark Brown int reg; 34d4d6b722SMark Brown struct wm831x *wm831x; 35d4d6b722SMark Brown struct regulator_dev *regulator; 36d4d6b722SMark Brown }; 37d4d6b722SMark Brown 38d4d6b722SMark Brown static int wm831x_isink_enable(struct regulator_dev *rdev) 39d4d6b722SMark Brown { 40d4d6b722SMark Brown struct wm831x_isink *isink = rdev_get_drvdata(rdev); 41d4d6b722SMark Brown struct wm831x *wm831x = isink->wm831x; 42d4d6b722SMark Brown int ret; 43d4d6b722SMark Brown 44d4d6b722SMark Brown /* We have a two stage enable: first start the ISINK... */ 45d4d6b722SMark Brown ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_ENA, 46d4d6b722SMark Brown WM831X_CS1_ENA); 47d4d6b722SMark Brown if (ret != 0) 48d4d6b722SMark Brown return ret; 49d4d6b722SMark Brown 50d4d6b722SMark Brown /* ...then enable drive */ 51d4d6b722SMark Brown ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_DRIVE, 52d4d6b722SMark Brown WM831X_CS1_DRIVE); 53d4d6b722SMark Brown if (ret != 0) 54d4d6b722SMark Brown wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_ENA, 0); 55d4d6b722SMark Brown 56d4d6b722SMark Brown return ret; 57d4d6b722SMark Brown 58d4d6b722SMark Brown } 59d4d6b722SMark Brown 60d4d6b722SMark Brown static int wm831x_isink_disable(struct regulator_dev *rdev) 61d4d6b722SMark Brown { 62d4d6b722SMark Brown struct wm831x_isink *isink = rdev_get_drvdata(rdev); 63d4d6b722SMark Brown struct wm831x *wm831x = isink->wm831x; 64d4d6b722SMark Brown int ret; 65d4d6b722SMark Brown 66d4d6b722SMark Brown ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_DRIVE, 0); 67d4d6b722SMark Brown if (ret < 0) 68d4d6b722SMark Brown return ret; 69d4d6b722SMark Brown 70d4d6b722SMark Brown ret = wm831x_set_bits(wm831x, isink->reg, WM831X_CS1_ENA, 0); 71d4d6b722SMark Brown if (ret < 0) 72d4d6b722SMark Brown return ret; 73d4d6b722SMark Brown 74d4d6b722SMark Brown return ret; 75d4d6b722SMark Brown 76d4d6b722SMark Brown } 77d4d6b722SMark Brown 78d4d6b722SMark Brown static int wm831x_isink_is_enabled(struct regulator_dev *rdev) 79d4d6b722SMark Brown { 80d4d6b722SMark Brown struct wm831x_isink *isink = rdev_get_drvdata(rdev); 81d4d6b722SMark Brown struct wm831x *wm831x = isink->wm831x; 82d4d6b722SMark Brown int ret; 83d4d6b722SMark Brown 84d4d6b722SMark Brown ret = wm831x_reg_read(wm831x, isink->reg); 85d4d6b722SMark Brown if (ret < 0) 86d4d6b722SMark Brown return ret; 87d4d6b722SMark Brown 88d4d6b722SMark Brown if ((ret & (WM831X_CS1_ENA | WM831X_CS1_DRIVE)) == 89d4d6b722SMark Brown (WM831X_CS1_ENA | WM831X_CS1_DRIVE)) 90d4d6b722SMark Brown return 1; 91d4d6b722SMark Brown else 92d4d6b722SMark Brown return 0; 93d4d6b722SMark Brown } 94d4d6b722SMark Brown 95d4d6b722SMark Brown static int wm831x_isink_set_current(struct regulator_dev *rdev, 96d4d6b722SMark Brown int min_uA, int max_uA) 97d4d6b722SMark Brown { 98d4d6b722SMark Brown struct wm831x_isink *isink = rdev_get_drvdata(rdev); 99d4d6b722SMark Brown struct wm831x *wm831x = isink->wm831x; 100d4d6b722SMark Brown int ret, i; 101d4d6b722SMark Brown 102d4d6b722SMark Brown for (i = 0; i < ARRAY_SIZE(wm831x_isinkv_values); i++) { 103d4d6b722SMark Brown int val = wm831x_isinkv_values[i]; 104ed3be9a0SAxel Lin if (min_uA <= val && val <= max_uA) { 105d4d6b722SMark Brown ret = wm831x_set_bits(wm831x, isink->reg, 106d4d6b722SMark Brown WM831X_CS1_ISEL_MASK, i); 107d4d6b722SMark Brown return ret; 108d4d6b722SMark Brown } 109d4d6b722SMark Brown } 110d4d6b722SMark Brown 111d4d6b722SMark Brown return -EINVAL; 112d4d6b722SMark Brown } 113d4d6b722SMark Brown 114d4d6b722SMark Brown static int wm831x_isink_get_current(struct regulator_dev *rdev) 115d4d6b722SMark Brown { 116d4d6b722SMark Brown struct wm831x_isink *isink = rdev_get_drvdata(rdev); 117d4d6b722SMark Brown struct wm831x *wm831x = isink->wm831x; 118d4d6b722SMark Brown int ret; 119d4d6b722SMark Brown 120d4d6b722SMark Brown ret = wm831x_reg_read(wm831x, isink->reg); 121d4d6b722SMark Brown if (ret < 0) 122d4d6b722SMark Brown return ret; 123d4d6b722SMark Brown 124d4d6b722SMark Brown ret &= WM831X_CS1_ISEL_MASK; 125d4d6b722SMark Brown if (ret > WM831X_ISINK_MAX_ISEL) 126d4d6b722SMark Brown ret = WM831X_ISINK_MAX_ISEL; 127d4d6b722SMark Brown 128d4d6b722SMark Brown return wm831x_isinkv_values[ret]; 129d4d6b722SMark Brown } 130d4d6b722SMark Brown 131d4d6b722SMark Brown static struct regulator_ops wm831x_isink_ops = { 132d4d6b722SMark Brown .is_enabled = wm831x_isink_is_enabled, 133d4d6b722SMark Brown .enable = wm831x_isink_enable, 134d4d6b722SMark Brown .disable = wm831x_isink_disable, 135d4d6b722SMark Brown .set_current_limit = wm831x_isink_set_current, 136d4d6b722SMark Brown .get_current_limit = wm831x_isink_get_current, 137d4d6b722SMark Brown }; 138d4d6b722SMark Brown 139d4d6b722SMark Brown static irqreturn_t wm831x_isink_irq(int irq, void *data) 140d4d6b722SMark Brown { 141d4d6b722SMark Brown struct wm831x_isink *isink = data; 142d4d6b722SMark Brown 143d4d6b722SMark Brown regulator_notifier_call_chain(isink->regulator, 144d4d6b722SMark Brown REGULATOR_EVENT_OVER_CURRENT, 145d4d6b722SMark Brown NULL); 146d4d6b722SMark Brown 147d4d6b722SMark Brown return IRQ_HANDLED; 148d4d6b722SMark Brown } 149d4d6b722SMark Brown 150d4d6b722SMark Brown 151d4d6b722SMark Brown static __devinit int wm831x_isink_probe(struct platform_device *pdev) 152d4d6b722SMark Brown { 153d4d6b722SMark Brown struct wm831x *wm831x = dev_get_drvdata(pdev->dev.parent); 154d4d6b722SMark Brown struct wm831x_pdata *pdata = wm831x->dev->platform_data; 155d4d6b722SMark Brown struct wm831x_isink *isink; 156d4d6b722SMark Brown int id = pdev->id % ARRAY_SIZE(pdata->isink); 157c172708dSMark Brown struct regulator_config config = { }; 158d4d6b722SMark Brown struct resource *res; 159d4d6b722SMark Brown int ret, irq; 160d4d6b722SMark Brown 161d4d6b722SMark Brown dev_dbg(&pdev->dev, "Probing ISINK%d\n", id + 1); 162d4d6b722SMark Brown 163d4d6b722SMark Brown if (pdata == NULL || pdata->isink[id] == NULL) 164d4d6b722SMark Brown return -ENODEV; 165d4d6b722SMark Brown 166fded2f4fSMark Brown isink = devm_kzalloc(&pdev->dev, sizeof(struct wm831x_isink), 167fded2f4fSMark Brown GFP_KERNEL); 168d4d6b722SMark Brown if (isink == NULL) { 169d4d6b722SMark Brown dev_err(&pdev->dev, "Unable to allocate private data\n"); 170d4d6b722SMark Brown return -ENOMEM; 171d4d6b722SMark Brown } 172d4d6b722SMark Brown 173e8092da9SMark Brown isink->wm831x = wm831x; 174e8092da9SMark Brown 1755656098eSMark Brown res = platform_get_resource(pdev, IORESOURCE_REG, 0); 176d4d6b722SMark Brown if (res == NULL) { 1775656098eSMark Brown dev_err(&pdev->dev, "No REG resource\n"); 178d4d6b722SMark Brown ret = -EINVAL; 179d4d6b722SMark Brown goto err; 180d4d6b722SMark Brown } 181d4d6b722SMark Brown isink->reg = res->start; 182d4d6b722SMark Brown 183d4d6b722SMark Brown /* For current parts this is correct; probably need to revisit 184d4d6b722SMark Brown * in future. 185d4d6b722SMark Brown */ 186d4d6b722SMark Brown snprintf(isink->name, sizeof(isink->name), "ISINK%d", id + 1); 187d4d6b722SMark Brown isink->desc.name = isink->name; 188d4d6b722SMark Brown isink->desc.id = id; 189d4d6b722SMark Brown isink->desc.ops = &wm831x_isink_ops; 190d4d6b722SMark Brown isink->desc.type = REGULATOR_CURRENT; 191d4d6b722SMark Brown isink->desc.owner = THIS_MODULE; 192d4d6b722SMark Brown 193c172708dSMark Brown config.dev = pdev->dev.parent; 194c172708dSMark Brown config.init_data = pdata->isink[id]; 195c172708dSMark Brown config.driver_data = isink; 196c172708dSMark Brown 197c172708dSMark Brown isink->regulator = regulator_register(&isink->desc, &config); 198d4d6b722SMark Brown if (IS_ERR(isink->regulator)) { 199d4d6b722SMark Brown ret = PTR_ERR(isink->regulator); 200d4d6b722SMark Brown dev_err(wm831x->dev, "Failed to register ISINK%d: %d\n", 201d4d6b722SMark Brown id + 1, ret); 202d4d6b722SMark Brown goto err; 203d4d6b722SMark Brown } 204d4d6b722SMark Brown 205cd99758bSMark Brown irq = wm831x_irq(wm831x, platform_get_irq(pdev, 0)); 206dfda9c27SMark Brown ret = request_threaded_irq(irq, NULL, wm831x_isink_irq, 207dfda9c27SMark Brown IRQF_TRIGGER_RISING, isink->name, isink); 208d4d6b722SMark Brown if (ret != 0) { 209d4d6b722SMark Brown dev_err(&pdev->dev, "Failed to request ISINK IRQ %d: %d\n", 210d4d6b722SMark Brown irq, ret); 211d4d6b722SMark Brown goto err_regulator; 212d4d6b722SMark Brown } 213d4d6b722SMark Brown 214d4d6b722SMark Brown platform_set_drvdata(pdev, isink); 215d4d6b722SMark Brown 216d4d6b722SMark Brown return 0; 217d4d6b722SMark Brown 218d4d6b722SMark Brown err_regulator: 219d4d6b722SMark Brown regulator_unregister(isink->regulator); 220d4d6b722SMark Brown err: 221d4d6b722SMark Brown return ret; 222d4d6b722SMark Brown } 223d4d6b722SMark Brown 224d4d6b722SMark Brown static __devexit int wm831x_isink_remove(struct platform_device *pdev) 225d4d6b722SMark Brown { 226d4d6b722SMark Brown struct wm831x_isink *isink = platform_get_drvdata(pdev); 227d4d6b722SMark Brown 228eb66d565SDmitry Torokhov platform_set_drvdata(pdev, NULL); 229eb66d565SDmitry Torokhov 230cd99758bSMark Brown free_irq(wm831x_irq(isink->wm831x, platform_get_irq(pdev, 0)), isink); 231d4d6b722SMark Brown 232d4d6b722SMark Brown regulator_unregister(isink->regulator); 233d4d6b722SMark Brown 234d4d6b722SMark Brown return 0; 235d4d6b722SMark Brown } 236d4d6b722SMark Brown 237d4d6b722SMark Brown static struct platform_driver wm831x_isink_driver = { 238d4d6b722SMark Brown .probe = wm831x_isink_probe, 239d4d6b722SMark Brown .remove = __devexit_p(wm831x_isink_remove), 240d4d6b722SMark Brown .driver = { 241d4d6b722SMark Brown .name = "wm831x-isink", 242eb66d565SDmitry Torokhov .owner = THIS_MODULE, 243d4d6b722SMark Brown }, 244d4d6b722SMark Brown }; 245d4d6b722SMark Brown 246d4d6b722SMark Brown static int __init wm831x_isink_init(void) 247d4d6b722SMark Brown { 248d4d6b722SMark Brown int ret; 249d4d6b722SMark Brown ret = platform_driver_register(&wm831x_isink_driver); 250d4d6b722SMark Brown if (ret != 0) 251d4d6b722SMark Brown pr_err("Failed to register WM831x ISINK driver: %d\n", ret); 252d4d6b722SMark Brown 253d4d6b722SMark Brown return ret; 254d4d6b722SMark Brown } 255d4d6b722SMark Brown subsys_initcall(wm831x_isink_init); 256d4d6b722SMark Brown 257d4d6b722SMark Brown static void __exit wm831x_isink_exit(void) 258d4d6b722SMark Brown { 259d4d6b722SMark Brown platform_driver_unregister(&wm831x_isink_driver); 260d4d6b722SMark Brown } 261d4d6b722SMark Brown module_exit(wm831x_isink_exit); 262d4d6b722SMark Brown 263d4d6b722SMark Brown /* Module information */ 264d4d6b722SMark Brown MODULE_AUTHOR("Mark Brown"); 265d4d6b722SMark Brown MODULE_DESCRIPTION("WM831x current sink driver"); 266d4d6b722SMark Brown MODULE_LICENSE("GPL"); 267d4d6b722SMark Brown MODULE_ALIAS("platform:wm831x-isink"); 268