1 // SPDX-License-Identifier: GPL-2.0 2 // 3 // Lochnagar regulator driver 4 // 5 // Copyright (c) 2017-2018 Cirrus Logic, Inc. and 6 // Cirrus Logic International Semiconductor Ltd. 7 // 8 // Author: Charles Keepax <ckeepax@opensource.cirrus.com> 9 10 #include <linux/bitops.h> 11 #include <linux/device.h> 12 #include <linux/err.h> 13 #include <linux/module.h> 14 #include <linux/mutex.h> 15 #include <linux/of.h> 16 #include <linux/of_device.h> 17 #include <linux/platform_device.h> 18 #include <linux/regmap.h> 19 #include <linux/regulator/driver.h> 20 #include <linux/regulator/machine.h> 21 #include <linux/regulator/of_regulator.h> 22 23 #include <linux/mfd/lochnagar.h> 24 #include <linux/mfd/lochnagar1_regs.h> 25 #include <linux/mfd/lochnagar2_regs.h> 26 27 static const struct regulator_ops lochnagar_micvdd_ops = { 28 .enable = regulator_enable_regmap, 29 .disable = regulator_disable_regmap, 30 .is_enabled = regulator_is_enabled_regmap, 31 32 .list_voltage = regulator_list_voltage_linear_range, 33 .map_voltage = regulator_map_voltage_linear_range, 34 35 .get_voltage_sel = regulator_get_voltage_sel_regmap, 36 .set_voltage_sel = regulator_set_voltage_sel_regmap, 37 }; 38 39 static const struct regulator_linear_range lochnagar_micvdd_ranges[] = { 40 REGULATOR_LINEAR_RANGE(1000000, 0, 0xC, 50000), 41 REGULATOR_LINEAR_RANGE(1700000, 0xD, 0x1F, 100000), 42 }; 43 44 static int lochnagar_micbias_enable(struct regulator_dev *rdev) 45 { 46 struct lochnagar *lochnagar = rdev_get_drvdata(rdev); 47 int ret; 48 49 mutex_lock(&lochnagar->analogue_config_lock); 50 51 ret = regulator_enable_regmap(rdev); 52 if (ret < 0) 53 goto err; 54 55 ret = lochnagar_update_config(lochnagar); 56 57 err: 58 mutex_unlock(&lochnagar->analogue_config_lock); 59 60 return ret; 61 } 62 63 static int lochnagar_micbias_disable(struct regulator_dev *rdev) 64 { 65 struct lochnagar *lochnagar = rdev_get_drvdata(rdev); 66 int ret; 67 68 mutex_lock(&lochnagar->analogue_config_lock); 69 70 ret = regulator_disable_regmap(rdev); 71 if (ret < 0) 72 goto err; 73 74 ret = lochnagar_update_config(lochnagar); 75 76 err: 77 mutex_unlock(&lochnagar->analogue_config_lock); 78 79 return ret; 80 } 81 82 static const struct regulator_ops lochnagar_micbias_ops = { 83 .enable = lochnagar_micbias_enable, 84 .disable = lochnagar_micbias_disable, 85 .is_enabled = regulator_is_enabled_regmap, 86 }; 87 88 static const struct regulator_ops lochnagar_vddcore_ops = { 89 .enable = regulator_enable_regmap, 90 .disable = regulator_disable_regmap, 91 .is_enabled = regulator_is_enabled_regmap, 92 93 .list_voltage = regulator_list_voltage_linear_range, 94 .map_voltage = regulator_map_voltage_linear_range, 95 96 .get_voltage_sel = regulator_get_voltage_sel_regmap, 97 .set_voltage_sel = regulator_set_voltage_sel_regmap, 98 }; 99 100 static const struct regulator_linear_range lochnagar_vddcore_ranges[] = { 101 REGULATOR_LINEAR_RANGE(600000, 0x8, 0x41, 12500), 102 }; 103 104 enum lochnagar_regulators { 105 LOCHNAGAR_MICVDD, 106 LOCHNAGAR_MIC1VDD, 107 LOCHNAGAR_MIC2VDD, 108 LOCHNAGAR_VDDCORE, 109 }; 110 111 static int lochnagar_micbias_of_parse(struct device_node *np, 112 const struct regulator_desc *desc, 113 struct regulator_config *config) 114 { 115 struct lochnagar *lochnagar = config->driver_data; 116 int shift = (desc->id - LOCHNAGAR_MIC1VDD) * 117 LOCHNAGAR2_P2_MICBIAS_SRC_SHIFT; 118 int mask = LOCHNAGAR2_P1_MICBIAS_SRC_MASK << shift; 119 unsigned int val; 120 int ret; 121 122 ret = of_property_read_u32(np, "cirrus,micbias-input", &val); 123 if (ret >= 0) { 124 mutex_lock(&lochnagar->analogue_config_lock); 125 ret = regmap_update_bits(lochnagar->regmap, 126 LOCHNAGAR2_ANALOGUE_PATH_CTRL2, 127 mask, val << shift); 128 mutex_unlock(&lochnagar->analogue_config_lock); 129 if (ret < 0) { 130 dev_err(lochnagar->dev, 131 "Failed to update micbias source: %d\n", ret); 132 return ret; 133 } 134 } 135 136 return 0; 137 } 138 139 static const struct regulator_desc lochnagar_regulators[] = { 140 [LOCHNAGAR_MICVDD] = { 141 .name = "MICVDD", 142 .supply_name = "SYSVDD", 143 .type = REGULATOR_VOLTAGE, 144 .n_voltages = 32, 145 .ops = &lochnagar_micvdd_ops, 146 147 .id = LOCHNAGAR_MICVDD, 148 .of_match = of_match_ptr("MICVDD"), 149 150 .enable_reg = LOCHNAGAR2_MICVDD_CTRL1, 151 .enable_mask = LOCHNAGAR2_MICVDD_REG_ENA_MASK, 152 .vsel_reg = LOCHNAGAR2_MICVDD_CTRL2, 153 .vsel_mask = LOCHNAGAR2_MICVDD_VSEL_MASK, 154 155 .linear_ranges = lochnagar_micvdd_ranges, 156 .n_linear_ranges = ARRAY_SIZE(lochnagar_micvdd_ranges), 157 158 .enable_time = 3000, 159 .ramp_delay = 1000, 160 161 .owner = THIS_MODULE, 162 }, 163 [LOCHNAGAR_MIC1VDD] = { 164 .name = "MIC1VDD", 165 .supply_name = "MICBIAS1", 166 .type = REGULATOR_VOLTAGE, 167 .ops = &lochnagar_micbias_ops, 168 169 .id = LOCHNAGAR_MIC1VDD, 170 .of_match = of_match_ptr("MIC1VDD"), 171 .of_parse_cb = lochnagar_micbias_of_parse, 172 173 .enable_reg = LOCHNAGAR2_ANALOGUE_PATH_CTRL2, 174 .enable_mask = LOCHNAGAR2_P1_INPUT_BIAS_ENA_MASK, 175 176 .owner = THIS_MODULE, 177 }, 178 [LOCHNAGAR_MIC2VDD] = { 179 .name = "MIC2VDD", 180 .supply_name = "MICBIAS2", 181 .type = REGULATOR_VOLTAGE, 182 .ops = &lochnagar_micbias_ops, 183 184 .id = LOCHNAGAR_MIC2VDD, 185 .of_match = of_match_ptr("MIC2VDD"), 186 .of_parse_cb = lochnagar_micbias_of_parse, 187 188 .enable_reg = LOCHNAGAR2_ANALOGUE_PATH_CTRL2, 189 .enable_mask = LOCHNAGAR2_P2_INPUT_BIAS_ENA_MASK, 190 191 .owner = THIS_MODULE, 192 }, 193 [LOCHNAGAR_VDDCORE] = { 194 .name = "VDDCORE", 195 .supply_name = "SYSVDD", 196 .type = REGULATOR_VOLTAGE, 197 .n_voltages = 66, 198 .ops = &lochnagar_vddcore_ops, 199 200 .id = LOCHNAGAR_VDDCORE, 201 .of_match = of_match_ptr("VDDCORE"), 202 203 .enable_reg = LOCHNAGAR2_VDDCORE_CDC_CTRL1, 204 .enable_mask = LOCHNAGAR2_VDDCORE_CDC_REG_ENA_MASK, 205 .vsel_reg = LOCHNAGAR2_VDDCORE_CDC_CTRL2, 206 .vsel_mask = LOCHNAGAR2_VDDCORE_CDC_VSEL_MASK, 207 208 .linear_ranges = lochnagar_vddcore_ranges, 209 .n_linear_ranges = ARRAY_SIZE(lochnagar_vddcore_ranges), 210 211 .enable_time = 3000, 212 .ramp_delay = 1000, 213 214 .owner = THIS_MODULE, 215 }, 216 }; 217 218 static const struct of_device_id lochnagar_of_match[] = { 219 { 220 .compatible = "cirrus,lochnagar2-micvdd", 221 .data = &lochnagar_regulators[LOCHNAGAR_MICVDD], 222 }, 223 { 224 .compatible = "cirrus,lochnagar2-mic1vdd", 225 .data = &lochnagar_regulators[LOCHNAGAR_MIC1VDD], 226 }, 227 { 228 .compatible = "cirrus,lochnagar2-mic2vdd", 229 .data = &lochnagar_regulators[LOCHNAGAR_MIC2VDD], 230 }, 231 { 232 .compatible = "cirrus,lochnagar2-vddcore", 233 .data = &lochnagar_regulators[LOCHNAGAR_VDDCORE], 234 }, 235 {} 236 }; 237 MODULE_DEVICE_TABLE(of, lochnagar_of_match); 238 239 static int lochnagar_regulator_probe(struct platform_device *pdev) 240 { 241 struct device *dev = &pdev->dev; 242 struct lochnagar *lochnagar = dev_get_drvdata(dev->parent); 243 struct regulator_config config = { }; 244 const struct of_device_id *of_id; 245 const struct regulator_desc *desc; 246 struct regulator_dev *rdev; 247 int ret; 248 249 config.dev = dev; 250 config.regmap = lochnagar->regmap; 251 config.driver_data = lochnagar; 252 253 of_id = of_match_device(lochnagar_of_match, dev); 254 if (!of_id) 255 return -EINVAL; 256 257 desc = of_id->data; 258 259 rdev = devm_regulator_register(dev, desc, &config); 260 if (IS_ERR(rdev)) { 261 ret = PTR_ERR(rdev); 262 dev_err(dev, "Failed to register %s regulator: %d\n", 263 desc->name, ret); 264 return ret; 265 } 266 267 return 0; 268 } 269 270 static struct platform_driver lochnagar_regulator_driver = { 271 .driver = { 272 .name = "lochnagar-regulator", 273 .of_match_table = of_match_ptr(lochnagar_of_match), 274 }, 275 276 .probe = lochnagar_regulator_probe, 277 }; 278 module_platform_driver(lochnagar_regulator_driver); 279 280 MODULE_AUTHOR("Charles Keepax <ckeepax@opensource.cirrus.com>"); 281 MODULE_DESCRIPTION("Regulator driver for Cirrus Logic Lochnagar Board"); 282 MODULE_LICENSE("GPL v2"); 283 MODULE_ALIAS("platform:lochnagar-regulator"); 284