bcm_iproc_adc.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright 2016 Broadcom
  4. */
  5. #include <linux/module.h>
  6. #include <linux/mod_devicetable.h>
  7. #include <linux/io.h>
  8. #include <linux/clk.h>
  9. #include <linux/mfd/syscon.h>
  10. #include <linux/regmap.h>
  11. #include <linux/delay.h>
  12. #include <linux/interrupt.h>
  13. #include <linux/platform_device.h>
  14. #include <linux/iio/iio.h>
  15. /* Below Register's are common to IPROC ADC and Touchscreen IP */
  16. #define IPROC_REGCTL1 0x00
  17. #define IPROC_REGCTL2 0x04
  18. #define IPROC_INTERRUPT_THRES 0x08
  19. #define IPROC_INTERRUPT_MASK 0x0c
  20. #define IPROC_INTERRUPT_STATUS 0x10
  21. #define IPROC_ANALOG_CONTROL 0x1c
  22. #define IPROC_CONTROLLER_STATUS 0x14
  23. #define IPROC_AUX_DATA 0x20
  24. #define IPROC_SOFT_BYPASS_CONTROL 0x38
  25. #define IPROC_SOFT_BYPASS_DATA 0x3C
  26. /* IPROC ADC Channel register offsets */
  27. #define IPROC_ADC_CHANNEL_REGCTL1 0x800
  28. #define IPROC_ADC_CHANNEL_REGCTL2 0x804
  29. #define IPROC_ADC_CHANNEL_STATUS 0x808
  30. #define IPROC_ADC_CHANNEL_INTERRUPT_STATUS 0x80c
  31. #define IPROC_ADC_CHANNEL_INTERRUPT_MASK 0x810
  32. #define IPROC_ADC_CHANNEL_DATA 0x814
  33. #define IPROC_ADC_CHANNEL_OFFSET 0x20
  34. /* Bit definitions for IPROC_REGCTL2 */
  35. #define IPROC_ADC_AUXIN_SCAN_ENA BIT(0)
  36. #define IPROC_ADC_PWR_LDO BIT(5)
  37. #define IPROC_ADC_PWR_ADC BIT(4)
  38. #define IPROC_ADC_PWR_BG BIT(3)
  39. #define IPROC_ADC_CONTROLLER_EN BIT(17)
  40. /* Bit definitions for IPROC_INTERRUPT_MASK and IPROC_INTERRUPT_STATUS */
  41. #define IPROC_ADC_AUXDATA_RDY_INTR BIT(3)
  42. #define IPROC_ADC_INTR 9
  43. #define IPROC_ADC_INTR_MASK (0xFF << IPROC_ADC_INTR)
  44. /* Bit definitions for IPROC_ANALOG_CONTROL */
  45. #define IPROC_ADC_CHANNEL_SEL 11
  46. #define IPROC_ADC_CHANNEL_SEL_MASK (0x7 << IPROC_ADC_CHANNEL_SEL)
  47. /* Bit definitions for IPROC_ADC_CHANNEL_REGCTL1 */
  48. #define IPROC_ADC_CHANNEL_ROUNDS 0x2
  49. #define IPROC_ADC_CHANNEL_ROUNDS_MASK (0x3F << IPROC_ADC_CHANNEL_ROUNDS)
  50. #define IPROC_ADC_CHANNEL_MODE 0x1
  51. #define IPROC_ADC_CHANNEL_MODE_MASK (0x1 << IPROC_ADC_CHANNEL_MODE)
  52. #define IPROC_ADC_CHANNEL_MODE_TDM 0x1
  53. #define IPROC_ADC_CHANNEL_MODE_SNAPSHOT 0x0
  54. #define IPROC_ADC_CHANNEL_ENABLE 0x0
  55. #define IPROC_ADC_CHANNEL_ENABLE_MASK 0x1
  56. /* Bit definitions for IPROC_ADC_CHANNEL_REGCTL2 */
  57. #define IPROC_ADC_CHANNEL_WATERMARK 0x0
  58. #define IPROC_ADC_CHANNEL_WATERMARK_MASK \
  59. (0x3F << IPROC_ADC_CHANNEL_WATERMARK)
  60. #define IPROC_ADC_WATER_MARK_LEVEL 0x1
  61. /* Bit definitions for IPROC_ADC_CHANNEL_STATUS */
  62. #define IPROC_ADC_CHANNEL_DATA_LOST 0x0
  63. #define IPROC_ADC_CHANNEL_DATA_LOST_MASK \
  64. (0x0 << IPROC_ADC_CHANNEL_DATA_LOST)
  65. #define IPROC_ADC_CHANNEL_VALID_ENTERIES 0x1
  66. #define IPROC_ADC_CHANNEL_VALID_ENTERIES_MASK \
  67. (0xFF << IPROC_ADC_CHANNEL_VALID_ENTERIES)
  68. #define IPROC_ADC_CHANNEL_TOTAL_ENTERIES 0x9
  69. #define IPROC_ADC_CHANNEL_TOTAL_ENTERIES_MASK \
  70. (0xFF << IPROC_ADC_CHANNEL_TOTAL_ENTERIES)
  71. /* Bit definitions for IPROC_ADC_CHANNEL_INTERRUPT_MASK */
  72. #define IPROC_ADC_CHANNEL_WTRMRK_INTR 0x0
  73. #define IPROC_ADC_CHANNEL_WTRMRK_INTR_MASK \
  74. (0x1 << IPROC_ADC_CHANNEL_WTRMRK_INTR)
  75. #define IPROC_ADC_CHANNEL_FULL_INTR 0x1
  76. #define IPROC_ADC_CHANNEL_FULL_INTR_MASK \
  77. (0x1 << IPROC_ADC_IPROC_ADC_CHANNEL_FULL_INTR)
  78. #define IPROC_ADC_CHANNEL_EMPTY_INTR 0x2
  79. #define IPROC_ADC_CHANNEL_EMPTY_INTR_MASK \
  80. (0x1 << IPROC_ADC_CHANNEL_EMPTY_INTR)
  81. #define IPROC_ADC_WATER_MARK_INTR_ENABLE 0x1
  82. /* Number of time to retry a set of the interrupt mask reg */
  83. #define IPROC_ADC_INTMASK_RETRY_ATTEMPTS 10
  84. #define IPROC_ADC_READ_TIMEOUT (HZ*2)
  85. #define iproc_adc_dbg_reg(dev, priv, reg) \
  86. do { \
  87. u32 val; \
  88. regmap_read(priv->regmap, reg, &val); \
  89. dev_dbg(dev, "%20s= 0x%08x\n", #reg, val); \
  90. } while (0)
  91. struct iproc_adc_priv {
  92. struct regmap *regmap;
  93. struct clk *adc_clk;
  94. struct mutex mutex;
  95. int irqno;
  96. int chan_val;
  97. int chan_id;
  98. struct completion completion;
  99. };
  100. static void iproc_adc_reg_dump(struct iio_dev *indio_dev)
  101. {
  102. struct device *dev = &indio_dev->dev;
  103. struct iproc_adc_priv *adc_priv = iio_priv(indio_dev);
  104. iproc_adc_dbg_reg(dev, adc_priv, IPROC_REGCTL1);
  105. iproc_adc_dbg_reg(dev, adc_priv, IPROC_REGCTL2);
  106. iproc_adc_dbg_reg(dev, adc_priv, IPROC_INTERRUPT_THRES);
  107. iproc_adc_dbg_reg(dev, adc_priv, IPROC_INTERRUPT_MASK);
  108. iproc_adc_dbg_reg(dev, adc_priv, IPROC_INTERRUPT_STATUS);
  109. iproc_adc_dbg_reg(dev, adc_priv, IPROC_CONTROLLER_STATUS);
  110. iproc_adc_dbg_reg(dev, adc_priv, IPROC_ANALOG_CONTROL);
  111. iproc_adc_dbg_reg(dev, adc_priv, IPROC_AUX_DATA);
  112. iproc_adc_dbg_reg(dev, adc_priv, IPROC_SOFT_BYPASS_CONTROL);
  113. iproc_adc_dbg_reg(dev, adc_priv, IPROC_SOFT_BYPASS_DATA);
  114. }
  115. static irqreturn_t iproc_adc_interrupt_thread(int irq, void *data)
  116. {
  117. u32 channel_intr_status;
  118. u32 intr_status;
  119. u32 intr_mask;
  120. struct iio_dev *indio_dev = data;
  121. struct iproc_adc_priv *adc_priv = iio_priv(indio_dev);
  122. /*
  123. * This interrupt is shared with the touchscreen driver.
  124. * Make sure this interrupt is intended for us.
  125. * Handle only ADC channel specific interrupts.
  126. */
  127. regmap_read(adc_priv->regmap, IPROC_INTERRUPT_STATUS, &intr_status);
  128. regmap_read(adc_priv->regmap, IPROC_INTERRUPT_MASK, &intr_mask);
  129. intr_status = intr_status & intr_mask;
  130. channel_intr_status = (intr_status & IPROC_ADC_INTR_MASK) >>
  131. IPROC_ADC_INTR;
  132. if (channel_intr_status)
  133. return IRQ_WAKE_THREAD;
  134. return IRQ_NONE;
  135. }
  136. static irqreturn_t iproc_adc_interrupt_handler(int irq, void *data)
  137. {
  138. irqreturn_t retval = IRQ_NONE;
  139. struct iproc_adc_priv *adc_priv;
  140. struct iio_dev *indio_dev = data;
  141. unsigned int valid_entries;
  142. u32 intr_status;
  143. u32 intr_channels;
  144. u32 channel_status;
  145. u32 ch_intr_status;
  146. adc_priv = iio_priv(indio_dev);
  147. regmap_read(adc_priv->regmap, IPROC_INTERRUPT_STATUS, &intr_status);
  148. dev_dbg(&indio_dev->dev, "iproc_adc_interrupt_handler(),INTRPT_STS:%x\n",
  149. intr_status);
  150. intr_channels = (intr_status & IPROC_ADC_INTR_MASK) >> IPROC_ADC_INTR;
  151. if (intr_channels) {
  152. regmap_read(adc_priv->regmap,
  153. IPROC_ADC_CHANNEL_INTERRUPT_STATUS +
  154. IPROC_ADC_CHANNEL_OFFSET * adc_priv->chan_id,
  155. &ch_intr_status);
  156. if (ch_intr_status & IPROC_ADC_CHANNEL_WTRMRK_INTR_MASK) {
  157. regmap_read(adc_priv->regmap,
  158. IPROC_ADC_CHANNEL_STATUS +
  159. IPROC_ADC_CHANNEL_OFFSET *
  160. adc_priv->chan_id,
  161. &channel_status);
  162. valid_entries = ((channel_status &
  163. IPROC_ADC_CHANNEL_VALID_ENTERIES_MASK) >>
  164. IPROC_ADC_CHANNEL_VALID_ENTERIES);
  165. if (valid_entries >= 1) {
  166. regmap_read(adc_priv->regmap,
  167. IPROC_ADC_CHANNEL_DATA +
  168. IPROC_ADC_CHANNEL_OFFSET *
  169. adc_priv->chan_id,
  170. &adc_priv->chan_val);
  171. complete(&adc_priv->completion);
  172. } else {
  173. dev_err(&indio_dev->dev,
  174. "No data rcvd on channel %d\n",
  175. adc_priv->chan_id);
  176. }
  177. regmap_write(adc_priv->regmap,
  178. IPROC_ADC_CHANNEL_INTERRUPT_MASK +
  179. IPROC_ADC_CHANNEL_OFFSET *
  180. adc_priv->chan_id,
  181. (ch_intr_status &
  182. ~(IPROC_ADC_CHANNEL_WTRMRK_INTR_MASK)));
  183. }
  184. regmap_write(adc_priv->regmap,
  185. IPROC_ADC_CHANNEL_INTERRUPT_STATUS +
  186. IPROC_ADC_CHANNEL_OFFSET * adc_priv->chan_id,
  187. ch_intr_status);
  188. regmap_write(adc_priv->regmap, IPROC_INTERRUPT_STATUS,
  189. intr_channels);
  190. retval = IRQ_HANDLED;
  191. }
  192. return retval;
  193. }
  194. static int iproc_adc_do_read(struct iio_dev *indio_dev,
  195. int channel,
  196. u16 *p_adc_data)
  197. {
  198. int read_len = 0;
  199. u32 val;
  200. u32 mask;
  201. u32 val_check;
  202. int failed_cnt = 0;
  203. struct iproc_adc_priv *adc_priv = iio_priv(indio_dev);
  204. mutex_lock(&adc_priv->mutex);
  205. /*
  206. * After a read is complete the ADC interrupts will be disabled so
  207. * we can assume this section of code is safe from interrupts.
  208. */
  209. adc_priv->chan_val = -1;
  210. adc_priv->chan_id = channel;
  211. reinit_completion(&adc_priv->completion);
  212. /* Clear any pending interrupt */
  213. regmap_update_bits(adc_priv->regmap, IPROC_INTERRUPT_STATUS,
  214. IPROC_ADC_INTR_MASK | IPROC_ADC_AUXDATA_RDY_INTR,
  215. ((0x0 << channel) << IPROC_ADC_INTR) |
  216. IPROC_ADC_AUXDATA_RDY_INTR);
  217. /* Configure channel for snapshot mode and enable */
  218. val = (BIT(IPROC_ADC_CHANNEL_ROUNDS) |
  219. (IPROC_ADC_CHANNEL_MODE_SNAPSHOT << IPROC_ADC_CHANNEL_MODE) |
  220. (0x1 << IPROC_ADC_CHANNEL_ENABLE));
  221. mask = IPROC_ADC_CHANNEL_ROUNDS_MASK | IPROC_ADC_CHANNEL_MODE_MASK |
  222. IPROC_ADC_CHANNEL_ENABLE_MASK;
  223. regmap_update_bits(adc_priv->regmap, (IPROC_ADC_CHANNEL_REGCTL1 +
  224. IPROC_ADC_CHANNEL_OFFSET * channel),
  225. mask, val);
  226. /* Set the Watermark for a channel */
  227. regmap_update_bits(adc_priv->regmap, (IPROC_ADC_CHANNEL_REGCTL2 +
  228. IPROC_ADC_CHANNEL_OFFSET * channel),
  229. IPROC_ADC_CHANNEL_WATERMARK_MASK,
  230. 0x1);
  231. /* Enable water mark interrupt */
  232. regmap_update_bits(adc_priv->regmap, (IPROC_ADC_CHANNEL_INTERRUPT_MASK +
  233. IPROC_ADC_CHANNEL_OFFSET *
  234. channel),
  235. IPROC_ADC_CHANNEL_WTRMRK_INTR_MASK,
  236. IPROC_ADC_WATER_MARK_INTR_ENABLE);
  237. regmap_read(adc_priv->regmap, IPROC_INTERRUPT_MASK, &val);
  238. /* Enable ADC interrupt for a channel */
  239. val |= (BIT(channel) << IPROC_ADC_INTR);
  240. regmap_write(adc_priv->regmap, IPROC_INTERRUPT_MASK, val);
  241. /*
  242. * There seems to be a very rare issue where writing to this register
  243. * does not take effect. To work around the issue we will try multiple
  244. * writes. In total we will spend about 10*10 = 100 us attempting this.
  245. * Testing has shown that this may loop a few time, but we have never
  246. * hit the full count.
  247. */
  248. regmap_read(adc_priv->regmap, IPROC_INTERRUPT_MASK, &val_check);
  249. while (val_check != val) {
  250. failed_cnt++;
  251. if (failed_cnt > IPROC_ADC_INTMASK_RETRY_ATTEMPTS)
  252. break;
  253. udelay(10);
  254. regmap_update_bits(adc_priv->regmap, IPROC_INTERRUPT_MASK,
  255. IPROC_ADC_INTR_MASK,
  256. ((0x1 << channel) <<
  257. IPROC_ADC_INTR));
  258. regmap_read(adc_priv->regmap, IPROC_INTERRUPT_MASK, &val_check);
  259. }
  260. if (failed_cnt) {
  261. dev_dbg(&indio_dev->dev,
  262. "IntMask failed (%d times)", failed_cnt);
  263. if (failed_cnt > IPROC_ADC_INTMASK_RETRY_ATTEMPTS) {
  264. dev_err(&indio_dev->dev,
  265. "IntMask set failed. Read will likely fail.");
  266. read_len = -EIO;
  267. goto adc_err;
  268. }
  269. }
  270. regmap_read(adc_priv->regmap, IPROC_INTERRUPT_MASK, &val_check);
  271. if (wait_for_completion_timeout(&adc_priv->completion,
  272. IPROC_ADC_READ_TIMEOUT) > 0) {
  273. /* Only the lower 16 bits are relevant */
  274. *p_adc_data = adc_priv->chan_val & 0xFFFF;
  275. read_len = sizeof(*p_adc_data);
  276. } else {
  277. /*
  278. * We never got the interrupt, something went wrong.
  279. * Perhaps the interrupt may still be coming, we do not want
  280. * that now. Lets disable the ADC interrupt, and clear the
  281. * status to put it back in to normal state.
  282. */
  283. read_len = -ETIMEDOUT;
  284. goto adc_err;
  285. }
  286. mutex_unlock(&adc_priv->mutex);
  287. return read_len;
  288. adc_err:
  289. regmap_update_bits(adc_priv->regmap, IPROC_INTERRUPT_MASK,
  290. IPROC_ADC_INTR_MASK,
  291. ((0x0 << channel) << IPROC_ADC_INTR));
  292. regmap_update_bits(adc_priv->regmap, IPROC_INTERRUPT_STATUS,
  293. IPROC_ADC_INTR_MASK,
  294. ((0x0 << channel) << IPROC_ADC_INTR));
  295. dev_err(&indio_dev->dev, "Timed out waiting for ADC data!\n");
  296. iproc_adc_reg_dump(indio_dev);
  297. mutex_unlock(&adc_priv->mutex);
  298. return read_len;
  299. }
  300. static int iproc_adc_enable(struct iio_dev *indio_dev)
  301. {
  302. u32 val;
  303. u32 channel_id;
  304. struct iproc_adc_priv *adc_priv = iio_priv(indio_dev);
  305. int ret;
  306. /* Set i_amux = 3b'000, select channel 0 */
  307. ret = regmap_update_bits(adc_priv->regmap, IPROC_ANALOG_CONTROL,
  308. IPROC_ADC_CHANNEL_SEL_MASK, 0);
  309. if (ret) {
  310. dev_err(&indio_dev->dev,
  311. "failed to write IPROC_ANALOG_CONTROL %d\n", ret);
  312. return ret;
  313. }
  314. adc_priv->chan_val = -1;
  315. /*
  316. * PWR up LDO, ADC, and Band Gap (0 to enable)
  317. * Also enable ADC controller (set high)
  318. */
  319. ret = regmap_read(adc_priv->regmap, IPROC_REGCTL2, &val);
  320. if (ret) {
  321. dev_err(&indio_dev->dev,
  322. "failed to read IPROC_REGCTL2 %d\n", ret);
  323. return ret;
  324. }
  325. val &= ~(IPROC_ADC_PWR_LDO | IPROC_ADC_PWR_ADC | IPROC_ADC_PWR_BG);
  326. ret = regmap_write(adc_priv->regmap, IPROC_REGCTL2, val);
  327. if (ret) {
  328. dev_err(&indio_dev->dev,
  329. "failed to write IPROC_REGCTL2 %d\n", ret);
  330. return ret;
  331. }
  332. ret = regmap_read(adc_priv->regmap, IPROC_REGCTL2, &val);
  333. if (ret) {
  334. dev_err(&indio_dev->dev,
  335. "failed to read IPROC_REGCTL2 %d\n", ret);
  336. return ret;
  337. }
  338. val |= IPROC_ADC_CONTROLLER_EN;
  339. ret = regmap_write(adc_priv->regmap, IPROC_REGCTL2, val);
  340. if (ret) {
  341. dev_err(&indio_dev->dev,
  342. "failed to write IPROC_REGCTL2 %d\n", ret);
  343. return ret;
  344. }
  345. for (channel_id = 0; channel_id < indio_dev->num_channels;
  346. channel_id++) {
  347. ret = regmap_write(adc_priv->regmap,
  348. IPROC_ADC_CHANNEL_INTERRUPT_MASK +
  349. IPROC_ADC_CHANNEL_OFFSET * channel_id, 0);
  350. if (ret) {
  351. dev_err(&indio_dev->dev,
  352. "failed to write ADC_CHANNEL_INTERRUPT_MASK %d\n",
  353. ret);
  354. return ret;
  355. }
  356. ret = regmap_write(adc_priv->regmap,
  357. IPROC_ADC_CHANNEL_INTERRUPT_STATUS +
  358. IPROC_ADC_CHANNEL_OFFSET * channel_id, 0);
  359. if (ret) {
  360. dev_err(&indio_dev->dev,
  361. "failed to write ADC_CHANNEL_INTERRUPT_STATUS %d\n",
  362. ret);
  363. return ret;
  364. }
  365. }
  366. return 0;
  367. }
  368. static void iproc_adc_disable(struct iio_dev *indio_dev)
  369. {
  370. u32 val;
  371. int ret;
  372. struct iproc_adc_priv *adc_priv = iio_priv(indio_dev);
  373. ret = regmap_read(adc_priv->regmap, IPROC_REGCTL2, &val);
  374. if (ret) {
  375. dev_err(&indio_dev->dev,
  376. "failed to read IPROC_REGCTL2 %d\n", ret);
  377. return;
  378. }
  379. val &= ~IPROC_ADC_CONTROLLER_EN;
  380. ret = regmap_write(adc_priv->regmap, IPROC_REGCTL2, val);
  381. if (ret) {
  382. dev_err(&indio_dev->dev,
  383. "failed to write IPROC_REGCTL2 %d\n", ret);
  384. return;
  385. }
  386. }
  387. static int iproc_adc_read_raw(struct iio_dev *indio_dev,
  388. struct iio_chan_spec const *chan,
  389. int *val,
  390. int *val2,
  391. long mask)
  392. {
  393. u16 adc_data;
  394. int err;
  395. switch (mask) {
  396. case IIO_CHAN_INFO_RAW:
  397. err = iproc_adc_do_read(indio_dev, chan->channel, &adc_data);
  398. if (err < 0)
  399. return err;
  400. *val = adc_data;
  401. return IIO_VAL_INT;
  402. case IIO_CHAN_INFO_SCALE:
  403. switch (chan->type) {
  404. case IIO_VOLTAGE:
  405. *val = 1800;
  406. *val2 = 10;
  407. return IIO_VAL_FRACTIONAL_LOG2;
  408. default:
  409. return -EINVAL;
  410. }
  411. default:
  412. return -EINVAL;
  413. }
  414. }
  415. static const struct iio_info iproc_adc_iio_info = {
  416. .read_raw = &iproc_adc_read_raw,
  417. };
  418. #define IPROC_ADC_CHANNEL(_index, _id) { \
  419. .type = IIO_VOLTAGE, \
  420. .indexed = 1, \
  421. .channel = _index, \
  422. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
  423. .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE), \
  424. .datasheet_name = _id, \
  425. }
  426. static const struct iio_chan_spec iproc_adc_iio_channels[] = {
  427. IPROC_ADC_CHANNEL(0, "adc0"),
  428. IPROC_ADC_CHANNEL(1, "adc1"),
  429. IPROC_ADC_CHANNEL(2, "adc2"),
  430. IPROC_ADC_CHANNEL(3, "adc3"),
  431. IPROC_ADC_CHANNEL(4, "adc4"),
  432. IPROC_ADC_CHANNEL(5, "adc5"),
  433. IPROC_ADC_CHANNEL(6, "adc6"),
  434. IPROC_ADC_CHANNEL(7, "adc7"),
  435. };
  436. static int iproc_adc_probe(struct platform_device *pdev)
  437. {
  438. struct iproc_adc_priv *adc_priv;
  439. struct iio_dev *indio_dev = NULL;
  440. int ret;
  441. indio_dev = devm_iio_device_alloc(&pdev->dev,
  442. sizeof(*adc_priv));
  443. if (!indio_dev) {
  444. dev_err(&pdev->dev, "failed to allocate iio device\n");
  445. return -ENOMEM;
  446. }
  447. adc_priv = iio_priv(indio_dev);
  448. platform_set_drvdata(pdev, indio_dev);
  449. mutex_init(&adc_priv->mutex);
  450. init_completion(&adc_priv->completion);
  451. adc_priv->regmap = syscon_regmap_lookup_by_phandle(pdev->dev.of_node,
  452. "adc-syscon");
  453. if (IS_ERR(adc_priv->regmap)) {
  454. dev_err(&pdev->dev, "failed to get handle for tsc syscon\n");
  455. ret = PTR_ERR(adc_priv->regmap);
  456. return ret;
  457. }
  458. adc_priv->adc_clk = devm_clk_get(&pdev->dev, "tsc_clk");
  459. if (IS_ERR(adc_priv->adc_clk)) {
  460. dev_err(&pdev->dev,
  461. "failed getting clock tsc_clk\n");
  462. ret = PTR_ERR(adc_priv->adc_clk);
  463. return ret;
  464. }
  465. adc_priv->irqno = platform_get_irq(pdev, 0);
  466. if (adc_priv->irqno <= 0)
  467. return -ENODEV;
  468. ret = regmap_update_bits(adc_priv->regmap, IPROC_REGCTL2,
  469. IPROC_ADC_AUXIN_SCAN_ENA, 0);
  470. if (ret) {
  471. dev_err(&pdev->dev, "failed to write IPROC_REGCTL2 %d\n", ret);
  472. return ret;
  473. }
  474. ret = devm_request_threaded_irq(&pdev->dev, adc_priv->irqno,
  475. iproc_adc_interrupt_handler,
  476. iproc_adc_interrupt_thread,
  477. IRQF_SHARED, "iproc-adc", indio_dev);
  478. if (ret) {
  479. dev_err(&pdev->dev, "request_irq error %d\n", ret);
  480. return ret;
  481. }
  482. ret = clk_prepare_enable(adc_priv->adc_clk);
  483. if (ret) {
  484. dev_err(&pdev->dev,
  485. "clk_prepare_enable failed %d\n", ret);
  486. return ret;
  487. }
  488. ret = iproc_adc_enable(indio_dev);
  489. if (ret) {
  490. dev_err(&pdev->dev, "failed to enable adc %d\n", ret);
  491. goto err_adc_enable;
  492. }
  493. indio_dev->name = "iproc-static-adc";
  494. indio_dev->info = &iproc_adc_iio_info;
  495. indio_dev->modes = INDIO_DIRECT_MODE;
  496. indio_dev->channels = iproc_adc_iio_channels;
  497. indio_dev->num_channels = ARRAY_SIZE(iproc_adc_iio_channels);
  498. ret = iio_device_register(indio_dev);
  499. if (ret) {
  500. dev_err(&pdev->dev, "iio_device_register failed:err %d\n", ret);
  501. goto err_clk;
  502. }
  503. return 0;
  504. err_clk:
  505. iproc_adc_disable(indio_dev);
  506. err_adc_enable:
  507. clk_disable_unprepare(adc_priv->adc_clk);
  508. return ret;
  509. }
  510. static int iproc_adc_remove(struct platform_device *pdev)
  511. {
  512. struct iio_dev *indio_dev = platform_get_drvdata(pdev);
  513. struct iproc_adc_priv *adc_priv = iio_priv(indio_dev);
  514. iio_device_unregister(indio_dev);
  515. iproc_adc_disable(indio_dev);
  516. clk_disable_unprepare(adc_priv->adc_clk);
  517. return 0;
  518. }
  519. static const struct of_device_id iproc_adc_of_match[] = {
  520. {.compatible = "brcm,iproc-static-adc", },
  521. { },
  522. };
  523. MODULE_DEVICE_TABLE(of, iproc_adc_of_match);
  524. static struct platform_driver iproc_adc_driver = {
  525. .probe = iproc_adc_probe,
  526. .remove = iproc_adc_remove,
  527. .driver = {
  528. .name = "iproc-static-adc",
  529. .of_match_table = iproc_adc_of_match,
  530. },
  531. };
  532. module_platform_driver(iproc_adc_driver);
  533. MODULE_DESCRIPTION("Broadcom iProc ADC controller driver");
  534. MODULE_AUTHOR("Raveendra Padasalagi <[email protected]>");
  535. MODULE_LICENSE("GPL v2");