aspeed_adc.c 21 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Aspeed AST2400/2500/2600 ADC
  4. *
  5. * Copyright (C) 2017 Google, Inc.
  6. * Copyright (C) 2021 Aspeed Technology Inc.
  7. *
  8. * ADC clock formula:
  9. * Ast2400/Ast2500:
  10. * clock period = period of PCLK * 2 * (ADC0C[31:17] + 1) * (ADC0C[9:0] + 1)
  11. * Ast2600:
  12. * clock period = period of PCLK * 2 * (ADC0C[15:0] + 1)
  13. */
  14. #include <linux/clk.h>
  15. #include <linux/clk-provider.h>
  16. #include <linux/err.h>
  17. #include <linux/errno.h>
  18. #include <linux/io.h>
  19. #include <linux/module.h>
  20. #include <linux/of_platform.h>
  21. #include <linux/platform_device.h>
  22. #include <linux/regulator/consumer.h>
  23. #include <linux/reset.h>
  24. #include <linux/spinlock.h>
  25. #include <linux/types.h>
  26. #include <linux/bitfield.h>
  27. #include <linux/regmap.h>
  28. #include <linux/mfd/syscon.h>
  29. #include <linux/iio/iio.h>
  30. #include <linux/iio/driver.h>
  31. #include <linux/iopoll.h>
  32. #define ASPEED_RESOLUTION_BITS 10
  33. #define ASPEED_CLOCKS_PER_SAMPLE 12
  34. #define ASPEED_REG_ENGINE_CONTROL 0x00
  35. #define ASPEED_REG_INTERRUPT_CONTROL 0x04
  36. #define ASPEED_REG_VGA_DETECT_CONTROL 0x08
  37. #define ASPEED_REG_CLOCK_CONTROL 0x0C
  38. #define ASPEED_REG_COMPENSATION_TRIM 0xC4
  39. /*
  40. * The register offset between 0xC8~0xCC can be read and won't affect the
  41. * hardware logic in each version of ADC.
  42. */
  43. #define ASPEED_REG_MAX 0xD0
  44. #define ASPEED_ADC_ENGINE_ENABLE BIT(0)
  45. #define ASPEED_ADC_OP_MODE GENMASK(3, 1)
  46. #define ASPEED_ADC_OP_MODE_PWR_DOWN 0
  47. #define ASPEED_ADC_OP_MODE_STANDBY 1
  48. #define ASPEED_ADC_OP_MODE_NORMAL 7
  49. #define ASPEED_ADC_CTRL_COMPENSATION BIT(4)
  50. #define ASPEED_ADC_AUTO_COMPENSATION BIT(5)
  51. /*
  52. * Bit 6 determines not only the reference voltage range but also the dividing
  53. * circuit for battery sensing.
  54. */
  55. #define ASPEED_ADC_REF_VOLTAGE GENMASK(7, 6)
  56. #define ASPEED_ADC_REF_VOLTAGE_2500mV 0
  57. #define ASPEED_ADC_REF_VOLTAGE_1200mV 1
  58. #define ASPEED_ADC_REF_VOLTAGE_EXT_HIGH 2
  59. #define ASPEED_ADC_REF_VOLTAGE_EXT_LOW 3
  60. #define ASPEED_ADC_BAT_SENSING_DIV BIT(6)
  61. #define ASPEED_ADC_BAT_SENSING_DIV_2_3 0
  62. #define ASPEED_ADC_BAT_SENSING_DIV_1_3 1
  63. #define ASPEED_ADC_CTRL_INIT_RDY BIT(8)
  64. #define ASPEED_ADC_CH7_MODE BIT(12)
  65. #define ASPEED_ADC_CH7_NORMAL 0
  66. #define ASPEED_ADC_CH7_BAT 1
  67. #define ASPEED_ADC_BAT_SENSING_ENABLE BIT(13)
  68. #define ASPEED_ADC_CTRL_CHANNEL GENMASK(31, 16)
  69. #define ASPEED_ADC_CTRL_CHANNEL_ENABLE(ch) FIELD_PREP(ASPEED_ADC_CTRL_CHANNEL, BIT(ch))
  70. #define ASPEED_ADC_INIT_POLLING_TIME 500
  71. #define ASPEED_ADC_INIT_TIMEOUT 500000
  72. /*
  73. * When the sampling rate is too high, the ADC may not have enough charging
  74. * time, resulting in a low voltage value. Thus, the default uses a slow
  75. * sampling rate for most use cases.
  76. */
  77. #define ASPEED_ADC_DEF_SAMPLING_RATE 65000
  78. struct aspeed_adc_trim_locate {
  79. const unsigned int offset;
  80. const unsigned int field;
  81. };
  82. struct aspeed_adc_model_data {
  83. const char *model_name;
  84. unsigned int min_sampling_rate; // Hz
  85. unsigned int max_sampling_rate; // Hz
  86. unsigned int vref_fixed_mv;
  87. bool wait_init_sequence;
  88. bool need_prescaler;
  89. bool bat_sense_sup;
  90. u8 scaler_bit_width;
  91. unsigned int num_channels;
  92. const struct aspeed_adc_trim_locate *trim_locate;
  93. };
  94. struct adc_gain {
  95. u8 mult;
  96. u8 div;
  97. };
  98. struct aspeed_adc_data {
  99. struct device *dev;
  100. const struct aspeed_adc_model_data *model_data;
  101. void __iomem *base;
  102. spinlock_t clk_lock;
  103. struct clk_hw *fixed_div_clk;
  104. struct clk_hw *clk_prescaler;
  105. struct clk_hw *clk_scaler;
  106. struct reset_control *rst;
  107. int vref_mv;
  108. u32 sample_period_ns;
  109. int cv;
  110. bool battery_sensing;
  111. struct adc_gain battery_mode_gain;
  112. };
  113. #define ASPEED_CHAN(_idx, _data_reg_addr) { \
  114. .type = IIO_VOLTAGE, \
  115. .indexed = 1, \
  116. .channel = (_idx), \
  117. .address = (_data_reg_addr), \
  118. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
  119. .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
  120. BIT(IIO_CHAN_INFO_SAMP_FREQ) | \
  121. BIT(IIO_CHAN_INFO_OFFSET), \
  122. }
  123. static const struct iio_chan_spec aspeed_adc_iio_channels[] = {
  124. ASPEED_CHAN(0, 0x10),
  125. ASPEED_CHAN(1, 0x12),
  126. ASPEED_CHAN(2, 0x14),
  127. ASPEED_CHAN(3, 0x16),
  128. ASPEED_CHAN(4, 0x18),
  129. ASPEED_CHAN(5, 0x1A),
  130. ASPEED_CHAN(6, 0x1C),
  131. ASPEED_CHAN(7, 0x1E),
  132. ASPEED_CHAN(8, 0x20),
  133. ASPEED_CHAN(9, 0x22),
  134. ASPEED_CHAN(10, 0x24),
  135. ASPEED_CHAN(11, 0x26),
  136. ASPEED_CHAN(12, 0x28),
  137. ASPEED_CHAN(13, 0x2A),
  138. ASPEED_CHAN(14, 0x2C),
  139. ASPEED_CHAN(15, 0x2E),
  140. };
  141. #define ASPEED_BAT_CHAN(_idx, _data_reg_addr) { \
  142. .type = IIO_VOLTAGE, \
  143. .indexed = 1, \
  144. .channel = (_idx), \
  145. .address = (_data_reg_addr), \
  146. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
  147. BIT(IIO_CHAN_INFO_OFFSET), \
  148. .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
  149. BIT(IIO_CHAN_INFO_SAMP_FREQ), \
  150. }
  151. static const struct iio_chan_spec aspeed_adc_iio_bat_channels[] = {
  152. ASPEED_CHAN(0, 0x10),
  153. ASPEED_CHAN(1, 0x12),
  154. ASPEED_CHAN(2, 0x14),
  155. ASPEED_CHAN(3, 0x16),
  156. ASPEED_CHAN(4, 0x18),
  157. ASPEED_CHAN(5, 0x1A),
  158. ASPEED_CHAN(6, 0x1C),
  159. ASPEED_BAT_CHAN(7, 0x1E),
  160. };
  161. static int aspeed_adc_set_trim_data(struct iio_dev *indio_dev)
  162. {
  163. struct device_node *syscon;
  164. struct regmap *scu;
  165. u32 scu_otp, trimming_val;
  166. struct aspeed_adc_data *data = iio_priv(indio_dev);
  167. syscon = of_find_node_by_name(NULL, "syscon");
  168. if (syscon == NULL) {
  169. dev_warn(data->dev, "Couldn't find syscon node\n");
  170. return -EOPNOTSUPP;
  171. }
  172. scu = syscon_node_to_regmap(syscon);
  173. of_node_put(syscon);
  174. if (IS_ERR(scu)) {
  175. dev_warn(data->dev, "Failed to get syscon regmap\n");
  176. return -EOPNOTSUPP;
  177. }
  178. if (data->model_data->trim_locate) {
  179. if (regmap_read(scu, data->model_data->trim_locate->offset,
  180. &scu_otp)) {
  181. dev_warn(data->dev,
  182. "Failed to get adc trimming data\n");
  183. trimming_val = 0x8;
  184. } else {
  185. trimming_val =
  186. ((scu_otp) &
  187. (data->model_data->trim_locate->field)) >>
  188. __ffs(data->model_data->trim_locate->field);
  189. if (!trimming_val)
  190. trimming_val = 0x8;
  191. }
  192. dev_dbg(data->dev,
  193. "trimming val = %d, offset = %08x, fields = %08x\n",
  194. trimming_val, data->model_data->trim_locate->offset,
  195. data->model_data->trim_locate->field);
  196. writel(trimming_val, data->base + ASPEED_REG_COMPENSATION_TRIM);
  197. }
  198. return 0;
  199. }
  200. static int aspeed_adc_compensation(struct iio_dev *indio_dev)
  201. {
  202. struct aspeed_adc_data *data = iio_priv(indio_dev);
  203. u32 index, adc_raw = 0;
  204. u32 adc_engine_control_reg_val;
  205. adc_engine_control_reg_val =
  206. readl(data->base + ASPEED_REG_ENGINE_CONTROL);
  207. adc_engine_control_reg_val &= ~ASPEED_ADC_OP_MODE;
  208. adc_engine_control_reg_val |=
  209. (FIELD_PREP(ASPEED_ADC_OP_MODE, ASPEED_ADC_OP_MODE_NORMAL) |
  210. ASPEED_ADC_ENGINE_ENABLE);
  211. /*
  212. * Enable compensating sensing:
  213. * After that, the input voltage of ADC will force to half of the reference
  214. * voltage. So the expected reading raw data will become half of the max
  215. * value. We can get compensating value = 0x200 - ADC read raw value.
  216. * It is recommended to average at least 10 samples to get a final CV.
  217. */
  218. writel(adc_engine_control_reg_val | ASPEED_ADC_CTRL_COMPENSATION |
  219. ASPEED_ADC_CTRL_CHANNEL_ENABLE(0),
  220. data->base + ASPEED_REG_ENGINE_CONTROL);
  221. /*
  222. * After enable compensating sensing mode need to wait some time for ADC stable
  223. * Experiment result is 1ms.
  224. */
  225. mdelay(1);
  226. for (index = 0; index < 16; index++) {
  227. /*
  228. * Waiting for the sampling period ensures that the value acquired
  229. * is fresh each time.
  230. */
  231. ndelay(data->sample_period_ns);
  232. adc_raw += readw(data->base + aspeed_adc_iio_channels[0].address);
  233. }
  234. adc_raw >>= 4;
  235. data->cv = BIT(ASPEED_RESOLUTION_BITS - 1) - adc_raw;
  236. writel(adc_engine_control_reg_val,
  237. data->base + ASPEED_REG_ENGINE_CONTROL);
  238. dev_dbg(data->dev, "Compensating value = %d\n", data->cv);
  239. return 0;
  240. }
  241. static int aspeed_adc_set_sampling_rate(struct iio_dev *indio_dev, u32 rate)
  242. {
  243. struct aspeed_adc_data *data = iio_priv(indio_dev);
  244. if (rate < data->model_data->min_sampling_rate ||
  245. rate > data->model_data->max_sampling_rate)
  246. return -EINVAL;
  247. /* Each sampling needs 12 clocks to convert.*/
  248. clk_set_rate(data->clk_scaler->clk, rate * ASPEED_CLOCKS_PER_SAMPLE);
  249. rate = clk_get_rate(data->clk_scaler->clk);
  250. data->sample_period_ns = DIV_ROUND_UP_ULL(
  251. (u64)NSEC_PER_SEC * ASPEED_CLOCKS_PER_SAMPLE, rate);
  252. dev_dbg(data->dev, "Adc clock = %d sample period = %d ns", rate,
  253. data->sample_period_ns);
  254. return 0;
  255. }
  256. static int aspeed_adc_read_raw(struct iio_dev *indio_dev,
  257. struct iio_chan_spec const *chan,
  258. int *val, int *val2, long mask)
  259. {
  260. struct aspeed_adc_data *data = iio_priv(indio_dev);
  261. u32 adc_engine_control_reg_val;
  262. switch (mask) {
  263. case IIO_CHAN_INFO_RAW:
  264. if (data->battery_sensing && chan->channel == 7) {
  265. adc_engine_control_reg_val =
  266. readl(data->base + ASPEED_REG_ENGINE_CONTROL);
  267. writel(adc_engine_control_reg_val |
  268. FIELD_PREP(ASPEED_ADC_CH7_MODE,
  269. ASPEED_ADC_CH7_BAT) |
  270. ASPEED_ADC_BAT_SENSING_ENABLE,
  271. data->base + ASPEED_REG_ENGINE_CONTROL);
  272. /*
  273. * After enable battery sensing mode need to wait some time for adc stable
  274. * Experiment result is 1ms.
  275. */
  276. mdelay(1);
  277. *val = readw(data->base + chan->address);
  278. *val = (*val * data->battery_mode_gain.mult) /
  279. data->battery_mode_gain.div;
  280. /* Restore control register value */
  281. writel(adc_engine_control_reg_val,
  282. data->base + ASPEED_REG_ENGINE_CONTROL);
  283. } else
  284. *val = readw(data->base + chan->address);
  285. return IIO_VAL_INT;
  286. case IIO_CHAN_INFO_OFFSET:
  287. if (data->battery_sensing && chan->channel == 7)
  288. *val = (data->cv * data->battery_mode_gain.mult) /
  289. data->battery_mode_gain.div;
  290. else
  291. *val = data->cv;
  292. return IIO_VAL_INT;
  293. case IIO_CHAN_INFO_SCALE:
  294. *val = data->vref_mv;
  295. *val2 = ASPEED_RESOLUTION_BITS;
  296. return IIO_VAL_FRACTIONAL_LOG2;
  297. case IIO_CHAN_INFO_SAMP_FREQ:
  298. *val = clk_get_rate(data->clk_scaler->clk) /
  299. ASPEED_CLOCKS_PER_SAMPLE;
  300. return IIO_VAL_INT;
  301. default:
  302. return -EINVAL;
  303. }
  304. }
  305. static int aspeed_adc_write_raw(struct iio_dev *indio_dev,
  306. struct iio_chan_spec const *chan,
  307. int val, int val2, long mask)
  308. {
  309. switch (mask) {
  310. case IIO_CHAN_INFO_SAMP_FREQ:
  311. return aspeed_adc_set_sampling_rate(indio_dev, val);
  312. case IIO_CHAN_INFO_SCALE:
  313. case IIO_CHAN_INFO_RAW:
  314. /*
  315. * Technically, these could be written but the only reasons
  316. * for doing so seem better handled in userspace. EPERM is
  317. * returned to signal this is a policy choice rather than a
  318. * hardware limitation.
  319. */
  320. return -EPERM;
  321. default:
  322. return -EINVAL;
  323. }
  324. }
  325. static int aspeed_adc_reg_access(struct iio_dev *indio_dev,
  326. unsigned int reg, unsigned int writeval,
  327. unsigned int *readval)
  328. {
  329. struct aspeed_adc_data *data = iio_priv(indio_dev);
  330. if (!readval || reg % 4 || reg > ASPEED_REG_MAX)
  331. return -EINVAL;
  332. *readval = readl(data->base + reg);
  333. return 0;
  334. }
  335. static const struct iio_info aspeed_adc_iio_info = {
  336. .read_raw = aspeed_adc_read_raw,
  337. .write_raw = aspeed_adc_write_raw,
  338. .debugfs_reg_access = aspeed_adc_reg_access,
  339. };
  340. static void aspeed_adc_unregister_fixed_divider(void *data)
  341. {
  342. struct clk_hw *clk = data;
  343. clk_hw_unregister_fixed_factor(clk);
  344. }
  345. static void aspeed_adc_reset_assert(void *data)
  346. {
  347. struct reset_control *rst = data;
  348. reset_control_assert(rst);
  349. }
  350. static void aspeed_adc_clk_disable_unprepare(void *data)
  351. {
  352. struct clk *clk = data;
  353. clk_disable_unprepare(clk);
  354. }
  355. static void aspeed_adc_power_down(void *data)
  356. {
  357. struct aspeed_adc_data *priv_data = data;
  358. writel(FIELD_PREP(ASPEED_ADC_OP_MODE, ASPEED_ADC_OP_MODE_PWR_DOWN),
  359. priv_data->base + ASPEED_REG_ENGINE_CONTROL);
  360. }
  361. static int aspeed_adc_vref_config(struct iio_dev *indio_dev)
  362. {
  363. struct aspeed_adc_data *data = iio_priv(indio_dev);
  364. int ret;
  365. u32 adc_engine_control_reg_val;
  366. if (data->model_data->vref_fixed_mv) {
  367. data->vref_mv = data->model_data->vref_fixed_mv;
  368. return 0;
  369. }
  370. adc_engine_control_reg_val =
  371. readl(data->base + ASPEED_REG_ENGINE_CONTROL);
  372. adc_engine_control_reg_val &= ~ASPEED_ADC_REF_VOLTAGE;
  373. ret = devm_regulator_get_enable_read_voltage(data->dev, "vref");
  374. if (ret < 0 && ret != -ENODEV)
  375. return ret;
  376. if (ret != -ENODEV) {
  377. data->vref_mv = ret / 1000;
  378. if ((data->vref_mv >= 1550) && (data->vref_mv <= 2700))
  379. writel(adc_engine_control_reg_val |
  380. FIELD_PREP(
  381. ASPEED_ADC_REF_VOLTAGE,
  382. ASPEED_ADC_REF_VOLTAGE_EXT_HIGH),
  383. data->base + ASPEED_REG_ENGINE_CONTROL);
  384. else if ((data->vref_mv >= 900) && (data->vref_mv <= 1650))
  385. writel(adc_engine_control_reg_val |
  386. FIELD_PREP(
  387. ASPEED_ADC_REF_VOLTAGE,
  388. ASPEED_ADC_REF_VOLTAGE_EXT_LOW),
  389. data->base + ASPEED_REG_ENGINE_CONTROL);
  390. else {
  391. dev_err(data->dev, "Regulator voltage %d not support",
  392. data->vref_mv);
  393. return -EOPNOTSUPP;
  394. }
  395. } else {
  396. data->vref_mv = 2500000;
  397. of_property_read_u32(data->dev->of_node,
  398. "aspeed,int-vref-microvolt",
  399. &data->vref_mv);
  400. /* Conversion from uV to mV */
  401. data->vref_mv /= 1000;
  402. if (data->vref_mv == 2500)
  403. writel(adc_engine_control_reg_val |
  404. FIELD_PREP(ASPEED_ADC_REF_VOLTAGE,
  405. ASPEED_ADC_REF_VOLTAGE_2500mV),
  406. data->base + ASPEED_REG_ENGINE_CONTROL);
  407. else if (data->vref_mv == 1200)
  408. writel(adc_engine_control_reg_val |
  409. FIELD_PREP(ASPEED_ADC_REF_VOLTAGE,
  410. ASPEED_ADC_REF_VOLTAGE_1200mV),
  411. data->base + ASPEED_REG_ENGINE_CONTROL);
  412. else {
  413. dev_err(data->dev, "Voltage %d not support", data->vref_mv);
  414. return -EOPNOTSUPP;
  415. }
  416. }
  417. return 0;
  418. }
  419. static int aspeed_adc_probe(struct platform_device *pdev)
  420. {
  421. struct iio_dev *indio_dev;
  422. struct aspeed_adc_data *data;
  423. int ret;
  424. u32 adc_engine_control_reg_val;
  425. struct device *dev = &pdev->dev;
  426. struct device_node *np = dev_of_node(dev);
  427. unsigned long scaler_flags = 0;
  428. char clk_name[32], clk_parent_name[32];
  429. indio_dev = devm_iio_device_alloc(dev, sizeof(*data));
  430. if (!indio_dev)
  431. return -ENOMEM;
  432. data = iio_priv(indio_dev);
  433. data->dev = dev;
  434. data->model_data = of_device_get_match_data(dev);
  435. platform_set_drvdata(pdev, indio_dev);
  436. data->base = devm_platform_ioremap_resource(pdev, 0);
  437. if (IS_ERR(data->base))
  438. return PTR_ERR(data->base);
  439. /* Register ADC clock prescaler with source specified by device tree. */
  440. spin_lock_init(&data->clk_lock);
  441. snprintf(clk_parent_name, ARRAY_SIZE(clk_parent_name), "%s",
  442. of_clk_get_parent_name(np, 0));
  443. snprintf(clk_name, ARRAY_SIZE(clk_name), "%s-fixed-div",
  444. data->model_data->model_name);
  445. data->fixed_div_clk = clk_hw_register_fixed_factor(dev, clk_name,
  446. clk_parent_name, 0, 1, 2);
  447. if (IS_ERR(data->fixed_div_clk))
  448. return PTR_ERR(data->fixed_div_clk);
  449. ret = devm_add_action_or_reset(dev, aspeed_adc_unregister_fixed_divider,
  450. data->fixed_div_clk);
  451. if (ret)
  452. return ret;
  453. snprintf(clk_parent_name, ARRAY_SIZE(clk_parent_name), clk_name);
  454. if (data->model_data->need_prescaler) {
  455. snprintf(clk_name, ARRAY_SIZE(clk_name), "%s-prescaler",
  456. data->model_data->model_name);
  457. data->clk_prescaler = devm_clk_hw_register_divider(
  458. dev, clk_name, clk_parent_name, 0,
  459. data->base + ASPEED_REG_CLOCK_CONTROL, 17, 15, 0,
  460. &data->clk_lock);
  461. if (IS_ERR(data->clk_prescaler))
  462. return PTR_ERR(data->clk_prescaler);
  463. snprintf(clk_parent_name, ARRAY_SIZE(clk_parent_name),
  464. clk_name);
  465. scaler_flags = CLK_SET_RATE_PARENT;
  466. }
  467. /*
  468. * Register ADC clock scaler downstream from the prescaler. Allow rate
  469. * setting to adjust the prescaler as well.
  470. */
  471. snprintf(clk_name, ARRAY_SIZE(clk_name), "%s-scaler",
  472. data->model_data->model_name);
  473. data->clk_scaler = devm_clk_hw_register_divider(
  474. dev, clk_name, clk_parent_name, scaler_flags,
  475. data->base + ASPEED_REG_CLOCK_CONTROL, 0,
  476. data->model_data->scaler_bit_width,
  477. data->model_data->need_prescaler ? CLK_DIVIDER_ONE_BASED : 0,
  478. &data->clk_lock);
  479. if (IS_ERR(data->clk_scaler))
  480. return PTR_ERR(data->clk_scaler);
  481. data->rst = devm_reset_control_get_shared(dev, NULL);
  482. if (IS_ERR(data->rst))
  483. return dev_err_probe(dev, PTR_ERR(data->rst),
  484. "invalid or missing reset controller device tree entry");
  485. reset_control_deassert(data->rst);
  486. ret = devm_add_action_or_reset(dev, aspeed_adc_reset_assert, data->rst);
  487. if (ret)
  488. return ret;
  489. ret = aspeed_adc_vref_config(indio_dev);
  490. if (ret)
  491. return ret;
  492. ret = aspeed_adc_set_trim_data(indio_dev);
  493. if (ret)
  494. return ret;
  495. if (of_property_present(np, "aspeed,battery-sensing")) {
  496. if (data->model_data->bat_sense_sup) {
  497. data->battery_sensing = 1;
  498. if (readl(data->base + ASPEED_REG_ENGINE_CONTROL) &
  499. ASPEED_ADC_BAT_SENSING_DIV) {
  500. data->battery_mode_gain.mult = 3;
  501. data->battery_mode_gain.div = 1;
  502. } else {
  503. data->battery_mode_gain.mult = 3;
  504. data->battery_mode_gain.div = 2;
  505. }
  506. } else
  507. dev_warn(dev, "Failed to enable battery-sensing mode\n");
  508. }
  509. ret = clk_prepare_enable(data->clk_scaler->clk);
  510. if (ret)
  511. return ret;
  512. ret = devm_add_action_or_reset(dev, aspeed_adc_clk_disable_unprepare,
  513. data->clk_scaler->clk);
  514. if (ret)
  515. return ret;
  516. ret = aspeed_adc_set_sampling_rate(indio_dev,
  517. ASPEED_ADC_DEF_SAMPLING_RATE);
  518. if (ret)
  519. return ret;
  520. adc_engine_control_reg_val =
  521. readl(data->base + ASPEED_REG_ENGINE_CONTROL);
  522. adc_engine_control_reg_val |=
  523. FIELD_PREP(ASPEED_ADC_OP_MODE, ASPEED_ADC_OP_MODE_NORMAL) |
  524. ASPEED_ADC_ENGINE_ENABLE;
  525. /* Enable engine in normal mode. */
  526. writel(adc_engine_control_reg_val,
  527. data->base + ASPEED_REG_ENGINE_CONTROL);
  528. ret = devm_add_action_or_reset(dev, aspeed_adc_power_down, data);
  529. if (ret)
  530. return ret;
  531. if (data->model_data->wait_init_sequence) {
  532. /* Wait for initial sequence complete. */
  533. ret = readl_poll_timeout(data->base + ASPEED_REG_ENGINE_CONTROL,
  534. adc_engine_control_reg_val,
  535. adc_engine_control_reg_val &
  536. ASPEED_ADC_CTRL_INIT_RDY,
  537. ASPEED_ADC_INIT_POLLING_TIME,
  538. ASPEED_ADC_INIT_TIMEOUT);
  539. if (ret)
  540. return ret;
  541. }
  542. aspeed_adc_compensation(indio_dev);
  543. /* Start all channels in normal mode. */
  544. adc_engine_control_reg_val =
  545. readl(data->base + ASPEED_REG_ENGINE_CONTROL);
  546. adc_engine_control_reg_val |= ASPEED_ADC_CTRL_CHANNEL;
  547. writel(adc_engine_control_reg_val,
  548. data->base + ASPEED_REG_ENGINE_CONTROL);
  549. indio_dev->name = data->model_data->model_name;
  550. indio_dev->info = &aspeed_adc_iio_info;
  551. indio_dev->modes = INDIO_DIRECT_MODE;
  552. indio_dev->channels = data->battery_sensing ?
  553. aspeed_adc_iio_bat_channels :
  554. aspeed_adc_iio_channels;
  555. indio_dev->num_channels = data->model_data->num_channels;
  556. return devm_iio_device_register(dev, indio_dev);
  557. }
  558. static const struct aspeed_adc_trim_locate ast2500_adc_trim = {
  559. .offset = 0x154,
  560. .field = GENMASK(31, 28),
  561. };
  562. static const struct aspeed_adc_trim_locate ast2600_adc0_trim = {
  563. .offset = 0x5d0,
  564. .field = GENMASK(3, 0),
  565. };
  566. static const struct aspeed_adc_trim_locate ast2600_adc1_trim = {
  567. .offset = 0x5d0,
  568. .field = GENMASK(7, 4),
  569. };
  570. static const struct aspeed_adc_trim_locate ast2700_adc0_trim = {
  571. .offset = 0x820,
  572. .field = GENMASK(3, 0),
  573. };
  574. static const struct aspeed_adc_trim_locate ast2700_adc1_trim = {
  575. .offset = 0x820,
  576. .field = GENMASK(7, 4),
  577. };
  578. static const struct aspeed_adc_model_data ast2400_model_data = {
  579. .model_name = "ast2400-adc",
  580. .vref_fixed_mv = 2500,
  581. .min_sampling_rate = 10000,
  582. .max_sampling_rate = 500000,
  583. .need_prescaler = true,
  584. .scaler_bit_width = 10,
  585. .num_channels = 16,
  586. };
  587. static const struct aspeed_adc_model_data ast2500_model_data = {
  588. .model_name = "ast2500-adc",
  589. .vref_fixed_mv = 1800,
  590. .min_sampling_rate = 1,
  591. .max_sampling_rate = 1000000,
  592. .wait_init_sequence = true,
  593. .need_prescaler = true,
  594. .scaler_bit_width = 10,
  595. .num_channels = 16,
  596. .trim_locate = &ast2500_adc_trim,
  597. };
  598. static const struct aspeed_adc_model_data ast2600_adc0_model_data = {
  599. .model_name = "ast2600-adc0",
  600. .min_sampling_rate = 10000,
  601. .max_sampling_rate = 500000,
  602. .wait_init_sequence = true,
  603. .bat_sense_sup = true,
  604. .scaler_bit_width = 16,
  605. .num_channels = 8,
  606. .trim_locate = &ast2600_adc0_trim,
  607. };
  608. static const struct aspeed_adc_model_data ast2600_adc1_model_data = {
  609. .model_name = "ast2600-adc1",
  610. .min_sampling_rate = 10000,
  611. .max_sampling_rate = 500000,
  612. .wait_init_sequence = true,
  613. .bat_sense_sup = true,
  614. .scaler_bit_width = 16,
  615. .num_channels = 8,
  616. .trim_locate = &ast2600_adc1_trim,
  617. };
  618. static const struct aspeed_adc_model_data ast2700_adc0_model_data = {
  619. .model_name = "ast2700-adc0",
  620. .min_sampling_rate = 10000,
  621. .max_sampling_rate = 500000,
  622. .wait_init_sequence = true,
  623. .bat_sense_sup = true,
  624. .scaler_bit_width = 16,
  625. .num_channels = 8,
  626. .trim_locate = &ast2700_adc0_trim,
  627. };
  628. static const struct aspeed_adc_model_data ast2700_adc1_model_data = {
  629. .model_name = "ast2700-adc1",
  630. .min_sampling_rate = 10000,
  631. .max_sampling_rate = 500000,
  632. .wait_init_sequence = true,
  633. .bat_sense_sup = true,
  634. .scaler_bit_width = 16,
  635. .num_channels = 8,
  636. .trim_locate = &ast2700_adc1_trim,
  637. };
  638. static const struct of_device_id aspeed_adc_matches[] = {
  639. { .compatible = "aspeed,ast2400-adc", .data = &ast2400_model_data },
  640. { .compatible = "aspeed,ast2500-adc", .data = &ast2500_model_data },
  641. { .compatible = "aspeed,ast2600-adc0", .data = &ast2600_adc0_model_data },
  642. { .compatible = "aspeed,ast2600-adc1", .data = &ast2600_adc1_model_data },
  643. { .compatible = "aspeed,ast2700-adc0", .data = &ast2700_adc0_model_data },
  644. { .compatible = "aspeed,ast2700-adc1", .data = &ast2700_adc1_model_data },
  645. { }
  646. };
  647. MODULE_DEVICE_TABLE(of, aspeed_adc_matches);
  648. static struct platform_driver aspeed_adc_driver = {
  649. .probe = aspeed_adc_probe,
  650. .driver = {
  651. .name = KBUILD_MODNAME,
  652. .of_match_table = aspeed_adc_matches,
  653. }
  654. };
  655. module_platform_driver(aspeed_adc_driver);
  656. MODULE_AUTHOR("Rick Altherr <raltherr@google.com>");
  657. MODULE_DESCRIPTION("Aspeed AST2400/2500/2600 ADC Driver");
  658. MODULE_LICENSE("GPL");