sx9324.c 33 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * Copyright 2021 Google LLC.
  4. *
  5. * Driver for Semtech's SX9324 capacitive proximity/button solution.
  6. * Based on SX9324 driver and copy of datasheet at:
  7. * https://edit.wpgdadawant.com/uploads/news_file/program/2019/30184/tech_files/program_30184_suggest_other_file.pdf
  8. */
  9. #include <linux/acpi.h>
  10. #include <linux/bits.h>
  11. #include <linux/bitfield.h>
  12. #include <linux/delay.h>
  13. #include <linux/i2c.h>
  14. #include <linux/interrupt.h>
  15. #include <linux/kernel.h>
  16. #include <linux/log2.h>
  17. #include <linux/mod_devicetable.h>
  18. #include <linux/module.h>
  19. #include <linux/pm.h>
  20. #include <linux/property.h>
  21. #include <linux/regmap.h>
  22. #include <linux/iio/iio.h>
  23. #include "sx_common.h"
  24. /* Register definitions. */
  25. #define SX9324_REG_IRQ_SRC SX_COMMON_REG_IRQ_SRC
  26. #define SX9324_REG_STAT0 0x01
  27. #define SX9324_REG_STAT1 0x02
  28. #define SX9324_REG_STAT2 0x03
  29. #define SX9324_REG_STAT2_COMPSTAT_MASK GENMASK(3, 0)
  30. #define SX9324_REG_STAT3 0x04
  31. #define SX9324_REG_IRQ_MSK 0x05
  32. #define SX9324_CONVDONE_IRQ BIT(3)
  33. #define SX9324_FAR_IRQ BIT(5)
  34. #define SX9324_CLOSE_IRQ BIT(6)
  35. #define SX9324_REG_IRQ_CFG0 0x06
  36. #define SX9324_REG_IRQ_CFG1 0x07
  37. #define SX9324_REG_IRQ_CFG1_FAILCOND 0x80
  38. #define SX9324_REG_IRQ_CFG2 0x08
  39. #define SX9324_REG_GNRL_CTRL0 0x10
  40. #define SX9324_REG_GNRL_CTRL0_SCANPERIOD_MASK GENMASK(4, 0)
  41. #define SX9324_REG_GNRL_CTRL0_SCANPERIOD_100MS 0x16
  42. #define SX9324_REG_GNRL_CTRL1 0x11
  43. #define SX9324_REG_GNRL_CTRL1_PHEN_MASK GENMASK(3, 0)
  44. #define SX9324_REG_GNRL_CTRL1_PAUSECTRL 0x20
  45. #define SX9324_REG_I2C_ADDR 0x14
  46. #define SX9324_REG_CLK_SPRD 0x15
  47. #define SX9324_REG_AFE_CTRL0 0x20
  48. #define SX9324_REG_AFE_CTRL0_RINT_SHIFT 6
  49. #define SX9324_REG_AFE_CTRL0_RINT_MASK \
  50. GENMASK(SX9324_REG_AFE_CTRL0_RINT_SHIFT + 1, \
  51. SX9324_REG_AFE_CTRL0_RINT_SHIFT)
  52. #define SX9324_REG_AFE_CTRL0_RINT_LOWEST 0x00
  53. #define SX9324_REG_AFE_CTRL0_CSIDLE_SHIFT 4
  54. #define SX9324_REG_AFE_CTRL0_CSIDLE_MASK \
  55. GENMASK(SX9324_REG_AFE_CTRL0_CSIDLE_SHIFT + 1, \
  56. SX9324_REG_AFE_CTRL0_CSIDLE_SHIFT)
  57. #define SX9324_REG_AFE_CTRL0_RINT_LOWEST 0x00
  58. #define SX9324_REG_AFE_CTRL1 0x21
  59. #define SX9324_REG_AFE_CTRL2 0x22
  60. #define SX9324_REG_AFE_CTRL3 0x23
  61. #define SX9324_REG_AFE_CTRL4 0x24
  62. #define SX9324_REG_AFE_CTRL4_FREQ_83_33HZ 0x40
  63. #define SX9324_REG_AFE_CTRL4_RESOLUTION_MASK GENMASK(2, 0)
  64. #define SX9324_REG_AFE_CTRL4_RES_100 0x04
  65. #define SX9324_REG_AFE_CTRL5 0x25
  66. #define SX9324_REG_AFE_CTRL6 0x26
  67. #define SX9324_REG_AFE_CTRL7 0x27
  68. #define SX9324_REG_AFE_PH0 0x28
  69. #define SX9324_REG_AFE_PH0_PIN_MASK(_pin) \
  70. GENMASK(2 * (_pin) + 1, 2 * (_pin))
  71. #define SX9324_REG_AFE_PH1 0x29
  72. #define SX9324_REG_AFE_PH2 0x2a
  73. #define SX9324_REG_AFE_PH3 0x2b
  74. #define SX9324_REG_AFE_CTRL8 0x2c
  75. #define SX9324_REG_AFE_CTRL8_RESERVED 0x10
  76. #define SX9324_REG_AFE_CTRL8_RESFILTIN_4KOHM 0x02
  77. #define SX9324_REG_AFE_CTRL8_RESFILTIN_MASK GENMASK(3, 0)
  78. #define SX9324_REG_AFE_CTRL9 0x2d
  79. #define SX9324_REG_AFE_CTRL9_AGAIN_MASK GENMASK(3, 0)
  80. #define SX9324_REG_AFE_CTRL9_AGAIN_1 0x08
  81. #define SX9324_REG_PROX_CTRL0 0x30
  82. #define SX9324_REG_PROX_CTRL0_GAIN_MASK GENMASK(5, 3)
  83. #define SX9324_REG_PROX_CTRL0_GAIN_SHIFT 3
  84. #define SX9324_REG_PROX_CTRL0_GAIN_RSVD 0x0
  85. #define SX9324_REG_PROX_CTRL0_GAIN_1 0x1
  86. #define SX9324_REG_PROX_CTRL0_GAIN_8 0x4
  87. #define SX9324_REG_PROX_CTRL0_RAWFILT_MASK GENMASK(2, 0)
  88. #define SX9324_REG_PROX_CTRL0_RAWFILT_1P50 0x01
  89. #define SX9324_REG_PROX_CTRL1 0x31
  90. #define SX9324_REG_PROX_CTRL2 0x32
  91. #define SX9324_REG_PROX_CTRL2_AVGNEG_THRESH_16K 0x20
  92. #define SX9324_REG_PROX_CTRL3 0x33
  93. #define SX9324_REG_PROX_CTRL3_AVGDEB_2SAMPLES 0x40
  94. #define SX9324_REG_PROX_CTRL3_AVGPOS_THRESH_16K 0x20
  95. #define SX9324_REG_PROX_CTRL4 0x34
  96. #define SX9324_REG_PROX_CTRL4_AVGNEGFILT_MASK GENMASK(5, 3)
  97. #define SX9324_REG_PROX_CTRL4_AVGNEG_FILT_2 0x08
  98. #define SX9324_REG_PROX_CTRL4_AVGPOSFILT_MASK GENMASK(2, 0)
  99. #define SX9324_REG_PROX_CTRL4_AVGPOS_FILT_256 0x04
  100. #define SX9324_REG_PROX_CTRL5 0x35
  101. #define SX9324_REG_PROX_CTRL5_HYST_MASK GENMASK(5, 4)
  102. #define SX9324_REG_PROX_CTRL5_CLOSE_DEBOUNCE_MASK GENMASK(3, 2)
  103. #define SX9324_REG_PROX_CTRL5_FAR_DEBOUNCE_MASK GENMASK(1, 0)
  104. #define SX9324_REG_PROX_CTRL6 0x36
  105. #define SX9324_REG_PROX_CTRL6_PROXTHRESH_32 0x08
  106. #define SX9324_REG_PROX_CTRL7 0x37
  107. #define SX9324_REG_ADV_CTRL0 0x40
  108. #define SX9324_REG_ADV_CTRL1 0x41
  109. #define SX9324_REG_ADV_CTRL2 0x42
  110. #define SX9324_REG_ADV_CTRL3 0x43
  111. #define SX9324_REG_ADV_CTRL4 0x44
  112. #define SX9324_REG_ADV_CTRL5 0x45
  113. #define SX9324_REG_ADV_CTRL5_STARTUPSENS_MASK GENMASK(3, 2)
  114. #define SX9324_REG_ADV_CTRL5_STARTUP_SENSOR_1 0x04
  115. #define SX9324_REG_ADV_CTRL5_STARTUP_METHOD_1 0x01
  116. #define SX9324_REG_ADV_CTRL6 0x46
  117. #define SX9324_REG_ADV_CTRL7 0x47
  118. #define SX9324_REG_ADV_CTRL8 0x48
  119. #define SX9324_REG_ADV_CTRL9 0x49
  120. #define SX9324_REG_ADV_CTRL10 0x4a
  121. #define SX9324_REG_ADV_CTRL11 0x4b
  122. #define SX9324_REG_ADV_CTRL12 0x4c
  123. #define SX9324_REG_ADV_CTRL13 0x4d
  124. #define SX9324_REG_ADV_CTRL14 0x4e
  125. #define SX9324_REG_ADV_CTRL15 0x4f
  126. #define SX9324_REG_ADV_CTRL16 0x50
  127. #define SX9324_REG_ADV_CTRL17 0x51
  128. #define SX9324_REG_ADV_CTRL18 0x52
  129. #define SX9324_REG_ADV_CTRL19 0x53
  130. #define SX9324_REG_ADV_CTRL20 0x54
  131. #define SX9324_REG_ADV_CTRL19_HIGHT_FAILURE_THRESH_SATURATION 0xf0
  132. #define SX9324_REG_PHASE_SEL 0x60
  133. #define SX9324_REG_USEFUL_MSB 0x61
  134. #define SX9324_REG_USEFUL_LSB 0x62
  135. #define SX9324_REG_AVG_MSB 0x63
  136. #define SX9324_REG_AVG_LSB 0x64
  137. #define SX9324_REG_DIFF_MSB 0x65
  138. #define SX9324_REG_DIFF_LSB 0x66
  139. #define SX9324_REG_OFFSET_MSB 0x67
  140. #define SX9324_REG_OFFSET_LSB 0x68
  141. #define SX9324_REG_SAR_MSB 0x69
  142. #define SX9324_REG_SAR_LSB 0x6a
  143. #define SX9324_REG_RESET 0x9f
  144. /* Write this to REG_RESET to do a soft reset. */
  145. #define SX9324_SOFT_RESET 0xde
  146. #define SX9324_REG_WHOAMI 0xfa
  147. #define SX9324_WHOAMI_VALUE 0x23
  148. #define SX9324_REG_REVISION 0xfe
  149. /* 4 channels, as defined in STAT0: PH0, PH1, PH2 and PH3. */
  150. #define SX9324_NUM_CHANNELS 4
  151. /* 3 CS pins: CS0, CS1, CS2. */
  152. #define SX9324_NUM_PINS 3
  153. static const char * const sx9324_cs_pin_usage[] = { "HZ", "MI", "DS", "GD" };
  154. static ssize_t sx9324_phase_configuration_show(struct iio_dev *indio_dev,
  155. uintptr_t private,
  156. const struct iio_chan_spec *chan,
  157. char *buf)
  158. {
  159. struct sx_common_data *data = iio_priv(indio_dev);
  160. unsigned int val;
  161. int i, ret, pin_idx;
  162. size_t len = 0;
  163. ret = regmap_read(data->regmap, SX9324_REG_AFE_PH0 + chan->channel, &val);
  164. if (ret < 0)
  165. return ret;
  166. for (i = 0; i < SX9324_NUM_PINS; i++) {
  167. pin_idx = (val & SX9324_REG_AFE_PH0_PIN_MASK(i)) >> (2 * i);
  168. len += sysfs_emit_at(buf, len, "%s,",
  169. sx9324_cs_pin_usage[pin_idx]);
  170. }
  171. buf[len - 1] = '\n';
  172. return len;
  173. }
  174. static const struct iio_chan_spec_ext_info sx9324_channel_ext_info[] = {
  175. {
  176. .name = "setup",
  177. .shared = IIO_SEPARATE,
  178. .read = sx9324_phase_configuration_show,
  179. },
  180. {}
  181. };
  182. #define SX9324_CHANNEL(idx) \
  183. { \
  184. .type = IIO_PROXIMITY, \
  185. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) | \
  186. BIT(IIO_CHAN_INFO_HARDWAREGAIN), \
  187. .info_mask_shared_by_all = BIT(IIO_CHAN_INFO_SAMP_FREQ), \
  188. .info_mask_separate_available = \
  189. BIT(IIO_CHAN_INFO_HARDWAREGAIN), \
  190. .info_mask_shared_by_all_available = \
  191. BIT(IIO_CHAN_INFO_SAMP_FREQ), \
  192. .indexed = 1, \
  193. .channel = idx, \
  194. .address = SX9324_REG_DIFF_MSB, \
  195. .event_spec = sx_common_events, \
  196. .num_event_specs = ARRAY_SIZE(sx_common_events), \
  197. .scan_index = idx, \
  198. .scan_type = { \
  199. .sign = 's', \
  200. .realbits = 12, \
  201. .storagebits = 16, \
  202. .endianness = IIO_BE, \
  203. }, \
  204. .ext_info = sx9324_channel_ext_info, \
  205. }
  206. static const struct iio_chan_spec sx9324_channels[] = {
  207. SX9324_CHANNEL(0), /* Phase 0 */
  208. SX9324_CHANNEL(1), /* Phase 1 */
  209. SX9324_CHANNEL(2), /* Phase 2 */
  210. SX9324_CHANNEL(3), /* Phase 3 */
  211. IIO_CHAN_SOFT_TIMESTAMP(4),
  212. };
  213. /*
  214. * Each entry contains the integer part (val) and the fractional part, in micro
  215. * seconds. It conforms to the IIO output IIO_VAL_INT_PLUS_MICRO.
  216. */
  217. static const struct {
  218. int val;
  219. int val2;
  220. } sx9324_samp_freq_table[] = {
  221. { 1000, 0 }, /* 00000: Min (no idle time) */
  222. { 500, 0 }, /* 00001: 2 ms */
  223. { 250, 0 }, /* 00010: 4 ms */
  224. { 166, 666666 }, /* 00011: 6 ms */
  225. { 125, 0 }, /* 00100: 8 ms */
  226. { 100, 0 }, /* 00101: 10 ms */
  227. { 71, 428571 }, /* 00110: 14 ms */
  228. { 55, 555556 }, /* 00111: 18 ms */
  229. { 45, 454545 }, /* 01000: 22 ms */
  230. { 38, 461538 }, /* 01001: 26 ms */
  231. { 33, 333333 }, /* 01010: 30 ms */
  232. { 29, 411765 }, /* 01011: 34 ms */
  233. { 26, 315789 }, /* 01100: 38 ms */
  234. { 23, 809524 }, /* 01101: 42 ms */
  235. { 21, 739130 }, /* 01110: 46 ms */
  236. { 20, 0 }, /* 01111: 50 ms */
  237. { 17, 857143 }, /* 10000: 56 ms */
  238. { 16, 129032 }, /* 10001: 62 ms */
  239. { 14, 705882 }, /* 10010: 68 ms */
  240. { 13, 513514 }, /* 10011: 74 ms */
  241. { 12, 500000 }, /* 10100: 80 ms */
  242. { 11, 111111 }, /* 10101: 90 ms */
  243. { 10, 0 }, /* 10110: 100 ms (Typ.) */
  244. { 5, 0 }, /* 10111: 200 ms */
  245. { 3, 333333 }, /* 11000: 300 ms */
  246. { 2, 500000 }, /* 11001: 400 ms */
  247. { 1, 666667 }, /* 11010: 600 ms */
  248. { 1, 250000 }, /* 11011: 800 ms */
  249. { 1, 0 }, /* 11100: 1 s */
  250. { 0, 500000 }, /* 11101: 2 s */
  251. { 0, 333333 }, /* 11110: 3 s */
  252. { 0, 250000 }, /* 11111: 4 s */
  253. };
  254. static const unsigned int sx9324_scan_period_table[] = {
  255. 2, 15, 30, 45, 60, 90, 120, 200,
  256. 400, 600, 800, 1000, 2000, 3000, 4000, 5000,
  257. };
  258. static const struct regmap_range sx9324_writable_reg_ranges[] = {
  259. /*
  260. * To set COMPSTAT for compensation, even if datasheet says register is
  261. * RO.
  262. */
  263. regmap_reg_range(SX9324_REG_STAT2, SX9324_REG_STAT2),
  264. regmap_reg_range(SX9324_REG_IRQ_MSK, SX9324_REG_IRQ_CFG2),
  265. regmap_reg_range(SX9324_REG_GNRL_CTRL0, SX9324_REG_GNRL_CTRL1),
  266. /* Leave i2c and clock spreading as unavailable */
  267. regmap_reg_range(SX9324_REG_AFE_CTRL0, SX9324_REG_AFE_CTRL9),
  268. regmap_reg_range(SX9324_REG_PROX_CTRL0, SX9324_REG_PROX_CTRL7),
  269. regmap_reg_range(SX9324_REG_ADV_CTRL0, SX9324_REG_ADV_CTRL20),
  270. regmap_reg_range(SX9324_REG_PHASE_SEL, SX9324_REG_PHASE_SEL),
  271. regmap_reg_range(SX9324_REG_OFFSET_MSB, SX9324_REG_OFFSET_LSB),
  272. regmap_reg_range(SX9324_REG_RESET, SX9324_REG_RESET),
  273. };
  274. static const struct regmap_access_table sx9324_writeable_regs = {
  275. .yes_ranges = sx9324_writable_reg_ranges,
  276. .n_yes_ranges = ARRAY_SIZE(sx9324_writable_reg_ranges),
  277. };
  278. /*
  279. * All allocated registers are readable, so we just list unallocated
  280. * ones.
  281. */
  282. static const struct regmap_range sx9324_non_readable_reg_ranges[] = {
  283. regmap_reg_range(SX9324_REG_IRQ_CFG2 + 1, SX9324_REG_GNRL_CTRL0 - 1),
  284. regmap_reg_range(SX9324_REG_GNRL_CTRL1 + 1, SX9324_REG_AFE_CTRL0 - 1),
  285. regmap_reg_range(SX9324_REG_AFE_CTRL9 + 1, SX9324_REG_PROX_CTRL0 - 1),
  286. regmap_reg_range(SX9324_REG_PROX_CTRL7 + 1, SX9324_REG_ADV_CTRL0 - 1),
  287. regmap_reg_range(SX9324_REG_ADV_CTRL20 + 1, SX9324_REG_PHASE_SEL - 1),
  288. regmap_reg_range(SX9324_REG_SAR_LSB + 1, SX9324_REG_RESET - 1),
  289. regmap_reg_range(SX9324_REG_RESET + 1, SX9324_REG_WHOAMI - 1),
  290. regmap_reg_range(SX9324_REG_WHOAMI + 1, SX9324_REG_REVISION - 1),
  291. };
  292. static const struct regmap_access_table sx9324_readable_regs = {
  293. .no_ranges = sx9324_non_readable_reg_ranges,
  294. .n_no_ranges = ARRAY_SIZE(sx9324_non_readable_reg_ranges),
  295. };
  296. static const struct regmap_range sx9324_volatile_reg_ranges[] = {
  297. regmap_reg_range(SX9324_REG_IRQ_SRC, SX9324_REG_STAT3),
  298. regmap_reg_range(SX9324_REG_USEFUL_MSB, SX9324_REG_DIFF_LSB),
  299. regmap_reg_range(SX9324_REG_SAR_MSB, SX9324_REG_SAR_LSB),
  300. regmap_reg_range(SX9324_REG_WHOAMI, SX9324_REG_WHOAMI),
  301. regmap_reg_range(SX9324_REG_REVISION, SX9324_REG_REVISION),
  302. };
  303. static const struct regmap_access_table sx9324_volatile_regs = {
  304. .yes_ranges = sx9324_volatile_reg_ranges,
  305. .n_yes_ranges = ARRAY_SIZE(sx9324_volatile_reg_ranges),
  306. };
  307. static const struct regmap_config sx9324_regmap_config = {
  308. .reg_bits = 8,
  309. .val_bits = 8,
  310. .max_register = SX9324_REG_REVISION,
  311. .cache_type = REGCACHE_RBTREE,
  312. .wr_table = &sx9324_writeable_regs,
  313. .rd_table = &sx9324_readable_regs,
  314. .volatile_table = &sx9324_volatile_regs,
  315. };
  316. static int sx9324_read_prox_data(struct sx_common_data *data,
  317. const struct iio_chan_spec *chan,
  318. __be16 *val)
  319. {
  320. int ret;
  321. ret = regmap_write(data->regmap, SX9324_REG_PHASE_SEL, chan->channel);
  322. if (ret < 0)
  323. return ret;
  324. return regmap_bulk_read(data->regmap, chan->address, val, sizeof(*val));
  325. }
  326. /*
  327. * If we have no interrupt support, we have to wait for a scan period
  328. * after enabling a channel to get a result.
  329. */
  330. static int sx9324_wait_for_sample(struct sx_common_data *data)
  331. {
  332. int ret;
  333. unsigned int val;
  334. ret = regmap_read(data->regmap, SX9324_REG_GNRL_CTRL0, &val);
  335. if (ret < 0)
  336. return ret;
  337. val = FIELD_GET(SX9324_REG_GNRL_CTRL0_SCANPERIOD_MASK, val);
  338. msleep(sx9324_scan_period_table[val]);
  339. return 0;
  340. }
  341. static int sx9324_read_gain(struct sx_common_data *data,
  342. const struct iio_chan_spec *chan, int *val)
  343. {
  344. unsigned int reg, regval;
  345. int ret;
  346. reg = SX9324_REG_PROX_CTRL0 + chan->channel / 2;
  347. ret = regmap_read(data->regmap, reg, &regval);
  348. if (ret)
  349. return ret;
  350. regval = FIELD_GET(SX9324_REG_PROX_CTRL0_GAIN_MASK, regval);
  351. if (regval)
  352. regval--;
  353. else if (regval == SX9324_REG_PROX_CTRL0_GAIN_RSVD ||
  354. regval > SX9324_REG_PROX_CTRL0_GAIN_8)
  355. return -EINVAL;
  356. *val = 1 << regval;
  357. return IIO_VAL_INT;
  358. }
  359. static int sx9324_read_samp_freq(struct sx_common_data *data,
  360. int *val, int *val2)
  361. {
  362. int ret;
  363. unsigned int regval;
  364. ret = regmap_read(data->regmap, SX9324_REG_GNRL_CTRL0, &regval);
  365. if (ret)
  366. return ret;
  367. regval = FIELD_GET(SX9324_REG_GNRL_CTRL0_SCANPERIOD_MASK, regval);
  368. *val = sx9324_samp_freq_table[regval].val;
  369. *val2 = sx9324_samp_freq_table[regval].val2;
  370. return IIO_VAL_INT_PLUS_MICRO;
  371. }
  372. static int sx9324_read_raw(struct iio_dev *indio_dev,
  373. const struct iio_chan_spec *chan,
  374. int *val, int *val2, long mask)
  375. {
  376. struct sx_common_data *data = iio_priv(indio_dev);
  377. switch (mask) {
  378. case IIO_CHAN_INFO_RAW:
  379. iio_device_claim_direct_scoped(return -EBUSY, indio_dev)
  380. return sx_common_read_proximity(data, chan, val);
  381. unreachable();
  382. case IIO_CHAN_INFO_HARDWAREGAIN:
  383. iio_device_claim_direct_scoped(return -EBUSY, indio_dev)
  384. return sx9324_read_gain(data, chan, val);
  385. unreachable();
  386. case IIO_CHAN_INFO_SAMP_FREQ:
  387. return sx9324_read_samp_freq(data, val, val2);
  388. default:
  389. return -EINVAL;
  390. }
  391. }
  392. static const int sx9324_gain_vals[] = { 1, 2, 4, 8 };
  393. static int sx9324_read_avail(struct iio_dev *indio_dev,
  394. struct iio_chan_spec const *chan,
  395. const int **vals, int *type, int *length,
  396. long mask)
  397. {
  398. if (chan->type != IIO_PROXIMITY)
  399. return -EINVAL;
  400. switch (mask) {
  401. case IIO_CHAN_INFO_HARDWAREGAIN:
  402. *type = IIO_VAL_INT;
  403. *length = ARRAY_SIZE(sx9324_gain_vals);
  404. *vals = sx9324_gain_vals;
  405. return IIO_AVAIL_LIST;
  406. case IIO_CHAN_INFO_SAMP_FREQ:
  407. *type = IIO_VAL_INT_PLUS_MICRO;
  408. *length = ARRAY_SIZE(sx9324_samp_freq_table) * 2;
  409. *vals = (int *)sx9324_samp_freq_table;
  410. return IIO_AVAIL_LIST;
  411. default:
  412. return -EINVAL;
  413. }
  414. }
  415. static int sx9324_set_samp_freq(struct sx_common_data *data,
  416. int val, int val2)
  417. {
  418. int i;
  419. for (i = 0; i < ARRAY_SIZE(sx9324_samp_freq_table); i++)
  420. if (val == sx9324_samp_freq_table[i].val &&
  421. val2 == sx9324_samp_freq_table[i].val2)
  422. break;
  423. if (i == ARRAY_SIZE(sx9324_samp_freq_table))
  424. return -EINVAL;
  425. guard(mutex)(&data->mutex);
  426. return regmap_update_bits(data->regmap,
  427. SX9324_REG_GNRL_CTRL0,
  428. SX9324_REG_GNRL_CTRL0_SCANPERIOD_MASK, i);
  429. }
  430. static int sx9324_read_thresh(struct sx_common_data *data,
  431. const struct iio_chan_spec *chan, int *val)
  432. {
  433. unsigned int regval;
  434. unsigned int reg;
  435. int ret;
  436. /*
  437. * TODO(gwendal): Depending on the phase function
  438. * (proximity/table/body), retrieve the right threshold.
  439. * For now, return the proximity threshold.
  440. */
  441. reg = SX9324_REG_PROX_CTRL6 + chan->channel / 2;
  442. ret = regmap_read(data->regmap, reg, &regval);
  443. if (ret)
  444. return ret;
  445. if (regval <= 1)
  446. *val = regval;
  447. else
  448. *val = (regval * regval) / 2;
  449. return IIO_VAL_INT;
  450. }
  451. static int sx9324_read_hysteresis(struct sx_common_data *data,
  452. const struct iio_chan_spec *chan, int *val)
  453. {
  454. unsigned int regval, pthresh;
  455. int ret;
  456. ret = sx9324_read_thresh(data, chan, &pthresh);
  457. if (ret < 0)
  458. return ret;
  459. ret = regmap_read(data->regmap, SX9324_REG_PROX_CTRL5, &regval);
  460. if (ret)
  461. return ret;
  462. regval = FIELD_GET(SX9324_REG_PROX_CTRL5_HYST_MASK, regval);
  463. if (!regval)
  464. *val = 0;
  465. else
  466. *val = pthresh >> (5 - regval);
  467. return IIO_VAL_INT;
  468. }
  469. static int sx9324_read_far_debounce(struct sx_common_data *data, int *val)
  470. {
  471. unsigned int regval;
  472. int ret;
  473. ret = regmap_read(data->regmap, SX9324_REG_PROX_CTRL5, &regval);
  474. if (ret)
  475. return ret;
  476. regval = FIELD_GET(SX9324_REG_PROX_CTRL5_FAR_DEBOUNCE_MASK, regval);
  477. if (regval)
  478. *val = 1 << regval;
  479. else
  480. *val = 0;
  481. return IIO_VAL_INT;
  482. }
  483. static int sx9324_read_close_debounce(struct sx_common_data *data, int *val)
  484. {
  485. unsigned int regval;
  486. int ret;
  487. ret = regmap_read(data->regmap, SX9324_REG_PROX_CTRL5, &regval);
  488. if (ret)
  489. return ret;
  490. regval = FIELD_GET(SX9324_REG_PROX_CTRL5_CLOSE_DEBOUNCE_MASK, regval);
  491. if (regval)
  492. *val = 1 << regval;
  493. else
  494. *val = 0;
  495. return IIO_VAL_INT;
  496. }
  497. static int sx9324_read_event_val(struct iio_dev *indio_dev,
  498. const struct iio_chan_spec *chan,
  499. enum iio_event_type type,
  500. enum iio_event_direction dir,
  501. enum iio_event_info info, int *val, int *val2)
  502. {
  503. struct sx_common_data *data = iio_priv(indio_dev);
  504. if (chan->type != IIO_PROXIMITY)
  505. return -EINVAL;
  506. switch (info) {
  507. case IIO_EV_INFO_VALUE:
  508. return sx9324_read_thresh(data, chan, val);
  509. case IIO_EV_INFO_PERIOD:
  510. switch (dir) {
  511. case IIO_EV_DIR_RISING:
  512. return sx9324_read_far_debounce(data, val);
  513. case IIO_EV_DIR_FALLING:
  514. return sx9324_read_close_debounce(data, val);
  515. default:
  516. return -EINVAL;
  517. }
  518. case IIO_EV_INFO_HYSTERESIS:
  519. return sx9324_read_hysteresis(data, chan, val);
  520. default:
  521. return -EINVAL;
  522. }
  523. }
  524. static int sx9324_write_thresh(struct sx_common_data *data,
  525. const struct iio_chan_spec *chan, int _val)
  526. {
  527. unsigned int reg, val = _val;
  528. reg = SX9324_REG_PROX_CTRL6 + chan->channel / 2;
  529. if (val >= 1)
  530. val = int_sqrt(2 * val);
  531. if (val > 0xff)
  532. return -EINVAL;
  533. guard(mutex)(&data->mutex);
  534. return regmap_write(data->regmap, reg, val);
  535. }
  536. static int sx9324_write_hysteresis(struct sx_common_data *data,
  537. const struct iio_chan_spec *chan, int _val)
  538. {
  539. unsigned int hyst, val = _val;
  540. int ret, pthresh;
  541. ret = sx9324_read_thresh(data, chan, &pthresh);
  542. if (ret < 0)
  543. return ret;
  544. if (val == 0)
  545. hyst = 0;
  546. else if (val >= pthresh >> 2)
  547. hyst = 3;
  548. else if (val >= pthresh >> 3)
  549. hyst = 2;
  550. else if (val >= pthresh >> 4)
  551. hyst = 1;
  552. else
  553. return -EINVAL;
  554. hyst = FIELD_PREP(SX9324_REG_PROX_CTRL5_HYST_MASK, hyst);
  555. guard(mutex)(&data->mutex);
  556. return regmap_update_bits(data->regmap, SX9324_REG_PROX_CTRL5,
  557. SX9324_REG_PROX_CTRL5_HYST_MASK, hyst);
  558. }
  559. static int sx9324_write_far_debounce(struct sx_common_data *data, int _val)
  560. {
  561. unsigned int regval, val = _val;
  562. if (val > 0)
  563. val = ilog2(val);
  564. if (!FIELD_FIT(SX9324_REG_PROX_CTRL5_FAR_DEBOUNCE_MASK, val))
  565. return -EINVAL;
  566. regval = FIELD_PREP(SX9324_REG_PROX_CTRL5_FAR_DEBOUNCE_MASK, val);
  567. guard(mutex)(&data->mutex);
  568. return regmap_update_bits(data->regmap, SX9324_REG_PROX_CTRL5,
  569. SX9324_REG_PROX_CTRL5_FAR_DEBOUNCE_MASK,
  570. regval);
  571. }
  572. static int sx9324_write_close_debounce(struct sx_common_data *data, int _val)
  573. {
  574. unsigned int regval, val = _val;
  575. if (val > 0)
  576. val = ilog2(val);
  577. if (!FIELD_FIT(SX9324_REG_PROX_CTRL5_CLOSE_DEBOUNCE_MASK, val))
  578. return -EINVAL;
  579. regval = FIELD_PREP(SX9324_REG_PROX_CTRL5_CLOSE_DEBOUNCE_MASK, val);
  580. guard(mutex)(&data->mutex);
  581. return regmap_update_bits(data->regmap, SX9324_REG_PROX_CTRL5,
  582. SX9324_REG_PROX_CTRL5_CLOSE_DEBOUNCE_MASK,
  583. regval);
  584. }
  585. static int sx9324_write_event_val(struct iio_dev *indio_dev,
  586. const struct iio_chan_spec *chan,
  587. enum iio_event_type type,
  588. enum iio_event_direction dir,
  589. enum iio_event_info info, int val, int val2)
  590. {
  591. struct sx_common_data *data = iio_priv(indio_dev);
  592. if (chan->type != IIO_PROXIMITY)
  593. return -EINVAL;
  594. switch (info) {
  595. case IIO_EV_INFO_VALUE:
  596. return sx9324_write_thresh(data, chan, val);
  597. case IIO_EV_INFO_PERIOD:
  598. switch (dir) {
  599. case IIO_EV_DIR_RISING:
  600. return sx9324_write_far_debounce(data, val);
  601. case IIO_EV_DIR_FALLING:
  602. return sx9324_write_close_debounce(data, val);
  603. default:
  604. return -EINVAL;
  605. }
  606. case IIO_EV_INFO_HYSTERESIS:
  607. return sx9324_write_hysteresis(data, chan, val);
  608. default:
  609. return -EINVAL;
  610. }
  611. }
  612. static int sx9324_write_gain(struct sx_common_data *data,
  613. const struct iio_chan_spec *chan, int val)
  614. {
  615. unsigned int gain, reg;
  616. reg = SX9324_REG_PROX_CTRL0 + chan->channel / 2;
  617. gain = ilog2(val) + 1;
  618. if (val <= 0 || gain > SX9324_REG_PROX_CTRL0_GAIN_8)
  619. return -EINVAL;
  620. gain = FIELD_PREP(SX9324_REG_PROX_CTRL0_GAIN_MASK, gain);
  621. guard(mutex)(&data->mutex);
  622. return regmap_update_bits(data->regmap, reg,
  623. SX9324_REG_PROX_CTRL0_GAIN_MASK,
  624. gain);
  625. }
  626. static int sx9324_write_raw(struct iio_dev *indio_dev,
  627. const struct iio_chan_spec *chan, int val, int val2,
  628. long mask)
  629. {
  630. struct sx_common_data *data = iio_priv(indio_dev);
  631. switch (mask) {
  632. case IIO_CHAN_INFO_SAMP_FREQ:
  633. return sx9324_set_samp_freq(data, val, val2);
  634. case IIO_CHAN_INFO_HARDWAREGAIN:
  635. return sx9324_write_gain(data, chan, val);
  636. default:
  637. return -EINVAL;
  638. }
  639. }
  640. static const struct sx_common_reg_default sx9324_default_regs[] = {
  641. { SX9324_REG_IRQ_MSK, 0x00 },
  642. { SX9324_REG_IRQ_CFG0, 0x00, "irq_cfg0" },
  643. { SX9324_REG_IRQ_CFG1, SX9324_REG_IRQ_CFG1_FAILCOND, "irq_cfg1" },
  644. { SX9324_REG_IRQ_CFG2, 0x00, "irq_cfg2" },
  645. { SX9324_REG_GNRL_CTRL0, SX9324_REG_GNRL_CTRL0_SCANPERIOD_100MS, "gnrl_ctrl0" },
  646. /*
  647. * The lower 4 bits should not be set as it enable sensors measurements.
  648. * Turning the detection on before the configuration values are set to
  649. * good values can cause the device to return erroneous readings.
  650. */
  651. { SX9324_REG_GNRL_CTRL1, SX9324_REG_GNRL_CTRL1_PAUSECTRL, "gnrl_ctrl1" },
  652. { SX9324_REG_AFE_CTRL0, SX9324_REG_AFE_CTRL0_RINT_LOWEST, "afe_ctrl0" },
  653. { SX9324_REG_AFE_CTRL3, 0x00, "afe_ctrl3" },
  654. { SX9324_REG_AFE_CTRL4, SX9324_REG_AFE_CTRL4_FREQ_83_33HZ |
  655. SX9324_REG_AFE_CTRL4_RES_100, "afe_ctrl4" },
  656. { SX9324_REG_AFE_CTRL6, 0x00, "afe_ctrl6" },
  657. { SX9324_REG_AFE_CTRL7, SX9324_REG_AFE_CTRL4_FREQ_83_33HZ |
  658. SX9324_REG_AFE_CTRL4_RES_100, "afe_ctrl7" },
  659. /* TODO(gwendal): PHx use chip default or all grounded? */
  660. { SX9324_REG_AFE_PH0, 0x29, "afe_ph0" },
  661. { SX9324_REG_AFE_PH1, 0x26, "afe_ph1" },
  662. { SX9324_REG_AFE_PH2, 0x1a, "afe_ph2" },
  663. { SX9324_REG_AFE_PH3, 0x16, "afe_ph3" },
  664. { SX9324_REG_AFE_CTRL8, SX9324_REG_AFE_CTRL8_RESERVED |
  665. SX9324_REG_AFE_CTRL8_RESFILTIN_4KOHM, "afe_ctrl8" },
  666. { SX9324_REG_AFE_CTRL9, SX9324_REG_AFE_CTRL9_AGAIN_1, "afe_ctrl9" },
  667. { SX9324_REG_PROX_CTRL0,
  668. SX9324_REG_PROX_CTRL0_GAIN_1 << SX9324_REG_PROX_CTRL0_GAIN_SHIFT |
  669. SX9324_REG_PROX_CTRL0_RAWFILT_1P50, "prox_ctrl0" },
  670. { SX9324_REG_PROX_CTRL1,
  671. SX9324_REG_PROX_CTRL0_GAIN_1 << SX9324_REG_PROX_CTRL0_GAIN_SHIFT |
  672. SX9324_REG_PROX_CTRL0_RAWFILT_1P50, "prox_ctrl1" },
  673. { SX9324_REG_PROX_CTRL2, SX9324_REG_PROX_CTRL2_AVGNEG_THRESH_16K, "prox_ctrl2" },
  674. { SX9324_REG_PROX_CTRL3, SX9324_REG_PROX_CTRL3_AVGDEB_2SAMPLES |
  675. SX9324_REG_PROX_CTRL3_AVGPOS_THRESH_16K, "prox_ctrl3" },
  676. { SX9324_REG_PROX_CTRL4, SX9324_REG_PROX_CTRL4_AVGNEG_FILT_2 |
  677. SX9324_REG_PROX_CTRL4_AVGPOS_FILT_256, "prox_ctrl4" },
  678. { SX9324_REG_PROX_CTRL5, 0x00, "prox_ctrl5" },
  679. { SX9324_REG_PROX_CTRL6, SX9324_REG_PROX_CTRL6_PROXTHRESH_32, "prox_ctrl6" },
  680. { SX9324_REG_PROX_CTRL7, SX9324_REG_PROX_CTRL6_PROXTHRESH_32, "prox_ctrl7" },
  681. { SX9324_REG_ADV_CTRL0, 0x00, "adv_ctrl0" },
  682. { SX9324_REG_ADV_CTRL1, 0x00, "adv_ctrl1" },
  683. { SX9324_REG_ADV_CTRL2, 0x00, "adv_ctrl2" },
  684. { SX9324_REG_ADV_CTRL3, 0x00, "adv_ctrl3" },
  685. { SX9324_REG_ADV_CTRL4, 0x00, "adv_ctrl4" },
  686. { SX9324_REG_ADV_CTRL5, SX9324_REG_ADV_CTRL5_STARTUP_SENSOR_1 |
  687. SX9324_REG_ADV_CTRL5_STARTUP_METHOD_1, "adv_ctrl5" },
  688. { SX9324_REG_ADV_CTRL6, 0x00, "adv_ctrl6" },
  689. { SX9324_REG_ADV_CTRL7, 0x00, "adv_ctrl7" },
  690. { SX9324_REG_ADV_CTRL8, 0x00, "adv_ctrl8" },
  691. { SX9324_REG_ADV_CTRL9, 0x00, "adv_ctrl9" },
  692. /* Body/Table threshold */
  693. { SX9324_REG_ADV_CTRL10, 0x00, "adv_ctrl10" },
  694. { SX9324_REG_ADV_CTRL11, 0x00, "adv_ctrl11" },
  695. { SX9324_REG_ADV_CTRL12, 0x00, "adv_ctrl12" },
  696. /* TODO(gwendal): SAR currenly disabled */
  697. { SX9324_REG_ADV_CTRL13, 0x00, "adv_ctrl13" },
  698. { SX9324_REG_ADV_CTRL14, 0x00, "adv_ctrl14" },
  699. { SX9324_REG_ADV_CTRL15, 0x00, "adv_ctrl15" },
  700. { SX9324_REG_ADV_CTRL16, 0x00, "adv_ctrl16" },
  701. { SX9324_REG_ADV_CTRL17, 0x00, "adv_ctrl17" },
  702. { SX9324_REG_ADV_CTRL18, 0x00, "adv_ctrl18" },
  703. { SX9324_REG_ADV_CTRL19,
  704. SX9324_REG_ADV_CTRL19_HIGHT_FAILURE_THRESH_SATURATION, "adv_ctrl19" },
  705. { SX9324_REG_ADV_CTRL20,
  706. SX9324_REG_ADV_CTRL19_HIGHT_FAILURE_THRESH_SATURATION, "adv_ctrl20" },
  707. };
  708. /* Activate all channels and perform an initial compensation. */
  709. static int sx9324_init_compensation(struct iio_dev *indio_dev)
  710. {
  711. struct sx_common_data *data = iio_priv(indio_dev);
  712. unsigned int val;
  713. int ret;
  714. /* run the compensation phase on all channels */
  715. ret = regmap_set_bits(data->regmap, SX9324_REG_STAT2,
  716. SX9324_REG_STAT2_COMPSTAT_MASK);
  717. if (ret)
  718. return ret;
  719. return regmap_read_poll_timeout(data->regmap, SX9324_REG_STAT2, val,
  720. !(val & SX9324_REG_STAT2_COMPSTAT_MASK),
  721. 20000, 2000000);
  722. }
  723. static u8 sx9324_parse_phase_prop(struct device *dev,
  724. struct sx_common_reg_default *reg_def,
  725. const char *prop)
  726. {
  727. unsigned int pin_defs[SX9324_NUM_PINS];
  728. int count, ret, pin;
  729. u32 raw = 0;
  730. count = device_property_count_u32(dev, prop);
  731. if (count != ARRAY_SIZE(pin_defs))
  732. return reg_def->def;
  733. ret = device_property_read_u32_array(dev, prop, pin_defs,
  734. ARRAY_SIZE(pin_defs));
  735. if (ret)
  736. return reg_def->def;
  737. for (pin = 0; pin < SX9324_NUM_PINS; pin++)
  738. raw |= (pin_defs[pin] << (2 * pin)) &
  739. SX9324_REG_AFE_PH0_PIN_MASK(pin);
  740. return raw;
  741. }
  742. static const struct sx_common_reg_default *
  743. sx9324_get_default_reg(struct device *dev, int idx,
  744. struct sx_common_reg_default *reg_def)
  745. {
  746. static const char * const sx9324_rints[] = { "lowest", "low", "high",
  747. "highest" };
  748. static const char * const sx9324_csidle[] = { "hi-z", "hi-z", "gnd",
  749. "vdd" };
  750. u32 start = 0, raw = 0, pos = 0;
  751. const char *prop;
  752. int ret;
  753. memcpy(reg_def, &sx9324_default_regs[idx], sizeof(*reg_def));
  754. sx_common_get_raw_register_config(dev, reg_def);
  755. switch (reg_def->reg) {
  756. case SX9324_REG_AFE_PH0:
  757. reg_def->def = sx9324_parse_phase_prop(dev, reg_def,
  758. "semtech,ph0-pin");
  759. break;
  760. case SX9324_REG_AFE_PH1:
  761. reg_def->def = sx9324_parse_phase_prop(dev, reg_def,
  762. "semtech,ph1-pin");
  763. break;
  764. case SX9324_REG_AFE_PH2:
  765. reg_def->def = sx9324_parse_phase_prop(dev, reg_def,
  766. "semtech,ph2-pin");
  767. break;
  768. case SX9324_REG_AFE_PH3:
  769. reg_def->def = sx9324_parse_phase_prop(dev, reg_def,
  770. "semtech,ph3-pin");
  771. break;
  772. case SX9324_REG_AFE_CTRL0:
  773. ret = device_property_match_property_string(dev, "semtech,cs-idle-sleep",
  774. sx9324_csidle,
  775. ARRAY_SIZE(sx9324_csidle));
  776. if (ret >= 0) {
  777. reg_def->def &= ~SX9324_REG_AFE_CTRL0_CSIDLE_MASK;
  778. reg_def->def |= ret << SX9324_REG_AFE_CTRL0_CSIDLE_SHIFT;
  779. }
  780. ret = device_property_match_property_string(dev, "semtech,int-comp-resistor",
  781. sx9324_rints,
  782. ARRAY_SIZE(sx9324_rints));
  783. if (ret >= 0) {
  784. reg_def->def &= ~SX9324_REG_AFE_CTRL0_RINT_MASK;
  785. reg_def->def |= ret << SX9324_REG_AFE_CTRL0_RINT_SHIFT;
  786. }
  787. break;
  788. case SX9324_REG_AFE_CTRL4:
  789. case SX9324_REG_AFE_CTRL7:
  790. if (reg_def->reg == SX9324_REG_AFE_CTRL4)
  791. prop = "semtech,ph01-resolution";
  792. else
  793. prop = "semtech,ph23-resolution";
  794. ret = device_property_read_u32(dev, prop, &raw);
  795. if (ret)
  796. break;
  797. raw = ilog2(raw) - 3;
  798. reg_def->def &= ~SX9324_REG_AFE_CTRL4_RESOLUTION_MASK;
  799. reg_def->def |= FIELD_PREP(SX9324_REG_AFE_CTRL4_RESOLUTION_MASK,
  800. raw);
  801. break;
  802. case SX9324_REG_AFE_CTRL8:
  803. ret = device_property_read_u32(dev,
  804. "semtech,input-precharge-resistor-ohms",
  805. &raw);
  806. if (ret)
  807. break;
  808. reg_def->def &= ~SX9324_REG_AFE_CTRL8_RESFILTIN_MASK;
  809. reg_def->def |= FIELD_PREP(SX9324_REG_AFE_CTRL8_RESFILTIN_MASK,
  810. raw / 2000);
  811. break;
  812. case SX9324_REG_AFE_CTRL9:
  813. ret = device_property_read_u32(dev,
  814. "semtech,input-analog-gain", &raw);
  815. if (ret)
  816. break;
  817. /*
  818. * The analog gain has the following setting:
  819. * +---------+----------------+----------------+
  820. * | dt(raw) | physical value | register value |
  821. * +---------+----------------+----------------+
  822. * | 0 | x1.247 | 6 |
  823. * | 1 | x1 | 8 |
  824. * | 2 | x0.768 | 11 |
  825. * | 3 | x0.552 | 15 |
  826. * +---------+----------------+----------------+
  827. */
  828. reg_def->def &= ~SX9324_REG_AFE_CTRL9_AGAIN_MASK;
  829. reg_def->def |= FIELD_PREP(SX9324_REG_AFE_CTRL9_AGAIN_MASK,
  830. 6 + raw * (raw + 3) / 2);
  831. break;
  832. case SX9324_REG_ADV_CTRL5:
  833. ret = device_property_read_u32(dev, "semtech,startup-sensor",
  834. &start);
  835. if (ret)
  836. break;
  837. reg_def->def &= ~SX9324_REG_ADV_CTRL5_STARTUPSENS_MASK;
  838. reg_def->def |= FIELD_PREP(SX9324_REG_ADV_CTRL5_STARTUPSENS_MASK,
  839. start);
  840. break;
  841. case SX9324_REG_PROX_CTRL4:
  842. ret = device_property_read_u32(dev, "semtech,avg-pos-strength",
  843. &pos);
  844. if (ret)
  845. break;
  846. /* Powers of 2, except for a gap between 16 and 64 */
  847. raw = clamp(ilog2(pos), 3, 11) - (pos >= 32 ? 4 : 3);
  848. reg_def->def &= ~SX9324_REG_PROX_CTRL4_AVGPOSFILT_MASK;
  849. reg_def->def |= FIELD_PREP(SX9324_REG_PROX_CTRL4_AVGPOSFILT_MASK,
  850. raw);
  851. break;
  852. case SX9324_REG_PROX_CTRL0:
  853. case SX9324_REG_PROX_CTRL1:
  854. if (reg_def->reg == SX9324_REG_PROX_CTRL0)
  855. prop = "semtech,ph01-proxraw-strength";
  856. else
  857. prop = "semtech,ph23-proxraw-strength";
  858. ret = device_property_read_u32(dev, prop, &raw);
  859. if (ret)
  860. break;
  861. reg_def->def &= ~SX9324_REG_PROX_CTRL0_RAWFILT_MASK;
  862. reg_def->def |= FIELD_PREP(SX9324_REG_PROX_CTRL0_RAWFILT_MASK,
  863. raw);
  864. break;
  865. }
  866. return reg_def;
  867. }
  868. static int sx9324_check_whoami(struct device *dev,
  869. struct iio_dev *indio_dev)
  870. {
  871. /*
  872. * Only one sensor for this driver. Assuming the device tree
  873. * is correct, just set the sensor name.
  874. */
  875. indio_dev->name = "sx9324";
  876. return 0;
  877. }
  878. static const struct sx_common_chip_info sx9324_chip_info = {
  879. .reg_stat = SX9324_REG_STAT0,
  880. .reg_irq_msk = SX9324_REG_IRQ_MSK,
  881. .reg_enable_chan = SX9324_REG_GNRL_CTRL1,
  882. .reg_reset = SX9324_REG_RESET,
  883. .mask_enable_chan = SX9324_REG_GNRL_CTRL1_PHEN_MASK,
  884. .irq_msk_offset = 3,
  885. .num_channels = SX9324_NUM_CHANNELS,
  886. .num_default_regs = ARRAY_SIZE(sx9324_default_regs),
  887. .ops = {
  888. .read_prox_data = sx9324_read_prox_data,
  889. .check_whoami = sx9324_check_whoami,
  890. .init_compensation = sx9324_init_compensation,
  891. .wait_for_sample = sx9324_wait_for_sample,
  892. .get_default_reg = sx9324_get_default_reg,
  893. },
  894. .iio_channels = sx9324_channels,
  895. .num_iio_channels = ARRAY_SIZE(sx9324_channels),
  896. .iio_info = {
  897. .read_raw = sx9324_read_raw,
  898. .read_avail = sx9324_read_avail,
  899. .read_event_value = sx9324_read_event_val,
  900. .write_event_value = sx9324_write_event_val,
  901. .write_raw = sx9324_write_raw,
  902. .read_event_config = sx_common_read_event_config,
  903. .write_event_config = sx_common_write_event_config,
  904. },
  905. };
  906. static int sx9324_probe(struct i2c_client *client)
  907. {
  908. return sx_common_probe(client, &sx9324_chip_info, &sx9324_regmap_config);
  909. }
  910. static int sx9324_suspend(struct device *dev)
  911. {
  912. struct sx_common_data *data = iio_priv(dev_get_drvdata(dev));
  913. unsigned int regval;
  914. int ret;
  915. disable_irq_nosync(data->client->irq);
  916. guard(mutex)(&data->mutex);
  917. ret = regmap_read(data->regmap, SX9324_REG_GNRL_CTRL1, &regval);
  918. if (ret < 0)
  919. return ret;
  920. data->suspend_ctrl =
  921. FIELD_GET(SX9324_REG_GNRL_CTRL1_PHEN_MASK, regval);
  922. /* Disable all phases, send the device to sleep. */
  923. return regmap_write(data->regmap, SX9324_REG_GNRL_CTRL1, 0);
  924. }
  925. static int sx9324_resume(struct device *dev)
  926. {
  927. struct sx_common_data *data = iio_priv(dev_get_drvdata(dev));
  928. scoped_guard(mutex, &data->mutex) {
  929. int ret = regmap_write(data->regmap, SX9324_REG_GNRL_CTRL1,
  930. data->suspend_ctrl |
  931. SX9324_REG_GNRL_CTRL1_PAUSECTRL);
  932. if (ret)
  933. return ret;
  934. }
  935. enable_irq(data->client->irq);
  936. return 0;
  937. }
  938. static DEFINE_SIMPLE_DEV_PM_OPS(sx9324_pm_ops, sx9324_suspend, sx9324_resume);
  939. static const struct acpi_device_id sx9324_acpi_match[] = {
  940. { "STH9324", SX9324_WHOAMI_VALUE },
  941. { }
  942. };
  943. MODULE_DEVICE_TABLE(acpi, sx9324_acpi_match);
  944. static const struct of_device_id sx9324_of_match[] = {
  945. { .compatible = "semtech,sx9324", (void *)SX9324_WHOAMI_VALUE },
  946. { }
  947. };
  948. MODULE_DEVICE_TABLE(of, sx9324_of_match);
  949. static const struct i2c_device_id sx9324_id[] = {
  950. { "sx9324", SX9324_WHOAMI_VALUE },
  951. { }
  952. };
  953. MODULE_DEVICE_TABLE(i2c, sx9324_id);
  954. static struct i2c_driver sx9324_driver = {
  955. .driver = {
  956. .name = "sx9324",
  957. .acpi_match_table = sx9324_acpi_match,
  958. .of_match_table = sx9324_of_match,
  959. .pm = pm_sleep_ptr(&sx9324_pm_ops),
  960. /*
  961. * Lots of i2c transfers in probe + over 200 ms waiting in
  962. * sx9324_init_compensation() mean a slow probe; prefer async
  963. * so we don't delay boot if we're builtin to the kernel.
  964. */
  965. .probe_type = PROBE_PREFER_ASYNCHRONOUS,
  966. },
  967. .probe = sx9324_probe,
  968. .id_table = sx9324_id,
  969. };
  970. module_i2c_driver(sx9324_driver);
  971. MODULE_AUTHOR("Gwendal Grignou <gwendal@chromium.org>");
  972. MODULE_DESCRIPTION("Driver for Semtech SX9324 proximity sensor");
  973. MODULE_LICENSE("GPL v2");
  974. MODULE_IMPORT_NS(SEMTECH_PROX);