1 // SPDX-License-Identifier: GPL-2.0 2 /* 3 * Amlogic Meson Successive Approximation Register (SAR) A/D Converter 4 * 5 * Copyright (C) 2017 Martin Blumenstingl <martin.blumenstingl@googlemail.com> 6 */ 7 8 #include <linux/bitfield.h> 9 #include <linux/clk.h> 10 #include <linux/clk-provider.h> 11 #include <linux/delay.h> 12 #include <linux/io.h> 13 #include <linux/iio/iio.h> 14 #include <linux/module.h> 15 #include <linux/mutex.h> 16 #include <linux/nvmem-consumer.h> 17 #include <linux/interrupt.h> 18 #include <linux/of.h> 19 #include <linux/of_irq.h> 20 #include <linux/platform_device.h> 21 #include <linux/regmap.h> 22 #include <linux/regulator/consumer.h> 23 #include <linux/mfd/syscon.h> 24 25 #define MESON_SAR_ADC_REG0 0x00 26 #define MESON_SAR_ADC_REG0_PANEL_DETECT BIT(31) 27 #define MESON_SAR_ADC_REG0_BUSY_MASK GENMASK(30, 28) 28 #define MESON_SAR_ADC_REG0_DELTA_BUSY BIT(30) 29 #define MESON_SAR_ADC_REG0_AVG_BUSY BIT(29) 30 #define MESON_SAR_ADC_REG0_SAMPLE_BUSY BIT(28) 31 #define MESON_SAR_ADC_REG0_FIFO_FULL BIT(27) 32 #define MESON_SAR_ADC_REG0_FIFO_EMPTY BIT(26) 33 #define MESON_SAR_ADC_REG0_FIFO_COUNT_MASK GENMASK(25, 21) 34 #define MESON_SAR_ADC_REG0_ADC_BIAS_CTRL_MASK GENMASK(20, 19) 35 #define MESON_SAR_ADC_REG0_CURR_CHAN_ID_MASK GENMASK(18, 16) 36 #define MESON_SAR_ADC_REG0_ADC_TEMP_SEN_SEL BIT(15) 37 #define MESON_SAR_ADC_REG0_SAMPLING_STOP BIT(14) 38 #define MESON_SAR_ADC_REG0_CHAN_DELTA_EN_MASK GENMASK(13, 12) 39 #define MESON_SAR_ADC_REG0_DETECT_IRQ_POL BIT(10) 40 #define MESON_SAR_ADC_REG0_DETECT_IRQ_EN BIT(9) 41 #define MESON_SAR_ADC_REG0_FIFO_CNT_IRQ_MASK GENMASK(8, 4) 42 #define MESON_SAR_ADC_REG0_FIFO_IRQ_EN BIT(3) 43 #define MESON_SAR_ADC_REG0_SAMPLING_START BIT(2) 44 #define MESON_SAR_ADC_REG0_CONTINUOUS_EN BIT(1) 45 #define MESON_SAR_ADC_REG0_SAMPLE_ENGINE_ENABLE BIT(0) 46 47 #define MESON_SAR_ADC_CHAN_LIST 0x04 48 #define MESON_SAR_ADC_CHAN_LIST_MAX_INDEX_MASK GENMASK(26, 24) 49 #define MESON_SAR_ADC_CHAN_LIST_ENTRY_MASK(_chan) \ 50 (GENMASK(2, 0) << ((_chan) * 3)) 51 52 #define MESON_SAR_ADC_AVG_CNTL 0x08 53 #define MESON_SAR_ADC_AVG_CNTL_AVG_MODE_SHIFT(_chan) \ 54 (16 + ((_chan) * 2)) 55 #define MESON_SAR_ADC_AVG_CNTL_AVG_MODE_MASK(_chan) \ 56 (GENMASK(17, 16) << ((_chan) * 2)) 57 #define MESON_SAR_ADC_AVG_CNTL_NUM_SAMPLES_SHIFT(_chan) \ 58 (0 + ((_chan) * 2)) 59 #define MESON_SAR_ADC_AVG_CNTL_NUM_SAMPLES_MASK(_chan) \ 60 (GENMASK(1, 0) << ((_chan) * 2)) 61 62 #define MESON_SAR_ADC_REG3 0x0c 63 #define MESON_SAR_ADC_REG3_CNTL_USE_SC_DLY BIT(31) 64 #define MESON_SAR_ADC_REG3_CLK_EN BIT(30) 65 #define MESON_SAR_ADC_REG3_BL30_INITIALIZED BIT(28) 66 #define MESON_SAR_ADC_REG3_CTRL_CONT_RING_COUNTER_EN BIT(27) 67 #define MESON_SAR_ADC_REG3_CTRL_SAMPLING_CLOCK_PHASE BIT(26) 68 #define MESON_SAR_ADC_REG3_CTRL_CHAN7_MUX_SEL_MASK GENMASK(25, 23) 69 #define MESON_SAR_ADC_REG3_DETECT_EN BIT(22) 70 #define MESON_SAR_ADC_REG3_ADC_EN BIT(21) 71 #define MESON_SAR_ADC_REG3_PANEL_DETECT_COUNT_MASK GENMASK(20, 18) 72 #define MESON_SAR_ADC_REG3_PANEL_DETECT_FILTER_TB_MASK GENMASK(17, 16) 73 #define MESON_SAR_ADC_REG3_ADC_CLK_DIV_SHIFT 10 74 #define MESON_SAR_ADC_REG3_ADC_CLK_DIV_WIDTH 6 75 #define MESON_SAR_ADC_REG3_BLOCK_DLY_SEL_MASK GENMASK(9, 8) 76 #define MESON_SAR_ADC_REG3_BLOCK_DLY_MASK GENMASK(7, 0) 77 78 #define MESON_SAR_ADC_DELAY 0x10 79 #define MESON_SAR_ADC_DELAY_INPUT_DLY_SEL_MASK GENMASK(25, 24) 80 #define MESON_SAR_ADC_DELAY_BL30_BUSY BIT(15) 81 #define MESON_SAR_ADC_DELAY_KERNEL_BUSY BIT(14) 82 #define MESON_SAR_ADC_DELAY_INPUT_DLY_CNT_MASK GENMASK(23, 16) 83 #define MESON_SAR_ADC_DELAY_SAMPLE_DLY_SEL_MASK GENMASK(9, 8) 84 #define MESON_SAR_ADC_DELAY_SAMPLE_DLY_CNT_MASK GENMASK(7, 0) 85 86 #define MESON_SAR_ADC_LAST_RD 0x14 87 #define MESON_SAR_ADC_LAST_RD_LAST_CHANNEL1_MASK GENMASK(23, 16) 88 #define MESON_SAR_ADC_LAST_RD_LAST_CHANNEL0_MASK GENMASK(9, 0) 89 90 #define MESON_SAR_ADC_FIFO_RD 0x18 91 #define MESON_SAR_ADC_FIFO_RD_CHAN_ID_MASK GENMASK(14, 12) 92 #define MESON_SAR_ADC_FIFO_RD_SAMPLE_VALUE_MASK GENMASK(11, 0) 93 94 #define MESON_SAR_ADC_AUX_SW 0x1c 95 #define MESON_SAR_ADC_AUX_SW_MUX_SEL_CHAN_SHIFT(_chan) \ 96 (8 + (((_chan) - 2) * 3)) 97 #define MESON_SAR_ADC_AUX_SW_VREF_P_MUX BIT(6) 98 #define MESON_SAR_ADC_AUX_SW_VREF_N_MUX BIT(5) 99 #define MESON_SAR_ADC_AUX_SW_MODE_SEL BIT(4) 100 #define MESON_SAR_ADC_AUX_SW_YP_DRIVE_SW BIT(3) 101 #define MESON_SAR_ADC_AUX_SW_XP_DRIVE_SW BIT(2) 102 #define MESON_SAR_ADC_AUX_SW_YM_DRIVE_SW BIT(1) 103 #define MESON_SAR_ADC_AUX_SW_XM_DRIVE_SW BIT(0) 104 105 #define MESON_SAR_ADC_CHAN_10_SW 0x20 106 #define MESON_SAR_ADC_CHAN_10_SW_CHAN1_MUX_SEL_MASK GENMASK(25, 23) 107 #define MESON_SAR_ADC_CHAN_10_SW_CHAN1_VREF_P_MUX BIT(22) 108 #define MESON_SAR_ADC_CHAN_10_SW_CHAN1_VREF_N_MUX BIT(21) 109 #define MESON_SAR_ADC_CHAN_10_SW_CHAN1_MODE_SEL BIT(20) 110 #define MESON_SAR_ADC_CHAN_10_SW_CHAN1_YP_DRIVE_SW BIT(19) 111 #define MESON_SAR_ADC_CHAN_10_SW_CHAN1_XP_DRIVE_SW BIT(18) 112 #define MESON_SAR_ADC_CHAN_10_SW_CHAN1_YM_DRIVE_SW BIT(17) 113 #define MESON_SAR_ADC_CHAN_10_SW_CHAN1_XM_DRIVE_SW BIT(16) 114 #define MESON_SAR_ADC_CHAN_10_SW_CHAN0_MUX_SEL_MASK GENMASK(9, 7) 115 #define MESON_SAR_ADC_CHAN_10_SW_CHAN0_VREF_P_MUX BIT(6) 116 #define MESON_SAR_ADC_CHAN_10_SW_CHAN0_VREF_N_MUX BIT(5) 117 #define MESON_SAR_ADC_CHAN_10_SW_CHAN0_MODE_SEL BIT(4) 118 #define MESON_SAR_ADC_CHAN_10_SW_CHAN0_YP_DRIVE_SW BIT(3) 119 #define MESON_SAR_ADC_CHAN_10_SW_CHAN0_XP_DRIVE_SW BIT(2) 120 #define MESON_SAR_ADC_CHAN_10_SW_CHAN0_YM_DRIVE_SW BIT(1) 121 #define MESON_SAR_ADC_CHAN_10_SW_CHAN0_XM_DRIVE_SW BIT(0) 122 123 #define MESON_SAR_ADC_DETECT_IDLE_SW 0x24 124 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_SW_EN BIT(26) 125 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_MUX_MASK GENMASK(25, 23) 126 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_VREF_P_MUX BIT(22) 127 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_VREF_N_MUX BIT(21) 128 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_MODE_SEL BIT(20) 129 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_YP_DRIVE_SW BIT(19) 130 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_XP_DRIVE_SW BIT(18) 131 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_YM_DRIVE_SW BIT(17) 132 #define MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_XM_DRIVE_SW BIT(16) 133 #define MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_MUX_SEL_MASK GENMASK(9, 7) 134 #define MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_VREF_P_MUX BIT(6) 135 #define MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_VREF_N_MUX BIT(5) 136 #define MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_MODE_SEL BIT(4) 137 #define MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_YP_DRIVE_SW BIT(3) 138 #define MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_XP_DRIVE_SW BIT(2) 139 #define MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_YM_DRIVE_SW BIT(1) 140 #define MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_XM_DRIVE_SW BIT(0) 141 142 #define MESON_SAR_ADC_DELTA_10 0x28 143 #define MESON_SAR_ADC_DELTA_10_TEMP_SEL BIT(27) 144 #define MESON_SAR_ADC_DELTA_10_TS_REVE1 BIT(26) 145 #define MESON_SAR_ADC_DELTA_10_CHAN1_DELTA_VALUE_MASK GENMASK(25, 16) 146 #define MESON_SAR_ADC_DELTA_10_TS_REVE0 BIT(15) 147 #define MESON_SAR_ADC_DELTA_10_TS_C_MASK GENMASK(14, 11) 148 #define MESON_SAR_ADC_DELTA_10_TS_VBG_EN BIT(10) 149 #define MESON_SAR_ADC_DELTA_10_CHAN0_DELTA_VALUE_MASK GENMASK(9, 0) 150 151 /* 152 * NOTE: registers from here are undocumented (the vendor Linux kernel driver 153 * and u-boot source served as reference). These only seem to be relevant on 154 * GXBB and newer. 155 */ 156 #define MESON_SAR_ADC_REG11 0x2c 157 #define MESON_SAR_ADC_REG11_BANDGAP_EN BIT(13) 158 #define MESON_SAR_ADC_REG11_CMV_SEL BIT(6) 159 #define MESON_SAR_ADC_REG11_VREF_VOLTAGE BIT(5) 160 #define MESON_SAR_ADC_REG11_EOC BIT(1) 161 #define MESON_SAR_ADC_REG11_VREF_SEL BIT(0) 162 163 #define MESON_SAR_ADC_REG12 0x30 164 #define MESON_SAR_ADC_REG12_MPLL0_UNKNOWN BIT(0) 165 #define MESON_SAR_ADC_REG12_MPLL1_UNKNOWN BIT(1) 166 #define MESON_SAR_ADC_REG12_MPLL2_UNKNOWN BIT(2) 167 168 #define MESON_SAR_ADC_REG13 0x34 169 #define MESON_SAR_ADC_REG13_12BIT_CALIBRATION_MASK GENMASK(13, 8) 170 171 #define MESON_SAR_ADC_MAX_FIFO_SIZE 32 172 #define MESON_SAR_ADC_TIMEOUT 100 /* ms */ 173 #define MESON_SAR_ADC_VOLTAGE_AND_TEMP_CHANNEL 6 174 #define MESON_SAR_ADC_VOLTAGE_AND_MUX_CHANNEL 7 175 #define MESON_SAR_ADC_TEMP_OFFSET 27 176 177 /* temperature sensor calibration information in eFuse */ 178 #define MESON_SAR_ADC_EFUSE_BYTES 4 179 #define MESON_SAR_ADC_EFUSE_BYTE3_UPPER_ADC_VAL GENMASK(6, 0) 180 #define MESON_SAR_ADC_EFUSE_BYTE3_IS_CALIBRATED BIT(7) 181 182 #define MESON_HHI_DPLL_TOP_0 0x318 183 #define MESON_HHI_DPLL_TOP_0_TSC_BIT4 BIT(9) 184 185 /* for use with IIO_VAL_INT_PLUS_MICRO */ 186 #define MILLION 1000000 187 188 #define MESON_SAR_ADC_CHAN(_chan) { \ 189 .type = IIO_VOLTAGE, \ 190 .indexed = 1, \ 191 .channel = _chan, \ 192 .address = _chan, \ 193 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ 194 BIT(IIO_CHAN_INFO_AVERAGE_RAW), \ 195 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \ 196 .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_CALIBBIAS) | \ 197 BIT(IIO_CHAN_INFO_CALIBSCALE), \ 198 .datasheet_name = "SAR_ADC_CH"#_chan, \ 199 } 200 201 #define MESON_SAR_ADC_TEMP_CHAN(_chan) { \ 202 .type = IIO_TEMP, \ 203 .channel = _chan, \ 204 .address = MESON_SAR_ADC_VOLTAGE_AND_TEMP_CHANNEL, \ 205 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ 206 BIT(IIO_CHAN_INFO_AVERAGE_RAW), \ 207 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_OFFSET) | \ 208 BIT(IIO_CHAN_INFO_SCALE), \ 209 .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_CALIBBIAS) | \ 210 BIT(IIO_CHAN_INFO_CALIBSCALE), \ 211 .datasheet_name = "TEMP_SENSOR", \ 212 } 213 214 #define MESON_SAR_ADC_MUX(_chan, _sel) { \ 215 .type = IIO_VOLTAGE, \ 216 .channel = _chan, \ 217 .indexed = 1, \ 218 .address = MESON_SAR_ADC_VOLTAGE_AND_MUX_CHANNEL, \ 219 .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \ 220 BIT(IIO_CHAN_INFO_AVERAGE_RAW), \ 221 .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \ 222 .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_CALIBBIAS) | \ 223 BIT(IIO_CHAN_INFO_CALIBSCALE), \ 224 .datasheet_name = "SAR_ADC_MUX_"#_sel, \ 225 } 226 227 enum meson_sar_adc_vref_sel { 228 VREF_CALIBATION_VOLTAGE = 0, 229 VREF_VDDA = 1, 230 }; 231 232 enum meson_sar_adc_avg_mode { 233 NO_AVERAGING = 0x0, 234 MEAN_AVERAGING = 0x1, 235 MEDIAN_AVERAGING = 0x2, 236 }; 237 238 enum meson_sar_adc_num_samples { 239 ONE_SAMPLE = 0x0, 240 TWO_SAMPLES = 0x1, 241 FOUR_SAMPLES = 0x2, 242 EIGHT_SAMPLES = 0x3, 243 }; 244 245 enum meson_sar_adc_chan7_mux_sel { 246 CHAN7_MUX_VSS = 0x0, 247 CHAN7_MUX_VDD_DIV4 = 0x1, 248 CHAN7_MUX_VDD_DIV2 = 0x2, 249 CHAN7_MUX_VDD_MUL3_DIV4 = 0x3, 250 CHAN7_MUX_VDD = 0x4, 251 CHAN7_MUX_CH7_INPUT = 0x7, 252 }; 253 254 enum meson_sar_adc_channel_index { 255 NUM_CHAN_0, 256 NUM_CHAN_1, 257 NUM_CHAN_2, 258 NUM_CHAN_3, 259 NUM_CHAN_4, 260 NUM_CHAN_5, 261 NUM_CHAN_6, 262 NUM_CHAN_7, 263 NUM_CHAN_TEMP, 264 NUM_MUX_0_VSS, 265 NUM_MUX_1_VDD_DIV4, 266 NUM_MUX_2_VDD_DIV2, 267 NUM_MUX_3_VDD_MUL3_DIV4, 268 NUM_MUX_4_VDD, 269 }; 270 271 static enum meson_sar_adc_chan7_mux_sel chan7_mux_values[] = { 272 CHAN7_MUX_VSS, 273 CHAN7_MUX_VDD_DIV4, 274 CHAN7_MUX_VDD_DIV2, 275 CHAN7_MUX_VDD_MUL3_DIV4, 276 CHAN7_MUX_VDD, 277 }; 278 279 static const char * const chan7_mux_names[] = { 280 [CHAN7_MUX_VSS] = "gnd", 281 [CHAN7_MUX_VDD_DIV4] = "0.25vdd", 282 [CHAN7_MUX_VDD_DIV2] = "0.5vdd", 283 [CHAN7_MUX_VDD_MUL3_DIV4] = "0.75vdd", 284 [CHAN7_MUX_VDD] = "vdd", 285 }; 286 287 static const struct iio_chan_spec meson_sar_adc_iio_channels[] = { 288 MESON_SAR_ADC_CHAN(NUM_CHAN_0), 289 MESON_SAR_ADC_CHAN(NUM_CHAN_1), 290 MESON_SAR_ADC_CHAN(NUM_CHAN_2), 291 MESON_SAR_ADC_CHAN(NUM_CHAN_3), 292 MESON_SAR_ADC_CHAN(NUM_CHAN_4), 293 MESON_SAR_ADC_CHAN(NUM_CHAN_5), 294 MESON_SAR_ADC_CHAN(NUM_CHAN_6), 295 MESON_SAR_ADC_CHAN(NUM_CHAN_7), 296 MESON_SAR_ADC_MUX(NUM_MUX_0_VSS, 0), 297 MESON_SAR_ADC_MUX(NUM_MUX_1_VDD_DIV4, 1), 298 MESON_SAR_ADC_MUX(NUM_MUX_2_VDD_DIV2, 2), 299 MESON_SAR_ADC_MUX(NUM_MUX_3_VDD_MUL3_DIV4, 3), 300 MESON_SAR_ADC_MUX(NUM_MUX_4_VDD, 4), 301 }; 302 303 static const struct iio_chan_spec meson_sar_adc_and_temp_iio_channels[] = { 304 MESON_SAR_ADC_CHAN(NUM_CHAN_0), 305 MESON_SAR_ADC_CHAN(NUM_CHAN_1), 306 MESON_SAR_ADC_CHAN(NUM_CHAN_2), 307 MESON_SAR_ADC_CHAN(NUM_CHAN_3), 308 MESON_SAR_ADC_CHAN(NUM_CHAN_4), 309 MESON_SAR_ADC_CHAN(NUM_CHAN_5), 310 MESON_SAR_ADC_CHAN(NUM_CHAN_6), 311 MESON_SAR_ADC_CHAN(NUM_CHAN_7), 312 MESON_SAR_ADC_TEMP_CHAN(NUM_CHAN_TEMP), 313 MESON_SAR_ADC_MUX(NUM_MUX_0_VSS, 0), 314 MESON_SAR_ADC_MUX(NUM_MUX_1_VDD_DIV4, 1), 315 MESON_SAR_ADC_MUX(NUM_MUX_2_VDD_DIV2, 2), 316 MESON_SAR_ADC_MUX(NUM_MUX_3_VDD_MUL3_DIV4, 3), 317 MESON_SAR_ADC_MUX(NUM_MUX_4_VDD, 4), 318 }; 319 320 struct meson_sar_adc_param { 321 bool has_bl30_integration; 322 unsigned long clock_rate; 323 unsigned int resolution; 324 const struct regmap_config *regmap_config; 325 u8 temperature_trimming_bits; 326 unsigned int temperature_multiplier; 327 unsigned int temperature_divider; 328 u8 disable_ring_counter; 329 bool has_vref_select; 330 u8 vref_select; 331 u8 cmv_select; 332 u8 adc_eoc; 333 enum meson_sar_adc_vref_sel vref_voltage; 334 bool enable_mpll_clock_workaround; 335 }; 336 337 struct meson_sar_adc_data { 338 const struct meson_sar_adc_param *param; 339 const char *name; 340 }; 341 342 struct meson_sar_adc_priv { 343 struct regmap *regmap; 344 struct regulator *vref; 345 const struct meson_sar_adc_param *param; 346 struct clk *clkin; 347 struct clk *core_clk; 348 struct clk *adc_sel_clk; 349 struct clk *adc_clk; 350 struct clk_gate clk_gate; 351 struct clk *adc_div_clk; 352 struct clk_divider clk_div; 353 struct completion done; 354 /* lock to protect against multiple access to the device */ 355 struct mutex lock; 356 int calibbias; 357 int calibscale; 358 struct regmap *tsc_regmap; 359 bool temperature_sensor_calibrated; 360 u8 temperature_sensor_coefficient; 361 u16 temperature_sensor_adc_val; 362 enum meson_sar_adc_chan7_mux_sel chan7_mux_sel; 363 }; 364 365 static const struct regmap_config meson_sar_adc_regmap_config_gxbb = { 366 .reg_bits = 8, 367 .val_bits = 32, 368 .reg_stride = 4, 369 .max_register = MESON_SAR_ADC_REG13, 370 }; 371 372 static const struct regmap_config meson_sar_adc_regmap_config_meson8 = { 373 .reg_bits = 8, 374 .val_bits = 32, 375 .reg_stride = 4, 376 .max_register = MESON_SAR_ADC_DELTA_10, 377 }; 378 379 static const struct iio_chan_spec * 380 find_channel_by_num(struct iio_dev *indio_dev, int num) 381 { 382 int i; 383 384 for (i = 0; i < indio_dev->num_channels; i++) 385 if (indio_dev->channels[i].channel == num) 386 return &indio_dev->channels[i]; 387 return NULL; 388 } 389 390 static unsigned int meson_sar_adc_get_fifo_count(struct iio_dev *indio_dev) 391 { 392 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 393 u32 regval; 394 395 regmap_read(priv->regmap, MESON_SAR_ADC_REG0, ®val); 396 397 return FIELD_GET(MESON_SAR_ADC_REG0_FIFO_COUNT_MASK, regval); 398 } 399 400 static int meson_sar_adc_calib_val(struct iio_dev *indio_dev, int val) 401 { 402 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 403 int tmp; 404 405 /* use val_calib = scale * val_raw + offset calibration function */ 406 tmp = div_s64((s64)val * priv->calibscale, MILLION) + priv->calibbias; 407 408 return clamp(tmp, 0, (1 << priv->param->resolution) - 1); 409 } 410 411 static int meson_sar_adc_wait_busy_clear(struct iio_dev *indio_dev) 412 { 413 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 414 int val; 415 416 /* 417 * NOTE: we need a small delay before reading the status, otherwise 418 * the sample engine may not have started internally (which would 419 * seem to us that sampling is already finished). 420 */ 421 udelay(1); 422 return regmap_read_poll_timeout_atomic(priv->regmap, MESON_SAR_ADC_REG0, val, 423 !FIELD_GET(MESON_SAR_ADC_REG0_BUSY_MASK, val), 424 1, 10000); 425 } 426 427 static void meson_sar_adc_set_chan7_mux(struct iio_dev *indio_dev, 428 enum meson_sar_adc_chan7_mux_sel sel) 429 { 430 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 431 u32 regval; 432 433 regval = FIELD_PREP(MESON_SAR_ADC_REG3_CTRL_CHAN7_MUX_SEL_MASK, sel); 434 regmap_update_bits(priv->regmap, MESON_SAR_ADC_REG3, 435 MESON_SAR_ADC_REG3_CTRL_CHAN7_MUX_SEL_MASK, regval); 436 437 usleep_range(10, 20); 438 439 priv->chan7_mux_sel = sel; 440 } 441 442 static int meson_sar_adc_read_raw_sample(struct iio_dev *indio_dev, 443 const struct iio_chan_spec *chan, 444 int *val) 445 { 446 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 447 struct device *dev = indio_dev->dev.parent; 448 int regval, fifo_chan, fifo_val, count; 449 450 if (!wait_for_completion_timeout(&priv->done, 451 msecs_to_jiffies(MESON_SAR_ADC_TIMEOUT))) 452 return -ETIMEDOUT; 453 454 count = meson_sar_adc_get_fifo_count(indio_dev); 455 if (count != 1) { 456 dev_err(dev, "ADC FIFO has %d element(s) instead of one\n", count); 457 return -EINVAL; 458 } 459 460 regmap_read(priv->regmap, MESON_SAR_ADC_FIFO_RD, ®val); 461 fifo_chan = FIELD_GET(MESON_SAR_ADC_FIFO_RD_CHAN_ID_MASK, regval); 462 if (fifo_chan != chan->address) { 463 dev_err(dev, "ADC FIFO entry belongs to channel %d instead of %lu\n", 464 fifo_chan, chan->address); 465 return -EINVAL; 466 } 467 468 fifo_val = FIELD_GET(MESON_SAR_ADC_FIFO_RD_SAMPLE_VALUE_MASK, regval); 469 fifo_val &= GENMASK(priv->param->resolution - 1, 0); 470 *val = meson_sar_adc_calib_val(indio_dev, fifo_val); 471 472 return 0; 473 } 474 475 static void meson_sar_adc_set_averaging(struct iio_dev *indio_dev, 476 const struct iio_chan_spec *chan, 477 enum meson_sar_adc_avg_mode mode, 478 enum meson_sar_adc_num_samples samples) 479 { 480 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 481 int val, address = chan->address; 482 483 val = samples << MESON_SAR_ADC_AVG_CNTL_NUM_SAMPLES_SHIFT(address); 484 regmap_update_bits(priv->regmap, MESON_SAR_ADC_AVG_CNTL, 485 MESON_SAR_ADC_AVG_CNTL_NUM_SAMPLES_MASK(address), 486 val); 487 488 val = mode << MESON_SAR_ADC_AVG_CNTL_AVG_MODE_SHIFT(address); 489 regmap_update_bits(priv->regmap, MESON_SAR_ADC_AVG_CNTL, 490 MESON_SAR_ADC_AVG_CNTL_AVG_MODE_MASK(address), val); 491 } 492 493 static void meson_sar_adc_enable_channel(struct iio_dev *indio_dev, 494 const struct iio_chan_spec *chan) 495 { 496 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 497 u32 regval; 498 499 /* 500 * the SAR ADC engine allows sampling multiple channels at the same 501 * time. to keep it simple we're only working with one *internal* 502 * channel, which starts counting at index 0 (which means: count = 1). 503 */ 504 regval = FIELD_PREP(MESON_SAR_ADC_CHAN_LIST_MAX_INDEX_MASK, 0); 505 regmap_update_bits(priv->regmap, MESON_SAR_ADC_CHAN_LIST, 506 MESON_SAR_ADC_CHAN_LIST_MAX_INDEX_MASK, regval); 507 508 /* map channel index 0 to the channel which we want to read */ 509 regval = FIELD_PREP(MESON_SAR_ADC_CHAN_LIST_ENTRY_MASK(0), 510 chan->address); 511 regmap_update_bits(priv->regmap, MESON_SAR_ADC_CHAN_LIST, 512 MESON_SAR_ADC_CHAN_LIST_ENTRY_MASK(0), regval); 513 514 regval = FIELD_PREP(MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_MUX_MASK, 515 chan->address); 516 regmap_update_bits(priv->regmap, MESON_SAR_ADC_DETECT_IDLE_SW, 517 MESON_SAR_ADC_DETECT_IDLE_SW_DETECT_MUX_MASK, 518 regval); 519 520 regval = FIELD_PREP(MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_MUX_SEL_MASK, 521 chan->address); 522 regmap_update_bits(priv->regmap, MESON_SAR_ADC_DETECT_IDLE_SW, 523 MESON_SAR_ADC_DETECT_IDLE_SW_IDLE_MUX_SEL_MASK, 524 regval); 525 526 if (chan->address == MESON_SAR_ADC_VOLTAGE_AND_TEMP_CHANNEL) { 527 if (chan->type == IIO_TEMP) 528 regval = MESON_SAR_ADC_DELTA_10_TEMP_SEL; 529 else 530 regval = 0; 531 532 regmap_update_bits(priv->regmap, 533 MESON_SAR_ADC_DELTA_10, 534 MESON_SAR_ADC_DELTA_10_TEMP_SEL, regval); 535 } else if (chan->address == MESON_SAR_ADC_VOLTAGE_AND_MUX_CHANNEL) { 536 enum meson_sar_adc_chan7_mux_sel sel; 537 538 if (chan->channel == NUM_CHAN_7) 539 sel = CHAN7_MUX_CH7_INPUT; 540 else 541 sel = chan7_mux_values[chan->channel - NUM_MUX_0_VSS]; 542 if (sel != priv->chan7_mux_sel) 543 meson_sar_adc_set_chan7_mux(indio_dev, sel); 544 } 545 } 546 547 static void meson_sar_adc_start_sample_engine(struct iio_dev *indio_dev) 548 { 549 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 550 551 reinit_completion(&priv->done); 552 553 regmap_set_bits(priv->regmap, MESON_SAR_ADC_REG0, 554 MESON_SAR_ADC_REG0_FIFO_IRQ_EN); 555 556 regmap_set_bits(priv->regmap, MESON_SAR_ADC_REG0, 557 MESON_SAR_ADC_REG0_SAMPLE_ENGINE_ENABLE); 558 559 regmap_set_bits(priv->regmap, MESON_SAR_ADC_REG0, 560 MESON_SAR_ADC_REG0_SAMPLING_START); 561 } 562 563 static void meson_sar_adc_stop_sample_engine(struct iio_dev *indio_dev) 564 { 565 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 566 567 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_REG0, 568 MESON_SAR_ADC_REG0_FIFO_IRQ_EN); 569 570 regmap_set_bits(priv->regmap, MESON_SAR_ADC_REG0, 571 MESON_SAR_ADC_REG0_SAMPLING_STOP); 572 573 /* wait until all modules are stopped */ 574 meson_sar_adc_wait_busy_clear(indio_dev); 575 576 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_REG0, 577 MESON_SAR_ADC_REG0_SAMPLE_ENGINE_ENABLE); 578 } 579 580 static int meson_sar_adc_lock(struct iio_dev *indio_dev) 581 { 582 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 583 int val, ret; 584 585 mutex_lock(&priv->lock); 586 587 if (priv->param->has_bl30_integration) { 588 /* prevent BL30 from using the SAR ADC while we are using it */ 589 regmap_set_bits(priv->regmap, MESON_SAR_ADC_DELAY, 590 MESON_SAR_ADC_DELAY_KERNEL_BUSY); 591 592 udelay(1); 593 594 /* 595 * wait until BL30 releases it's lock (so we can use the SAR 596 * ADC) 597 */ 598 ret = regmap_read_poll_timeout_atomic(priv->regmap, MESON_SAR_ADC_DELAY, val, 599 !(val & MESON_SAR_ADC_DELAY_BL30_BUSY), 600 1, 10000); 601 if (ret) { 602 mutex_unlock(&priv->lock); 603 return ret; 604 } 605 } 606 607 return 0; 608 } 609 610 static void meson_sar_adc_unlock(struct iio_dev *indio_dev) 611 { 612 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 613 614 if (priv->param->has_bl30_integration) 615 /* allow BL30 to use the SAR ADC again */ 616 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_DELAY, 617 MESON_SAR_ADC_DELAY_KERNEL_BUSY); 618 619 mutex_unlock(&priv->lock); 620 } 621 622 static void meson_sar_adc_clear_fifo(struct iio_dev *indio_dev) 623 { 624 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 625 unsigned int count, tmp; 626 627 for (count = 0; count < MESON_SAR_ADC_MAX_FIFO_SIZE; count++) { 628 if (!meson_sar_adc_get_fifo_count(indio_dev)) 629 break; 630 631 regmap_read(priv->regmap, MESON_SAR_ADC_FIFO_RD, &tmp); 632 } 633 } 634 635 static int meson_sar_adc_get_sample(struct iio_dev *indio_dev, 636 const struct iio_chan_spec *chan, 637 enum meson_sar_adc_avg_mode avg_mode, 638 enum meson_sar_adc_num_samples avg_samples, 639 int *val) 640 { 641 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 642 struct device *dev = indio_dev->dev.parent; 643 int ret; 644 645 if (chan->type == IIO_TEMP && !priv->temperature_sensor_calibrated) 646 return -ENOTSUPP; 647 648 ret = meson_sar_adc_lock(indio_dev); 649 if (ret) 650 return ret; 651 652 /* clear the FIFO to make sure we're not reading old values */ 653 meson_sar_adc_clear_fifo(indio_dev); 654 655 meson_sar_adc_set_averaging(indio_dev, chan, avg_mode, avg_samples); 656 657 meson_sar_adc_enable_channel(indio_dev, chan); 658 659 meson_sar_adc_start_sample_engine(indio_dev); 660 ret = meson_sar_adc_read_raw_sample(indio_dev, chan, val); 661 meson_sar_adc_stop_sample_engine(indio_dev); 662 663 meson_sar_adc_unlock(indio_dev); 664 665 if (ret) { 666 dev_warn(dev, "failed to read sample for channel %lu: %d\n", 667 chan->address, ret); 668 return ret; 669 } 670 671 return IIO_VAL_INT; 672 } 673 674 static int meson_sar_adc_iio_info_read_raw(struct iio_dev *indio_dev, 675 const struct iio_chan_spec *chan, 676 int *val, int *val2, long mask) 677 { 678 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 679 struct device *dev = indio_dev->dev.parent; 680 int ret; 681 682 switch (mask) { 683 case IIO_CHAN_INFO_RAW: 684 return meson_sar_adc_get_sample(indio_dev, chan, NO_AVERAGING, 685 ONE_SAMPLE, val); 686 687 case IIO_CHAN_INFO_AVERAGE_RAW: 688 return meson_sar_adc_get_sample(indio_dev, chan, 689 MEAN_AVERAGING, EIGHT_SAMPLES, 690 val); 691 692 case IIO_CHAN_INFO_SCALE: 693 if (chan->type == IIO_VOLTAGE) { 694 ret = regulator_get_voltage(priv->vref); 695 if (ret < 0) { 696 dev_err(dev, "failed to get vref voltage: %d\n", ret); 697 return ret; 698 } 699 700 *val = ret / 1000; 701 *val2 = priv->param->resolution; 702 return IIO_VAL_FRACTIONAL_LOG2; 703 } else if (chan->type == IIO_TEMP) { 704 /* SoC specific multiplier and divider */ 705 *val = priv->param->temperature_multiplier; 706 *val2 = priv->param->temperature_divider; 707 708 /* celsius to millicelsius */ 709 *val *= 1000; 710 711 return IIO_VAL_FRACTIONAL; 712 } else { 713 return -EINVAL; 714 } 715 716 case IIO_CHAN_INFO_CALIBBIAS: 717 *val = priv->calibbias; 718 return IIO_VAL_INT; 719 720 case IIO_CHAN_INFO_CALIBSCALE: 721 *val = priv->calibscale / MILLION; 722 *val2 = priv->calibscale % MILLION; 723 return IIO_VAL_INT_PLUS_MICRO; 724 725 case IIO_CHAN_INFO_OFFSET: 726 *val = DIV_ROUND_CLOSEST(MESON_SAR_ADC_TEMP_OFFSET * 727 priv->param->temperature_divider, 728 priv->param->temperature_multiplier); 729 *val -= priv->temperature_sensor_adc_val; 730 return IIO_VAL_INT; 731 732 default: 733 return -EINVAL; 734 } 735 } 736 737 static int meson_sar_adc_clk_init(struct iio_dev *indio_dev, 738 void __iomem *base) 739 { 740 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 741 struct device *dev = indio_dev->dev.parent; 742 struct clk_init_data init; 743 const char *clk_parents[1]; 744 745 init.name = devm_kasprintf(dev, GFP_KERNEL, "%s#adc_div", dev_name(dev)); 746 if (!init.name) 747 return -ENOMEM; 748 749 init.flags = 0; 750 init.ops = &clk_divider_ops; 751 clk_parents[0] = __clk_get_name(priv->clkin); 752 init.parent_names = clk_parents; 753 init.num_parents = 1; 754 755 priv->clk_div.reg = base + MESON_SAR_ADC_REG3; 756 priv->clk_div.shift = MESON_SAR_ADC_REG3_ADC_CLK_DIV_SHIFT; 757 priv->clk_div.width = MESON_SAR_ADC_REG3_ADC_CLK_DIV_WIDTH; 758 priv->clk_div.hw.init = &init; 759 priv->clk_div.flags = 0; 760 761 priv->adc_div_clk = devm_clk_register(dev, &priv->clk_div.hw); 762 if (WARN_ON(IS_ERR(priv->adc_div_clk))) 763 return PTR_ERR(priv->adc_div_clk); 764 765 init.name = devm_kasprintf(dev, GFP_KERNEL, "%s#adc_en", dev_name(dev)); 766 if (!init.name) 767 return -ENOMEM; 768 769 init.flags = CLK_SET_RATE_PARENT; 770 init.ops = &clk_gate_ops; 771 clk_parents[0] = __clk_get_name(priv->adc_div_clk); 772 init.parent_names = clk_parents; 773 init.num_parents = 1; 774 775 priv->clk_gate.reg = base + MESON_SAR_ADC_REG3; 776 priv->clk_gate.bit_idx = __ffs(MESON_SAR_ADC_REG3_CLK_EN); 777 priv->clk_gate.hw.init = &init; 778 779 priv->adc_clk = devm_clk_register(dev, &priv->clk_gate.hw); 780 if (WARN_ON(IS_ERR(priv->adc_clk))) 781 return PTR_ERR(priv->adc_clk); 782 783 return 0; 784 } 785 786 static int meson_sar_adc_temp_sensor_init(struct iio_dev *indio_dev) 787 { 788 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 789 u8 *buf, trimming_bits, trimming_mask, upper_adc_val; 790 struct device *dev = indio_dev->dev.parent; 791 struct nvmem_cell *temperature_calib; 792 size_t read_len; 793 int ret; 794 795 temperature_calib = nvmem_cell_get(dev, "temperature_calib"); 796 if (IS_ERR(temperature_calib)) { 797 ret = PTR_ERR(temperature_calib); 798 799 /* 800 * leave the temperature sensor disabled if no calibration data 801 * was passed via nvmem-cells. 802 */ 803 if (ret == -ENODEV) 804 return 0; 805 806 return dev_err_probe(dev, ret, "failed to get temperature_calib cell\n"); 807 } 808 809 read_len = MESON_SAR_ADC_EFUSE_BYTES; 810 buf = nvmem_cell_read(temperature_calib, &read_len); 811 nvmem_cell_put(temperature_calib); 812 if (IS_ERR(buf)) 813 return dev_err_probe(dev, PTR_ERR(buf), "failed to read temperature_calib cell\n"); 814 if (read_len != MESON_SAR_ADC_EFUSE_BYTES) { 815 kfree(buf); 816 return dev_err_probe(dev, -EINVAL, "invalid read size of temperature_calib cell\n"); 817 } 818 819 priv->tsc_regmap = syscon_regmap_lookup_by_phandle(dev->of_node, "amlogic,hhi-sysctrl"); 820 if (IS_ERR(priv->tsc_regmap)) 821 return dev_err_probe(dev, PTR_ERR(priv->tsc_regmap), 822 "failed to get amlogic,hhi-sysctrl regmap\n"); 823 824 trimming_bits = priv->param->temperature_trimming_bits; 825 trimming_mask = BIT(trimming_bits) - 1; 826 827 priv->temperature_sensor_calibrated = 828 buf[3] & MESON_SAR_ADC_EFUSE_BYTE3_IS_CALIBRATED; 829 priv->temperature_sensor_coefficient = buf[2] & trimming_mask; 830 831 upper_adc_val = FIELD_GET(MESON_SAR_ADC_EFUSE_BYTE3_UPPER_ADC_VAL, 832 buf[3]); 833 834 priv->temperature_sensor_adc_val = buf[2]; 835 priv->temperature_sensor_adc_val |= upper_adc_val << BITS_PER_BYTE; 836 priv->temperature_sensor_adc_val >>= trimming_bits; 837 838 kfree(buf); 839 840 return 0; 841 } 842 843 static int meson_sar_adc_init(struct iio_dev *indio_dev) 844 { 845 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 846 struct device *dev = indio_dev->dev.parent; 847 int regval, i, ret; 848 849 /* 850 * make sure we start at CH7 input since the other muxes are only used 851 * for internal calibration. 852 */ 853 meson_sar_adc_set_chan7_mux(indio_dev, CHAN7_MUX_CH7_INPUT); 854 855 if (priv->param->has_bl30_integration) { 856 /* 857 * leave sampling delay and the input clocks as configured by 858 * BL30 to make sure BL30 gets the values it expects when 859 * reading the temperature sensor. 860 */ 861 regmap_read(priv->regmap, MESON_SAR_ADC_REG3, ®val); 862 if (regval & MESON_SAR_ADC_REG3_BL30_INITIALIZED) 863 return 0; 864 } 865 866 meson_sar_adc_stop_sample_engine(indio_dev); 867 868 /* 869 * disable this bit as seems to be only relevant for Meson6 (based 870 * on the vendor driver), which we don't support at the moment. 871 */ 872 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_REG0, 873 MESON_SAR_ADC_REG0_ADC_TEMP_SEN_SEL); 874 875 /* disable all channels by default */ 876 regmap_write(priv->regmap, MESON_SAR_ADC_CHAN_LIST, 0x0); 877 878 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_REG3, 879 MESON_SAR_ADC_REG3_CTRL_SAMPLING_CLOCK_PHASE); 880 regmap_set_bits(priv->regmap, MESON_SAR_ADC_REG3, 881 MESON_SAR_ADC_REG3_CNTL_USE_SC_DLY); 882 883 /* delay between two samples = (10+1) * 1uS */ 884 regmap_update_bits(priv->regmap, MESON_SAR_ADC_DELAY, 885 MESON_SAR_ADC_DELAY_INPUT_DLY_CNT_MASK, 886 FIELD_PREP(MESON_SAR_ADC_DELAY_SAMPLE_DLY_CNT_MASK, 887 10)); 888 regmap_update_bits(priv->regmap, MESON_SAR_ADC_DELAY, 889 MESON_SAR_ADC_DELAY_SAMPLE_DLY_SEL_MASK, 890 FIELD_PREP(MESON_SAR_ADC_DELAY_SAMPLE_DLY_SEL_MASK, 891 0)); 892 893 /* delay between two samples = (10+1) * 1uS */ 894 regmap_update_bits(priv->regmap, MESON_SAR_ADC_DELAY, 895 MESON_SAR_ADC_DELAY_INPUT_DLY_CNT_MASK, 896 FIELD_PREP(MESON_SAR_ADC_DELAY_INPUT_DLY_CNT_MASK, 897 10)); 898 regmap_update_bits(priv->regmap, MESON_SAR_ADC_DELAY, 899 MESON_SAR_ADC_DELAY_INPUT_DLY_SEL_MASK, 900 FIELD_PREP(MESON_SAR_ADC_DELAY_INPUT_DLY_SEL_MASK, 901 1)); 902 903 /* 904 * set up the input channel muxes in MESON_SAR_ADC_CHAN_10_SW 905 * (0 = SAR_ADC_CH0, 1 = SAR_ADC_CH1) 906 */ 907 regval = FIELD_PREP(MESON_SAR_ADC_CHAN_10_SW_CHAN0_MUX_SEL_MASK, 0); 908 regmap_update_bits(priv->regmap, MESON_SAR_ADC_CHAN_10_SW, 909 MESON_SAR_ADC_CHAN_10_SW_CHAN0_MUX_SEL_MASK, 910 regval); 911 regval = FIELD_PREP(MESON_SAR_ADC_CHAN_10_SW_CHAN1_MUX_SEL_MASK, 1); 912 regmap_update_bits(priv->regmap, MESON_SAR_ADC_CHAN_10_SW, 913 MESON_SAR_ADC_CHAN_10_SW_CHAN1_MUX_SEL_MASK, 914 regval); 915 916 regmap_set_bits(priv->regmap, MESON_SAR_ADC_CHAN_10_SW, 917 MESON_SAR_ADC_CHAN_10_SW_CHAN0_XP_DRIVE_SW); 918 919 regmap_set_bits(priv->regmap, MESON_SAR_ADC_CHAN_10_SW, 920 MESON_SAR_ADC_CHAN_10_SW_CHAN0_YP_DRIVE_SW); 921 922 regmap_set_bits(priv->regmap, MESON_SAR_ADC_CHAN_10_SW, 923 MESON_SAR_ADC_CHAN_10_SW_CHAN1_XP_DRIVE_SW); 924 925 regmap_set_bits(priv->regmap, MESON_SAR_ADC_CHAN_10_SW, 926 MESON_SAR_ADC_CHAN_10_SW_CHAN1_YP_DRIVE_SW); 927 928 /* 929 * set up the input channel muxes in MESON_SAR_ADC_AUX_SW 930 * (2 = SAR_ADC_CH2, 3 = SAR_ADC_CH3, ...) and enable 931 * MESON_SAR_ADC_AUX_SW_YP_DRIVE_SW and 932 * MESON_SAR_ADC_AUX_SW_XP_DRIVE_SW like the vendor driver. 933 */ 934 regval = 0; 935 for (i = 2; i <= 7; i++) 936 regval |= i << MESON_SAR_ADC_AUX_SW_MUX_SEL_CHAN_SHIFT(i); 937 regval |= MESON_SAR_ADC_AUX_SW_YP_DRIVE_SW; 938 regval |= MESON_SAR_ADC_AUX_SW_XP_DRIVE_SW; 939 regmap_write(priv->regmap, MESON_SAR_ADC_AUX_SW, regval); 940 941 if (priv->temperature_sensor_calibrated) { 942 regmap_set_bits(priv->regmap, MESON_SAR_ADC_DELTA_10, 943 MESON_SAR_ADC_DELTA_10_TS_REVE1); 944 regmap_set_bits(priv->regmap, MESON_SAR_ADC_DELTA_10, 945 MESON_SAR_ADC_DELTA_10_TS_REVE0); 946 947 /* 948 * set bits [3:0] of the TSC (temperature sensor coefficient) 949 * to get the correct values when reading the temperature. 950 */ 951 regval = FIELD_PREP(MESON_SAR_ADC_DELTA_10_TS_C_MASK, 952 priv->temperature_sensor_coefficient); 953 regmap_update_bits(priv->regmap, MESON_SAR_ADC_DELTA_10, 954 MESON_SAR_ADC_DELTA_10_TS_C_MASK, regval); 955 956 if (priv->param->temperature_trimming_bits == 5) { 957 if (priv->temperature_sensor_coefficient & BIT(4)) 958 regval = MESON_HHI_DPLL_TOP_0_TSC_BIT4; 959 else 960 regval = 0; 961 962 /* 963 * bit [4] (the 5th bit when starting to count at 1) 964 * of the TSC is located in the HHI register area. 965 */ 966 regmap_update_bits(priv->tsc_regmap, 967 MESON_HHI_DPLL_TOP_0, 968 MESON_HHI_DPLL_TOP_0_TSC_BIT4, 969 regval); 970 } 971 } else { 972 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_DELTA_10, 973 MESON_SAR_ADC_DELTA_10_TS_REVE1); 974 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_DELTA_10, 975 MESON_SAR_ADC_DELTA_10_TS_REVE0); 976 } 977 978 regval = FIELD_PREP(MESON_SAR_ADC_REG3_CTRL_CONT_RING_COUNTER_EN, 979 priv->param->disable_ring_counter); 980 regmap_update_bits(priv->regmap, MESON_SAR_ADC_REG3, 981 MESON_SAR_ADC_REG3_CTRL_CONT_RING_COUNTER_EN, 982 regval); 983 984 if (priv->param->regmap_config->max_register >= MESON_SAR_ADC_REG11) { 985 regval = FIELD_PREP(MESON_SAR_ADC_REG11_EOC, priv->param->adc_eoc); 986 regmap_update_bits(priv->regmap, MESON_SAR_ADC_REG11, 987 MESON_SAR_ADC_REG11_EOC, regval); 988 989 if (priv->param->has_vref_select) { 990 regval = FIELD_PREP(MESON_SAR_ADC_REG11_VREF_SEL, 991 priv->param->vref_select); 992 regmap_update_bits(priv->regmap, MESON_SAR_ADC_REG11, 993 MESON_SAR_ADC_REG11_VREF_SEL, regval); 994 } 995 996 regval = FIELD_PREP(MESON_SAR_ADC_REG11_VREF_VOLTAGE, 997 priv->param->vref_voltage); 998 regmap_update_bits(priv->regmap, MESON_SAR_ADC_REG11, 999 MESON_SAR_ADC_REG11_VREF_VOLTAGE, regval); 1000 1001 regval = FIELD_PREP(MESON_SAR_ADC_REG11_CMV_SEL, 1002 priv->param->cmv_select); 1003 regmap_update_bits(priv->regmap, MESON_SAR_ADC_REG11, 1004 MESON_SAR_ADC_REG11_CMV_SEL, regval); 1005 1006 if (priv->param->enable_mpll_clock_workaround) { 1007 dev_warn(dev, 1008 "Enabling unknown bits to make the MPLL clocks work. This may change so always update dtbs and kernel together\n"); 1009 regmap_write(priv->regmap, MESON_SAR_ADC_REG12, 1010 MESON_SAR_ADC_REG12_MPLL0_UNKNOWN | 1011 MESON_SAR_ADC_REG12_MPLL1_UNKNOWN | 1012 MESON_SAR_ADC_REG12_MPLL2_UNKNOWN); 1013 } 1014 } 1015 1016 ret = clk_set_parent(priv->adc_sel_clk, priv->clkin); 1017 if (ret) 1018 return dev_err_probe(dev, ret, "failed to set adc parent to clkin\n"); 1019 1020 ret = clk_set_rate(priv->adc_clk, priv->param->clock_rate); 1021 if (ret) 1022 return dev_err_probe(dev, ret, "failed to set adc clock rate\n"); 1023 1024 return 0; 1025 } 1026 1027 static void meson_sar_adc_set_bandgap(struct iio_dev *indio_dev, bool on_off) 1028 { 1029 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 1030 1031 if (priv->param->regmap_config->max_register >= MESON_SAR_ADC_REG11) 1032 regmap_update_bits(priv->regmap, MESON_SAR_ADC_REG11, 1033 MESON_SAR_ADC_REG11_BANDGAP_EN, 1034 on_off ? MESON_SAR_ADC_REG11_BANDGAP_EN : 0); 1035 else 1036 regmap_update_bits(priv->regmap, MESON_SAR_ADC_DELTA_10, 1037 MESON_SAR_ADC_DELTA_10_TS_VBG_EN, 1038 on_off ? MESON_SAR_ADC_DELTA_10_TS_VBG_EN : 0); 1039 } 1040 1041 static int meson_sar_adc_hw_enable(struct iio_dev *indio_dev) 1042 { 1043 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 1044 struct device *dev = indio_dev->dev.parent; 1045 int ret; 1046 u32 regval; 1047 1048 ret = meson_sar_adc_lock(indio_dev); 1049 if (ret) { 1050 dev_err(dev, "failed to lock adc\n"); 1051 goto err_lock; 1052 } 1053 1054 ret = regulator_enable(priv->vref); 1055 if (ret < 0) { 1056 dev_err(dev, "failed to enable vref regulator\n"); 1057 goto err_vref; 1058 } 1059 1060 regval = FIELD_PREP(MESON_SAR_ADC_REG0_FIFO_CNT_IRQ_MASK, 1); 1061 regmap_update_bits(priv->regmap, MESON_SAR_ADC_REG0, 1062 MESON_SAR_ADC_REG0_FIFO_CNT_IRQ_MASK, regval); 1063 1064 meson_sar_adc_set_bandgap(indio_dev, true); 1065 1066 regmap_set_bits(priv->regmap, MESON_SAR_ADC_REG3, 1067 MESON_SAR_ADC_REG3_ADC_EN); 1068 1069 udelay(5); 1070 1071 ret = clk_prepare_enable(priv->adc_clk); 1072 if (ret) { 1073 dev_err(dev, "failed to enable adc clk\n"); 1074 goto err_adc_clk; 1075 } 1076 1077 meson_sar_adc_unlock(indio_dev); 1078 1079 return 0; 1080 1081 err_adc_clk: 1082 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_REG3, 1083 MESON_SAR_ADC_REG3_ADC_EN); 1084 meson_sar_adc_set_bandgap(indio_dev, false); 1085 regulator_disable(priv->vref); 1086 err_vref: 1087 meson_sar_adc_unlock(indio_dev); 1088 err_lock: 1089 return ret; 1090 } 1091 1092 static void meson_sar_adc_hw_disable(struct iio_dev *indio_dev) 1093 { 1094 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 1095 int ret; 1096 1097 /* 1098 * If taking the lock fails we have to assume that BL30 is broken. The 1099 * best we can do then is to release the resources anyhow. 1100 */ 1101 ret = meson_sar_adc_lock(indio_dev); 1102 if (ret) 1103 dev_err(indio_dev->dev.parent, "Failed to lock ADC (%pE)\n", ERR_PTR(ret)); 1104 1105 clk_disable_unprepare(priv->adc_clk); 1106 1107 regmap_clear_bits(priv->regmap, MESON_SAR_ADC_REG3, 1108 MESON_SAR_ADC_REG3_ADC_EN); 1109 1110 meson_sar_adc_set_bandgap(indio_dev, false); 1111 1112 regulator_disable(priv->vref); 1113 1114 if (!ret) 1115 meson_sar_adc_unlock(indio_dev); 1116 } 1117 1118 static irqreturn_t meson_sar_adc_irq(int irq, void *data) 1119 { 1120 struct iio_dev *indio_dev = data; 1121 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 1122 unsigned int cnt, threshold; 1123 u32 regval; 1124 1125 regmap_read(priv->regmap, MESON_SAR_ADC_REG0, ®val); 1126 cnt = FIELD_GET(MESON_SAR_ADC_REG0_FIFO_COUNT_MASK, regval); 1127 threshold = FIELD_GET(MESON_SAR_ADC_REG0_FIFO_CNT_IRQ_MASK, regval); 1128 1129 if (cnt < threshold) 1130 return IRQ_NONE; 1131 1132 complete(&priv->done); 1133 1134 return IRQ_HANDLED; 1135 } 1136 1137 static int meson_sar_adc_calib(struct iio_dev *indio_dev) 1138 { 1139 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 1140 int ret, nominal0, nominal1, value0, value1; 1141 1142 /* use points 25% and 75% for calibration */ 1143 nominal0 = (1 << priv->param->resolution) / 4; 1144 nominal1 = (1 << priv->param->resolution) * 3 / 4; 1145 1146 meson_sar_adc_set_chan7_mux(indio_dev, CHAN7_MUX_VDD_DIV4); 1147 usleep_range(10, 20); 1148 ret = meson_sar_adc_get_sample(indio_dev, 1149 find_channel_by_num(indio_dev, 1150 NUM_MUX_1_VDD_DIV4), 1151 MEAN_AVERAGING, EIGHT_SAMPLES, &value0); 1152 if (ret < 0) 1153 goto out; 1154 1155 meson_sar_adc_set_chan7_mux(indio_dev, CHAN7_MUX_VDD_MUL3_DIV4); 1156 usleep_range(10, 20); 1157 ret = meson_sar_adc_get_sample(indio_dev, 1158 find_channel_by_num(indio_dev, 1159 NUM_MUX_3_VDD_MUL3_DIV4), 1160 MEAN_AVERAGING, EIGHT_SAMPLES, &value1); 1161 if (ret < 0) 1162 goto out; 1163 1164 if (value1 <= value0) { 1165 ret = -EINVAL; 1166 goto out; 1167 } 1168 1169 priv->calibscale = div_s64((nominal1 - nominal0) * (s64)MILLION, 1170 value1 - value0); 1171 priv->calibbias = nominal0 - div_s64((s64)value0 * priv->calibscale, 1172 MILLION); 1173 ret = 0; 1174 out: 1175 meson_sar_adc_set_chan7_mux(indio_dev, CHAN7_MUX_CH7_INPUT); 1176 1177 return ret; 1178 } 1179 1180 static int read_label(struct iio_dev *indio_dev, 1181 struct iio_chan_spec const *chan, 1182 char *label) 1183 { 1184 if (chan->type == IIO_TEMP) 1185 return sysfs_emit(label, "temp-sensor\n"); 1186 if (chan->type == IIO_VOLTAGE && chan->channel >= NUM_MUX_0_VSS) 1187 return sysfs_emit(label, "%s\n", 1188 chan7_mux_names[chan->channel - NUM_MUX_0_VSS]); 1189 if (chan->type == IIO_VOLTAGE) 1190 return sysfs_emit(label, "channel-%d\n", chan->channel); 1191 return 0; 1192 } 1193 1194 static const struct iio_info meson_sar_adc_iio_info = { 1195 .read_raw = meson_sar_adc_iio_info_read_raw, 1196 .read_label = read_label, 1197 }; 1198 1199 static const struct meson_sar_adc_param meson_sar_adc_meson8_param = { 1200 .has_bl30_integration = false, 1201 .clock_rate = 1150000, 1202 .regmap_config = &meson_sar_adc_regmap_config_meson8, 1203 .resolution = 10, 1204 .temperature_trimming_bits = 4, 1205 .temperature_multiplier = 18 * 10000, 1206 .temperature_divider = 1024 * 10 * 85, 1207 }; 1208 1209 static const struct meson_sar_adc_param meson_sar_adc_meson8b_param = { 1210 .has_bl30_integration = false, 1211 .clock_rate = 1150000, 1212 .regmap_config = &meson_sar_adc_regmap_config_meson8, 1213 .resolution = 10, 1214 .temperature_trimming_bits = 5, 1215 .temperature_multiplier = 10, 1216 .temperature_divider = 32, 1217 }; 1218 1219 static const struct meson_sar_adc_param meson_sar_adc_gxbb_param = { 1220 .has_bl30_integration = true, 1221 .clock_rate = 1200000, 1222 .regmap_config = &meson_sar_adc_regmap_config_gxbb, 1223 .resolution = 10, 1224 .vref_voltage = 1, 1225 .cmv_select = 1, 1226 }; 1227 1228 static const struct meson_sar_adc_param meson_sar_adc_gxl_param = { 1229 .has_bl30_integration = true, 1230 .clock_rate = 1200000, 1231 .regmap_config = &meson_sar_adc_regmap_config_gxbb, 1232 .resolution = 12, 1233 .disable_ring_counter = 1, 1234 .vref_voltage = 1, 1235 .cmv_select = 1, 1236 }; 1237 1238 static const struct meson_sar_adc_param meson_sar_adc_gxlx_param = { 1239 .has_bl30_integration = true, 1240 .clock_rate = 1200000, 1241 .regmap_config = &meson_sar_adc_regmap_config_gxbb, 1242 .resolution = 12, 1243 .disable_ring_counter = 1, 1244 .vref_voltage = 1, 1245 .cmv_select = true, 1246 .enable_mpll_clock_workaround = true, 1247 }; 1248 1249 static const struct meson_sar_adc_param meson_sar_adc_axg_param = { 1250 .has_bl30_integration = true, 1251 .clock_rate = 1200000, 1252 .regmap_config = &meson_sar_adc_regmap_config_gxbb, 1253 .resolution = 12, 1254 .disable_ring_counter = 1, 1255 .vref_voltage = 1, 1256 .has_vref_select = true, 1257 .vref_select = VREF_VDDA, 1258 .cmv_select = 1, 1259 }; 1260 1261 static const struct meson_sar_adc_param meson_sar_adc_g12a_param = { 1262 .has_bl30_integration = false, 1263 .clock_rate = 1200000, 1264 .regmap_config = &meson_sar_adc_regmap_config_gxbb, 1265 .resolution = 12, 1266 .disable_ring_counter = 1, 1267 .adc_eoc = 1, 1268 .has_vref_select = true, 1269 .vref_select = VREF_VDDA, 1270 }; 1271 1272 static const struct meson_sar_adc_data meson_sar_adc_meson8_data = { 1273 .param = &meson_sar_adc_meson8_param, 1274 .name = "meson-meson8-saradc", 1275 }; 1276 1277 static const struct meson_sar_adc_data meson_sar_adc_meson8b_data = { 1278 .param = &meson_sar_adc_meson8b_param, 1279 .name = "meson-meson8b-saradc", 1280 }; 1281 1282 static const struct meson_sar_adc_data meson_sar_adc_meson8m2_data = { 1283 .param = &meson_sar_adc_meson8b_param, 1284 .name = "meson-meson8m2-saradc", 1285 }; 1286 1287 static const struct meson_sar_adc_data meson_sar_adc_gxbb_data = { 1288 .param = &meson_sar_adc_gxbb_param, 1289 .name = "meson-gxbb-saradc", 1290 }; 1291 1292 static const struct meson_sar_adc_data meson_sar_adc_gxl_data = { 1293 .param = &meson_sar_adc_gxl_param, 1294 .name = "meson-gxl-saradc", 1295 }; 1296 1297 static const struct meson_sar_adc_data meson_sar_adc_gxlx_data = { 1298 .param = &meson_sar_adc_gxlx_param, 1299 .name = "meson-gxlx-saradc", 1300 }; 1301 1302 static const struct meson_sar_adc_data meson_sar_adc_gxm_data = { 1303 .param = &meson_sar_adc_gxl_param, 1304 .name = "meson-gxm-saradc", 1305 }; 1306 1307 static const struct meson_sar_adc_data meson_sar_adc_axg_data = { 1308 .param = &meson_sar_adc_axg_param, 1309 .name = "meson-axg-saradc", 1310 }; 1311 1312 static const struct meson_sar_adc_data meson_sar_adc_g12a_data = { 1313 .param = &meson_sar_adc_g12a_param, 1314 .name = "meson-g12a-saradc", 1315 }; 1316 1317 static const struct meson_sar_adc_data meson_sar_adc_s4_data = { 1318 .param = &meson_sar_adc_g12a_param, 1319 .name = "meson-s4-saradc", 1320 }; 1321 1322 static const struct of_device_id meson_sar_adc_of_match[] = { 1323 { 1324 .compatible = "amlogic,meson8-saradc", 1325 .data = &meson_sar_adc_meson8_data, 1326 }, { 1327 .compatible = "amlogic,meson8b-saradc", 1328 .data = &meson_sar_adc_meson8b_data, 1329 }, { 1330 .compatible = "amlogic,meson8m2-saradc", 1331 .data = &meson_sar_adc_meson8m2_data, 1332 }, { 1333 .compatible = "amlogic,meson-gxbb-saradc", 1334 .data = &meson_sar_adc_gxbb_data, 1335 }, { 1336 .compatible = "amlogic,meson-gxl-saradc", 1337 .data = &meson_sar_adc_gxl_data, 1338 }, { 1339 .compatible = "amlogic,meson-gxlx-saradc", 1340 .data = &meson_sar_adc_gxlx_data, 1341 }, { 1342 .compatible = "amlogic,meson-gxm-saradc", 1343 .data = &meson_sar_adc_gxm_data, 1344 }, { 1345 .compatible = "amlogic,meson-axg-saradc", 1346 .data = &meson_sar_adc_axg_data, 1347 }, { 1348 .compatible = "amlogic,meson-g12a-saradc", 1349 .data = &meson_sar_adc_g12a_data, 1350 }, { 1351 .compatible = "amlogic,meson-s4-saradc", 1352 .data = &meson_sar_adc_s4_data, 1353 }, 1354 { } 1355 }; 1356 MODULE_DEVICE_TABLE(of, meson_sar_adc_of_match); 1357 1358 static int meson_sar_adc_probe(struct platform_device *pdev) 1359 { 1360 const struct meson_sar_adc_data *match_data; 1361 struct meson_sar_adc_priv *priv; 1362 struct device *dev = &pdev->dev; 1363 struct iio_dev *indio_dev; 1364 void __iomem *base; 1365 int irq, ret; 1366 1367 indio_dev = devm_iio_device_alloc(dev, sizeof(*priv)); 1368 if (!indio_dev) 1369 return -ENOMEM; 1370 1371 priv = iio_priv(indio_dev); 1372 init_completion(&priv->done); 1373 1374 match_data = of_device_get_match_data(dev); 1375 if (!match_data) 1376 return dev_err_probe(dev, -ENODEV, "failed to get match data\n"); 1377 1378 priv->param = match_data->param; 1379 1380 indio_dev->name = match_data->name; 1381 indio_dev->modes = INDIO_DIRECT_MODE; 1382 indio_dev->info = &meson_sar_adc_iio_info; 1383 1384 base = devm_platform_ioremap_resource(pdev, 0); 1385 if (IS_ERR(base)) 1386 return PTR_ERR(base); 1387 1388 priv->regmap = devm_regmap_init_mmio(dev, base, priv->param->regmap_config); 1389 if (IS_ERR(priv->regmap)) 1390 return dev_err_probe(dev, PTR_ERR(priv->regmap), "failed to init regmap\n"); 1391 1392 irq = irq_of_parse_and_map(dev->of_node, 0); 1393 if (!irq) 1394 return dev_err_probe(dev, -EINVAL, "failed to get irq\n"); 1395 1396 ret = devm_request_irq(dev, irq, meson_sar_adc_irq, IRQF_SHARED, dev_name(dev), indio_dev); 1397 if (ret) 1398 return dev_err_probe(dev, ret, "failed to request irq\n"); 1399 1400 priv->clkin = devm_clk_get(dev, "clkin"); 1401 if (IS_ERR(priv->clkin)) 1402 return dev_err_probe(dev, PTR_ERR(priv->clkin), "failed to get clkin\n"); 1403 1404 priv->core_clk = devm_clk_get_enabled(dev, "core"); 1405 if (IS_ERR(priv->core_clk)) 1406 return dev_err_probe(dev, PTR_ERR(priv->core_clk), "failed to get core clk\n"); 1407 1408 priv->adc_clk = devm_clk_get_optional(dev, "adc_clk"); 1409 if (IS_ERR(priv->adc_clk)) 1410 return dev_err_probe(dev, PTR_ERR(priv->adc_clk), "failed to get adc clk\n"); 1411 1412 priv->adc_sel_clk = devm_clk_get_optional(dev, "adc_sel"); 1413 if (IS_ERR(priv->adc_sel_clk)) 1414 return dev_err_probe(dev, PTR_ERR(priv->adc_sel_clk), "failed to get adc_sel clk\n"); 1415 1416 /* on pre-GXBB SoCs the SAR ADC itself provides the ADC clock: */ 1417 if (!priv->adc_clk) { 1418 ret = meson_sar_adc_clk_init(indio_dev, base); 1419 if (ret) 1420 return dev_err_probe(dev, ret, "failed to init internal clk\n"); 1421 } 1422 1423 priv->vref = devm_regulator_get(dev, "vref"); 1424 if (IS_ERR(priv->vref)) 1425 return dev_err_probe(dev, PTR_ERR(priv->vref), "failed to get vref regulator\n"); 1426 1427 priv->calibscale = MILLION; 1428 1429 if (priv->param->temperature_trimming_bits) { 1430 ret = meson_sar_adc_temp_sensor_init(indio_dev); 1431 if (ret) 1432 return ret; 1433 } 1434 1435 if (priv->temperature_sensor_calibrated) { 1436 indio_dev->channels = meson_sar_adc_and_temp_iio_channels; 1437 indio_dev->num_channels = 1438 ARRAY_SIZE(meson_sar_adc_and_temp_iio_channels); 1439 } else { 1440 indio_dev->channels = meson_sar_adc_iio_channels; 1441 indio_dev->num_channels = 1442 ARRAY_SIZE(meson_sar_adc_iio_channels); 1443 } 1444 1445 ret = meson_sar_adc_init(indio_dev); 1446 if (ret) 1447 goto err; 1448 1449 mutex_init(&priv->lock); 1450 1451 ret = meson_sar_adc_hw_enable(indio_dev); 1452 if (ret) 1453 goto err; 1454 1455 ret = meson_sar_adc_calib(indio_dev); 1456 if (ret) 1457 dev_warn(dev, "calibration failed\n"); 1458 1459 platform_set_drvdata(pdev, indio_dev); 1460 1461 ret = iio_device_register(indio_dev); 1462 if (ret) { 1463 dev_err_probe(dev, ret, "failed to register iio device\n"); 1464 goto err_hw; 1465 } 1466 1467 return 0; 1468 1469 err_hw: 1470 meson_sar_adc_hw_disable(indio_dev); 1471 err: 1472 return ret; 1473 } 1474 1475 static void meson_sar_adc_remove(struct platform_device *pdev) 1476 { 1477 struct iio_dev *indio_dev = platform_get_drvdata(pdev); 1478 1479 iio_device_unregister(indio_dev); 1480 1481 meson_sar_adc_hw_disable(indio_dev); 1482 } 1483 1484 static int meson_sar_adc_suspend(struct device *dev) 1485 { 1486 struct iio_dev *indio_dev = dev_get_drvdata(dev); 1487 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 1488 1489 meson_sar_adc_hw_disable(indio_dev); 1490 1491 clk_disable_unprepare(priv->core_clk); 1492 1493 return 0; 1494 } 1495 1496 static int meson_sar_adc_resume(struct device *dev) 1497 { 1498 struct iio_dev *indio_dev = dev_get_drvdata(dev); 1499 struct meson_sar_adc_priv *priv = iio_priv(indio_dev); 1500 int ret; 1501 1502 ret = clk_prepare_enable(priv->core_clk); 1503 if (ret) { 1504 dev_err(dev, "failed to enable core clk\n"); 1505 return ret; 1506 } 1507 1508 return meson_sar_adc_hw_enable(indio_dev); 1509 } 1510 1511 static DEFINE_SIMPLE_DEV_PM_OPS(meson_sar_adc_pm_ops, 1512 meson_sar_adc_suspend, meson_sar_adc_resume); 1513 1514 static struct platform_driver meson_sar_adc_driver = { 1515 .probe = meson_sar_adc_probe, 1516 .remove = meson_sar_adc_remove, 1517 .driver = { 1518 .name = "meson-saradc", 1519 .of_match_table = meson_sar_adc_of_match, 1520 .pm = pm_sleep_ptr(&meson_sar_adc_pm_ops), 1521 }, 1522 }; 1523 1524 module_platform_driver(meson_sar_adc_driver); 1525 1526 MODULE_AUTHOR("Martin Blumenstingl <martin.blumenstingl@googlemail.com>"); 1527 MODULE_DESCRIPTION("Amlogic Meson SAR ADC driver"); 1528 MODULE_LICENSE("GPL v2"); 1529