| Linus Walleij | 3615a34 | 2013-09-13 21:01:15 +0200 | [diff] [blame] | 1 | /* |
| 2 | * Regulator driver for STw4810/STw4811 VMMC regulator. |
| 3 | * |
| 4 | * Copyright (C) 2013 ST-Ericsson SA |
| 5 | * Written on behalf of Linaro for ST-Ericsson |
| 6 | * |
| 7 | * Author: Linus Walleij <linus.walleij@linaro.org> |
| 8 | * |
| 9 | * License terms: GNU General Public License (GPL) version 2 |
| 10 | */ |
| 11 | |
| 12 | #include <linux/err.h> |
| 13 | #include <linux/init.h> |
| 14 | #include <linux/mfd/stw481x.h> |
| 15 | #include <linux/module.h> |
| 16 | #include <linux/platform_device.h> |
| 17 | #include <linux/regulator/driver.h> |
| 18 | #include <linux/regulator/of_regulator.h> |
| 19 | |
| 20 | static const unsigned int stw481x_vmmc_voltages[] = { |
| 21 | 1800000, |
| 22 | 1800000, |
| 23 | 2850000, |
| 24 | 3000000, |
| 25 | 1850000, |
| 26 | 2600000, |
| 27 | 2700000, |
| 28 | 3300000, |
| 29 | }; |
| 30 | |
| 31 | static struct regulator_ops stw481x_vmmc_ops = { |
| 32 | .list_voltage = regulator_list_voltage_table, |
| 33 | .enable = regulator_enable_regmap, |
| 34 | .disable = regulator_disable_regmap, |
| 35 | .is_enabled = regulator_is_enabled_regmap, |
| 36 | .get_voltage_sel = regulator_get_voltage_sel_regmap, |
| 37 | .set_voltage_sel = regulator_set_voltage_sel_regmap, |
| 38 | }; |
| 39 | |
| 40 | static struct regulator_desc vmmc_regulator = { |
| 41 | .name = "VMMC", |
| 42 | .id = 0, |
| 43 | .ops = &stw481x_vmmc_ops, |
| 44 | .type = REGULATOR_VOLTAGE, |
| 45 | .owner = THIS_MODULE, |
| 46 | .n_voltages = ARRAY_SIZE(stw481x_vmmc_voltages), |
| 47 | .volt_table = stw481x_vmmc_voltages, |
| 48 | .enable_time = 200, /* FIXME: look this up */ |
| 49 | .enable_reg = STW_CONF1, |
| 50 | .enable_mask = STW_CONF1_PDN_VMMC, |
| 51 | .vsel_reg = STW_CONF1, |
| 52 | .vsel_mask = STW_CONF1_VMMC_MASK, |
| 53 | }; |
| 54 | |
| 55 | static int stw481x_vmmc_regulator_probe(struct platform_device *pdev) |
| 56 | { |
| 57 | struct stw481x *stw481x = dev_get_platdata(&pdev->dev); |
| 58 | struct regulator_config config = { }; |
| 59 | int ret; |
| 60 | |
| 61 | /* First disable the external VMMC if it's active */ |
| 62 | ret = regmap_update_bits(stw481x->map, STW_CONF2, |
| 63 | STW_CONF2_VMMC_EXT, 0); |
| 64 | if (ret) { |
| 65 | dev_err(&pdev->dev, "could not disable external VMMC\n"); |
| 66 | return ret; |
| 67 | } |
| 68 | |
| 69 | /* Register VMMC regulator */ |
| 70 | config.dev = &pdev->dev; |
| 71 | config.driver_data = stw481x; |
| 72 | config.regmap = stw481x->map; |
| 73 | config.of_node = pdev->dev.of_node; |
| 74 | config.init_data = of_get_regulator_init_data(&pdev->dev, |
| 75 | pdev->dev.of_node); |
| 76 | |
| 77 | stw481x->vmmc_regulator = regulator_register(&vmmc_regulator, &config); |
| 78 | if (IS_ERR(stw481x->vmmc_regulator)) { |
| 79 | dev_err(&pdev->dev, |
| 80 | "error initializing STw481x VMMC regulator\n"); |
| 81 | return PTR_ERR(stw481x->vmmc_regulator); |
| 82 | } |
| 83 | |
| 84 | dev_info(&pdev->dev, "initialized STw481x VMMC regulator\n"); |
| 85 | return 0; |
| 86 | } |
| 87 | |
| 88 | static int stw481x_vmmc_regulator_remove(struct platform_device *pdev) |
| 89 | { |
| 90 | struct stw481x *stw481x = dev_get_platdata(&pdev->dev); |
| 91 | |
| 92 | regulator_unregister(stw481x->vmmc_regulator); |
| 93 | return 0; |
| 94 | } |
| 95 | |
| 96 | static const struct of_device_id stw481x_vmmc_match[] = { |
| 97 | { .compatible = "st,stw481x-vmmc", }, |
| 98 | {}, |
| 99 | }; |
| 100 | |
| 101 | static struct platform_driver stw481x_vmmc_regulator_driver = { |
| 102 | .driver = { |
| 103 | .name = "stw481x-vmmc-regulator", |
| 104 | .owner = THIS_MODULE, |
| Axel Lin | 18dca93 | 2013-10-02 20:54:20 +0800 | [diff] [blame] | 105 | .of_match_table = stw481x_vmmc_match, |
| Linus Walleij | 3615a34 | 2013-09-13 21:01:15 +0200 | [diff] [blame] | 106 | }, |
| 107 | .probe = stw481x_vmmc_regulator_probe, |
| 108 | .remove = stw481x_vmmc_regulator_remove, |
| 109 | }; |
| 110 | |
| 111 | module_platform_driver(stw481x_vmmc_regulator_driver); |