1 /* 2 * arizona-micsupp.c -- Microphone supply for Arizona devices 3 * 4 * Copyright 2012 Wolfson Microelectronics PLC. 5 * 6 * Author: Mark Brown <broonie@opensource.wolfsonmicro.com> 7 * 8 * This program is free software; you can redistribute it and/or modify it 9 * under the terms of the GNU General Public License as published by the 10 * Free Software Foundation; either version 2 of the License, or (at your 11 * option) any later version. 12 */ 13 14 #include <linux/module.h> 15 #include <linux/moduleparam.h> 16 #include <linux/init.h> 17 #include <linux/bitops.h> 18 #include <linux/err.h> 19 #include <linux/platform_device.h> 20 #include <linux/regulator/driver.h> 21 #include <linux/regulator/machine.h> 22 #include <linux/gpio.h> 23 #include <linux/slab.h> 24 25 #include <linux/mfd/arizona/core.h> 26 #include <linux/mfd/arizona/pdata.h> 27 #include <linux/mfd/arizona/registers.h> 28 29 #define ARIZONA_MICSUPP_MAX_SELECTOR 0x1f 30 31 struct arizona_micsupp { 32 struct regulator_dev *regulator; 33 struct arizona *arizona; 34 35 struct regulator_consumer_supply supply; 36 struct regulator_init_data init_data; 37 }; 38 39 static int arizona_micsupp_list_voltage(struct regulator_dev *rdev, 40 unsigned int selector) 41 { 42 if (selector > ARIZONA_MICSUPP_MAX_SELECTOR) 43 return -EINVAL; 44 45 if (selector == ARIZONA_MICSUPP_MAX_SELECTOR) 46 return 3300000; 47 else 48 return (selector * 50000) + 1700000; 49 } 50 51 static int arizona_micsupp_map_voltage(struct regulator_dev *rdev, 52 int min_uV, int max_uV) 53 { 54 unsigned int voltage; 55 int selector; 56 57 if (min_uV < 1700000) 58 min_uV = 1700000; 59 60 if (min_uV > 3200000) 61 selector = ARIZONA_MICSUPP_MAX_SELECTOR; 62 else 63 selector = DIV_ROUND_UP(min_uV - 1700000, 50000); 64 65 if (selector < 0) 66 return -EINVAL; 67 68 voltage = arizona_micsupp_list_voltage(rdev, selector); 69 if (voltage < min_uV || voltage > max_uV) 70 return -EINVAL; 71 72 return selector; 73 } 74 75 static struct regulator_ops arizona_micsupp_ops = { 76 .enable = regulator_enable_regmap, 77 .disable = regulator_disable_regmap, 78 .is_enabled = regulator_is_enabled_regmap, 79 80 .list_voltage = arizona_micsupp_list_voltage, 81 .map_voltage = arizona_micsupp_map_voltage, 82 83 .get_voltage_sel = regulator_get_voltage_sel_regmap, 84 .set_voltage_sel = regulator_set_voltage_sel_regmap, 85 86 .get_bypass = regulator_get_bypass_regmap, 87 .set_bypass = regulator_set_bypass_regmap, 88 }; 89 90 static const struct regulator_desc arizona_micsupp = { 91 .name = "MICVDD", 92 .supply_name = "CPVDD", 93 .type = REGULATOR_VOLTAGE, 94 .n_voltages = ARIZONA_MICSUPP_MAX_SELECTOR + 1, 95 .ops = &arizona_micsupp_ops, 96 97 .vsel_reg = ARIZONA_LDO2_CONTROL_1, 98 .vsel_mask = ARIZONA_LDO2_VSEL_MASK, 99 .enable_reg = ARIZONA_MIC_CHARGE_PUMP_1, 100 .enable_mask = ARIZONA_CPMIC_ENA, 101 .bypass_reg = ARIZONA_MIC_CHARGE_PUMP_1, 102 .bypass_mask = ARIZONA_CPMIC_BYPASS, 103 104 .owner = THIS_MODULE, 105 }; 106 107 static const struct regulator_init_data arizona_micsupp_default = { 108 .constraints = { 109 .valid_ops_mask = REGULATOR_CHANGE_STATUS | 110 REGULATOR_CHANGE_VOLTAGE, 111 .min_uV = 1700000, 112 .max_uV = 3300000, 113 }, 114 115 .num_consumer_supplies = 1, 116 }; 117 118 static __devinit int arizona_micsupp_probe(struct platform_device *pdev) 119 { 120 struct arizona *arizona = dev_get_drvdata(pdev->dev.parent); 121 struct regulator_config config = { }; 122 struct arizona_micsupp *micsupp; 123 int ret; 124 125 micsupp = devm_kzalloc(&pdev->dev, sizeof(*micsupp), GFP_KERNEL); 126 if (micsupp == NULL) { 127 dev_err(&pdev->dev, "Unable to allocate private data\n"); 128 return -ENOMEM; 129 } 130 131 micsupp->arizona = arizona; 132 133 /* 134 * Since the chip usually supplies itself we provide some 135 * default init_data for it. This will be overridden with 136 * platform data if provided. 137 */ 138 micsupp->init_data = arizona_micsupp_default; 139 micsupp->init_data.consumer_supplies = &micsupp->supply; 140 micsupp->supply.supply = "MICVDD"; 141 micsupp->supply.dev_name = dev_name(arizona->dev); 142 143 config.dev = arizona->dev; 144 config.driver_data = micsupp; 145 config.regmap = arizona->regmap; 146 147 if (arizona->pdata.micvdd) 148 config.init_data = arizona->pdata.micvdd; 149 else 150 config.init_data = &micsupp->init_data; 151 152 /* Default to regulated mode until the API supports bypass */ 153 regmap_update_bits(arizona->regmap, ARIZONA_MIC_CHARGE_PUMP_1, 154 ARIZONA_CPMIC_BYPASS, 0); 155 156 micsupp->regulator = regulator_register(&arizona_micsupp, &config); 157 if (IS_ERR(micsupp->regulator)) { 158 ret = PTR_ERR(micsupp->regulator); 159 dev_err(arizona->dev, "Failed to register mic supply: %d\n", 160 ret); 161 return ret; 162 } 163 164 platform_set_drvdata(pdev, micsupp); 165 166 return 0; 167 } 168 169 static __devexit int arizona_micsupp_remove(struct platform_device *pdev) 170 { 171 struct arizona_micsupp *micsupp = platform_get_drvdata(pdev); 172 173 regulator_unregister(micsupp->regulator); 174 175 return 0; 176 } 177 178 static struct platform_driver arizona_micsupp_driver = { 179 .probe = arizona_micsupp_probe, 180 .remove = __devexit_p(arizona_micsupp_remove), 181 .driver = { 182 .name = "arizona-micsupp", 183 .owner = THIS_MODULE, 184 }, 185 }; 186 187 module_platform_driver(arizona_micsupp_driver); 188 189 /* Module information */ 190 MODULE_AUTHOR("Mark Brown <broonie@opensource.wolfsonmicro.com>"); 191 MODULE_DESCRIPTION("Arizona microphone supply driver"); 192 MODULE_LICENSE("GPL"); 193 MODULE_ALIAS("platform:arizona-micsupp"); 194