max44000.c 17 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643
  1. /*
  2. * MAX44000 Ambient and Infrared Proximity Sensor
  3. *
  4. * Copyright (c) 2016, Intel Corporation.
  5. *
  6. * This file is subject to the terms and conditions of version 2 of
  7. * the GNU General Public License. See the file COPYING in the main
  8. * directory of this archive for more details.
  9. *
  10. * Data sheet: https://datasheets.maximintegrated.com/en/ds/MAX44000.pdf
  11. *
  12. * 7-bit I2C slave address 0x4a
  13. */
  14. #include <linux/module.h>
  15. #include <linux/init.h>
  16. #include <linux/i2c.h>
  17. #include <linux/regmap.h>
  18. #include <linux/util_macros.h>
  19. #include <linux/iio/iio.h>
  20. #include <linux/iio/sysfs.h>
  21. #include <linux/iio/buffer.h>
  22. #include <linux/iio/trigger_consumer.h>
  23. #include <linux/iio/triggered_buffer.h>
  24. #include <linux/acpi.h>
  25. #define MAX44000_DRV_NAME "max44000"
  26. /* Registers in datasheet order */
  27. #define MAX44000_REG_STATUS 0x00
  28. #define MAX44000_REG_CFG_MAIN 0x01
  29. #define MAX44000_REG_CFG_RX 0x02
  30. #define MAX44000_REG_CFG_TX 0x03
  31. #define MAX44000_REG_ALS_DATA_HI 0x04
  32. #define MAX44000_REG_ALS_DATA_LO 0x05
  33. #define MAX44000_REG_PRX_DATA 0x16
  34. #define MAX44000_REG_ALS_UPTHR_HI 0x06
  35. #define MAX44000_REG_ALS_UPTHR_LO 0x07
  36. #define MAX44000_REG_ALS_LOTHR_HI 0x08
  37. #define MAX44000_REG_ALS_LOTHR_LO 0x09
  38. #define MAX44000_REG_PST 0x0a
  39. #define MAX44000_REG_PRX_IND 0x0b
  40. #define MAX44000_REG_PRX_THR 0x0c
  41. #define MAX44000_REG_TRIM_GAIN_GREEN 0x0f
  42. #define MAX44000_REG_TRIM_GAIN_IR 0x10
  43. /* REG_CFG bits */
  44. #define MAX44000_CFG_ALSINTE 0x01
  45. #define MAX44000_CFG_PRXINTE 0x02
  46. #define MAX44000_CFG_MASK 0x1c
  47. #define MAX44000_CFG_MODE_SHUTDOWN 0x00
  48. #define MAX44000_CFG_MODE_ALS_GIR 0x04
  49. #define MAX44000_CFG_MODE_ALS_G 0x08
  50. #define MAX44000_CFG_MODE_ALS_IR 0x0c
  51. #define MAX44000_CFG_MODE_ALS_PRX 0x10
  52. #define MAX44000_CFG_MODE_PRX 0x14
  53. #define MAX44000_CFG_TRIM 0x20
  54. /*
  55. * Upper 4 bits are not documented but start as 1 on powerup
  56. * Setting them to 0 causes proximity to misbehave so set them to 1
  57. */
  58. #define MAX44000_REG_CFG_RX_DEFAULT 0xf0
  59. /* REG_RX bits */
  60. #define MAX44000_CFG_RX_ALSTIM_MASK 0x0c
  61. #define MAX44000_CFG_RX_ALSTIM_SHIFT 2
  62. #define MAX44000_CFG_RX_ALSPGA_MASK 0x03
  63. #define MAX44000_CFG_RX_ALSPGA_SHIFT 0
  64. /* REG_TX bits */
  65. #define MAX44000_LED_CURRENT_MASK 0xf
  66. #define MAX44000_LED_CURRENT_MAX 11
  67. #define MAX44000_LED_CURRENT_DEFAULT 6
  68. #define MAX44000_ALSDATA_OVERFLOW 0x4000
  69. struct max44000_data {
  70. struct mutex lock;
  71. struct regmap *regmap;
  72. /* Ensure naturally aligned timestamp */
  73. struct {
  74. u16 channels[2];
  75. s64 ts __aligned(8);
  76. } scan;
  77. };
  78. /* Default scale is set to the minimum of 0.03125 or 1 / (1 << 5) lux */
  79. #define MAX44000_ALS_TO_LUX_DEFAULT_FRACTION_LOG2 5
  80. /* Scale can be multiplied by up to 128x via ALSPGA for measurement gain */
  81. static const int max44000_alspga_shift[] = {0, 2, 4, 7};
  82. #define MAX44000_ALSPGA_MAX_SHIFT 7
  83. /*
  84. * Scale can be multiplied by up to 64x via ALSTIM because of lost resolution
  85. *
  86. * This scaling factor is hidden from userspace and instead accounted for when
  87. * reading raw values from the device.
  88. *
  89. * This makes it possible to cleanly expose ALSPGA as IIO_CHAN_INFO_SCALE and
  90. * ALSTIM as IIO_CHAN_INFO_INT_TIME without the values affecting each other.
  91. *
  92. * Handling this internally is also required for buffer support because the
  93. * channel's scan_type can't be modified dynamically.
  94. */
  95. static const int max44000_alstim_shift[] = {0, 2, 4, 6};
  96. #define MAX44000_ALSTIM_SHIFT(alstim) (2 * (alstim))
  97. /* Available integration times with pretty manual alignment: */
  98. static const int max44000_int_time_avail_ns_array[] = {
  99. 100000000,
  100. 25000000,
  101. 6250000,
  102. 1562500,
  103. };
  104. static const char max44000_int_time_avail_str[] =
  105. "0.100 "
  106. "0.025 "
  107. "0.00625 "
  108. "0.0015625";
  109. /* Available scales (internal to ulux) with pretty manual alignment: */
  110. static const int max44000_scale_avail_ulux_array[] = {
  111. 31250,
  112. 125000,
  113. 500000,
  114. 4000000,
  115. };
  116. static const char max44000_scale_avail_str[] =
  117. "0.03125 "
  118. "0.125 "
  119. "0.5 "
  120. "4";
  121. #define MAX44000_SCAN_INDEX_ALS 0
  122. #define MAX44000_SCAN_INDEX_PRX 1
  123. static const struct iio_chan_spec max44000_channels[] = {
  124. {
  125. .type = IIO_LIGHT,
  126. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
  127. .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) |
  128. BIT(IIO_CHAN_INFO_INT_TIME),
  129. .scan_index = MAX44000_SCAN_INDEX_ALS,
  130. .scan_type = {
  131. .sign = 'u',
  132. .realbits = 14,
  133. .storagebits = 16,
  134. }
  135. },
  136. {
  137. .type = IIO_PROXIMITY,
  138. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
  139. .scan_index = MAX44000_SCAN_INDEX_PRX,
  140. .scan_type = {
  141. .sign = 'u',
  142. .realbits = 8,
  143. .storagebits = 16,
  144. }
  145. },
  146. IIO_CHAN_SOFT_TIMESTAMP(2),
  147. {
  148. .type = IIO_CURRENT,
  149. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
  150. BIT(IIO_CHAN_INFO_SCALE),
  151. .extend_name = "led",
  152. .output = 1,
  153. .scan_index = -1,
  154. },
  155. };
  156. static int max44000_read_alstim(struct max44000_data *data)
  157. {
  158. unsigned int val;
  159. int ret;
  160. ret = regmap_read(data->regmap, MAX44000_REG_CFG_RX, &val);
  161. if (ret < 0)
  162. return ret;
  163. return (val & MAX44000_CFG_RX_ALSTIM_MASK) >> MAX44000_CFG_RX_ALSTIM_SHIFT;
  164. }
  165. static int max44000_write_alstim(struct max44000_data *data, int val)
  166. {
  167. return regmap_write_bits(data->regmap, MAX44000_REG_CFG_RX,
  168. MAX44000_CFG_RX_ALSTIM_MASK,
  169. val << MAX44000_CFG_RX_ALSTIM_SHIFT);
  170. }
  171. static int max44000_read_alspga(struct max44000_data *data)
  172. {
  173. unsigned int val;
  174. int ret;
  175. ret = regmap_read(data->regmap, MAX44000_REG_CFG_RX, &val);
  176. if (ret < 0)
  177. return ret;
  178. return (val & MAX44000_CFG_RX_ALSPGA_MASK) >> MAX44000_CFG_RX_ALSPGA_SHIFT;
  179. }
  180. static int max44000_write_alspga(struct max44000_data *data, int val)
  181. {
  182. return regmap_write_bits(data->regmap, MAX44000_REG_CFG_RX,
  183. MAX44000_CFG_RX_ALSPGA_MASK,
  184. val << MAX44000_CFG_RX_ALSPGA_SHIFT);
  185. }
  186. static int max44000_read_alsval(struct max44000_data *data)
  187. {
  188. u16 regval;
  189. __be16 val;
  190. int alstim, ret;
  191. ret = regmap_bulk_read(data->regmap, MAX44000_REG_ALS_DATA_HI,
  192. &val, sizeof(val));
  193. if (ret < 0)
  194. return ret;
  195. alstim = ret = max44000_read_alstim(data);
  196. if (ret < 0)
  197. return ret;
  198. regval = be16_to_cpu(val);
  199. /*
  200. * Overflow is explained on datasheet page 17.
  201. *
  202. * It's a warning that either the G or IR channel has become saturated
  203. * and that the value in the register is likely incorrect.
  204. *
  205. * The recommendation is to change the scale (ALSPGA).
  206. * The driver just returns the max representable value.
  207. */
  208. if (regval & MAX44000_ALSDATA_OVERFLOW)
  209. return 0x3FFF;
  210. return regval << MAX44000_ALSTIM_SHIFT(alstim);
  211. }
  212. static int max44000_write_led_current_raw(struct max44000_data *data, int val)
  213. {
  214. /* Maybe we should clamp the value instead? */
  215. if (val < 0 || val > MAX44000_LED_CURRENT_MAX)
  216. return -ERANGE;
  217. if (val >= 8)
  218. val += 4;
  219. return regmap_write_bits(data->regmap, MAX44000_REG_CFG_TX,
  220. MAX44000_LED_CURRENT_MASK, val);
  221. }
  222. static int max44000_read_led_current_raw(struct max44000_data *data)
  223. {
  224. unsigned int regval;
  225. int ret;
  226. ret = regmap_read(data->regmap, MAX44000_REG_CFG_TX, &regval);
  227. if (ret < 0)
  228. return ret;
  229. regval &= MAX44000_LED_CURRENT_MASK;
  230. if (regval >= 8)
  231. regval -= 4;
  232. return regval;
  233. }
  234. static int max44000_read_raw(struct iio_dev *indio_dev,
  235. struct iio_chan_spec const *chan,
  236. int *val, int *val2, long mask)
  237. {
  238. struct max44000_data *data = iio_priv(indio_dev);
  239. int alstim, alspga;
  240. unsigned int regval;
  241. int ret;
  242. switch (mask) {
  243. case IIO_CHAN_INFO_RAW:
  244. switch (chan->type) {
  245. case IIO_LIGHT:
  246. mutex_lock(&data->lock);
  247. ret = max44000_read_alsval(data);
  248. mutex_unlock(&data->lock);
  249. if (ret < 0)
  250. return ret;
  251. *val = ret;
  252. return IIO_VAL_INT;
  253. case IIO_PROXIMITY:
  254. mutex_lock(&data->lock);
  255. ret = regmap_read(data->regmap, MAX44000_REG_PRX_DATA, &regval);
  256. mutex_unlock(&data->lock);
  257. if (ret < 0)
  258. return ret;
  259. *val = regval;
  260. return IIO_VAL_INT;
  261. case IIO_CURRENT:
  262. mutex_lock(&data->lock);
  263. ret = max44000_read_led_current_raw(data);
  264. mutex_unlock(&data->lock);
  265. if (ret < 0)
  266. return ret;
  267. *val = ret;
  268. return IIO_VAL_INT;
  269. default:
  270. return -EINVAL;
  271. }
  272. case IIO_CHAN_INFO_SCALE:
  273. switch (chan->type) {
  274. case IIO_CURRENT:
  275. /* Output register is in 10s of miliamps */
  276. *val = 10;
  277. return IIO_VAL_INT;
  278. case IIO_LIGHT:
  279. mutex_lock(&data->lock);
  280. alspga = ret = max44000_read_alspga(data);
  281. mutex_unlock(&data->lock);
  282. if (ret < 0)
  283. return ret;
  284. /* Avoid negative shifts */
  285. *val = (1 << MAX44000_ALSPGA_MAX_SHIFT);
  286. *val2 = MAX44000_ALS_TO_LUX_DEFAULT_FRACTION_LOG2
  287. + MAX44000_ALSPGA_MAX_SHIFT
  288. - max44000_alspga_shift[alspga];
  289. return IIO_VAL_FRACTIONAL_LOG2;
  290. default:
  291. return -EINVAL;
  292. }
  293. case IIO_CHAN_INFO_INT_TIME:
  294. mutex_lock(&data->lock);
  295. alstim = ret = max44000_read_alstim(data);
  296. mutex_unlock(&data->lock);
  297. if (ret < 0)
  298. return ret;
  299. *val = 0;
  300. *val2 = max44000_int_time_avail_ns_array[alstim];
  301. return IIO_VAL_INT_PLUS_NANO;
  302. default:
  303. return -EINVAL;
  304. }
  305. }
  306. static int max44000_write_raw(struct iio_dev *indio_dev,
  307. struct iio_chan_spec const *chan,
  308. int val, int val2, long mask)
  309. {
  310. struct max44000_data *data = iio_priv(indio_dev);
  311. int ret;
  312. if (mask == IIO_CHAN_INFO_RAW && chan->type == IIO_CURRENT) {
  313. mutex_lock(&data->lock);
  314. ret = max44000_write_led_current_raw(data, val);
  315. mutex_unlock(&data->lock);
  316. return ret;
  317. } else if (mask == IIO_CHAN_INFO_INT_TIME && chan->type == IIO_LIGHT) {
  318. s64 valns = val * NSEC_PER_SEC + val2;
  319. int alstim = find_closest_descending(valns,
  320. max44000_int_time_avail_ns_array,
  321. ARRAY_SIZE(max44000_int_time_avail_ns_array));
  322. mutex_lock(&data->lock);
  323. ret = max44000_write_alstim(data, alstim);
  324. mutex_unlock(&data->lock);
  325. return ret;
  326. } else if (mask == IIO_CHAN_INFO_SCALE && chan->type == IIO_LIGHT) {
  327. s64 valus = val * USEC_PER_SEC + val2;
  328. int alspga = find_closest(valus,
  329. max44000_scale_avail_ulux_array,
  330. ARRAY_SIZE(max44000_scale_avail_ulux_array));
  331. mutex_lock(&data->lock);
  332. ret = max44000_write_alspga(data, alspga);
  333. mutex_unlock(&data->lock);
  334. return ret;
  335. }
  336. return -EINVAL;
  337. }
  338. static int max44000_write_raw_get_fmt(struct iio_dev *indio_dev,
  339. struct iio_chan_spec const *chan,
  340. long mask)
  341. {
  342. if (mask == IIO_CHAN_INFO_INT_TIME && chan->type == IIO_LIGHT)
  343. return IIO_VAL_INT_PLUS_NANO;
  344. else if (mask == IIO_CHAN_INFO_SCALE && chan->type == IIO_LIGHT)
  345. return IIO_VAL_INT_PLUS_MICRO;
  346. else
  347. return IIO_VAL_INT;
  348. }
  349. static IIO_CONST_ATTR(illuminance_integration_time_available, max44000_int_time_avail_str);
  350. static IIO_CONST_ATTR(illuminance_scale_available, max44000_scale_avail_str);
  351. static struct attribute *max44000_attributes[] = {
  352. &iio_const_attr_illuminance_integration_time_available.dev_attr.attr,
  353. &iio_const_attr_illuminance_scale_available.dev_attr.attr,
  354. NULL
  355. };
  356. static const struct attribute_group max44000_attribute_group = {
  357. .attrs = max44000_attributes,
  358. };
  359. static const struct iio_info max44000_info = {
  360. .read_raw = max44000_read_raw,
  361. .write_raw = max44000_write_raw,
  362. .write_raw_get_fmt = max44000_write_raw_get_fmt,
  363. .attrs = &max44000_attribute_group,
  364. };
  365. static bool max44000_readable_reg(struct device *dev, unsigned int reg)
  366. {
  367. switch (reg) {
  368. case MAX44000_REG_STATUS:
  369. case MAX44000_REG_CFG_MAIN:
  370. case MAX44000_REG_CFG_RX:
  371. case MAX44000_REG_CFG_TX:
  372. case MAX44000_REG_ALS_DATA_HI:
  373. case MAX44000_REG_ALS_DATA_LO:
  374. case MAX44000_REG_PRX_DATA:
  375. case MAX44000_REG_ALS_UPTHR_HI:
  376. case MAX44000_REG_ALS_UPTHR_LO:
  377. case MAX44000_REG_ALS_LOTHR_HI:
  378. case MAX44000_REG_ALS_LOTHR_LO:
  379. case MAX44000_REG_PST:
  380. case MAX44000_REG_PRX_IND:
  381. case MAX44000_REG_PRX_THR:
  382. case MAX44000_REG_TRIM_GAIN_GREEN:
  383. case MAX44000_REG_TRIM_GAIN_IR:
  384. return true;
  385. default:
  386. return false;
  387. }
  388. }
  389. static bool max44000_writeable_reg(struct device *dev, unsigned int reg)
  390. {
  391. switch (reg) {
  392. case MAX44000_REG_CFG_MAIN:
  393. case MAX44000_REG_CFG_RX:
  394. case MAX44000_REG_CFG_TX:
  395. case MAX44000_REG_ALS_UPTHR_HI:
  396. case MAX44000_REG_ALS_UPTHR_LO:
  397. case MAX44000_REG_ALS_LOTHR_HI:
  398. case MAX44000_REG_ALS_LOTHR_LO:
  399. case MAX44000_REG_PST:
  400. case MAX44000_REG_PRX_IND:
  401. case MAX44000_REG_PRX_THR:
  402. case MAX44000_REG_TRIM_GAIN_GREEN:
  403. case MAX44000_REG_TRIM_GAIN_IR:
  404. return true;
  405. default:
  406. return false;
  407. }
  408. }
  409. static bool max44000_volatile_reg(struct device *dev, unsigned int reg)
  410. {
  411. switch (reg) {
  412. case MAX44000_REG_STATUS:
  413. case MAX44000_REG_ALS_DATA_HI:
  414. case MAX44000_REG_ALS_DATA_LO:
  415. case MAX44000_REG_PRX_DATA:
  416. return true;
  417. default:
  418. return false;
  419. }
  420. }
  421. static bool max44000_precious_reg(struct device *dev, unsigned int reg)
  422. {
  423. return reg == MAX44000_REG_STATUS;
  424. }
  425. static const struct regmap_config max44000_regmap_config = {
  426. .reg_bits = 8,
  427. .val_bits = 8,
  428. .max_register = MAX44000_REG_PRX_DATA,
  429. .readable_reg = max44000_readable_reg,
  430. .writeable_reg = max44000_writeable_reg,
  431. .volatile_reg = max44000_volatile_reg,
  432. .precious_reg = max44000_precious_reg,
  433. .use_single_rw = 1,
  434. .cache_type = REGCACHE_RBTREE,
  435. };
  436. static irqreturn_t max44000_trigger_handler(int irq, void *p)
  437. {
  438. struct iio_poll_func *pf = p;
  439. struct iio_dev *indio_dev = pf->indio_dev;
  440. struct max44000_data *data = iio_priv(indio_dev);
  441. int index = 0;
  442. unsigned int regval;
  443. int ret;
  444. mutex_lock(&data->lock);
  445. if (test_bit(MAX44000_SCAN_INDEX_ALS, indio_dev->active_scan_mask)) {
  446. ret = max44000_read_alsval(data);
  447. if (ret < 0)
  448. goto out_unlock;
  449. data->scan.channels[index++] = ret;
  450. }
  451. if (test_bit(MAX44000_SCAN_INDEX_PRX, indio_dev->active_scan_mask)) {
  452. ret = regmap_read(data->regmap, MAX44000_REG_PRX_DATA, &regval);
  453. if (ret < 0)
  454. goto out_unlock;
  455. data->scan.channels[index] = regval;
  456. }
  457. mutex_unlock(&data->lock);
  458. iio_push_to_buffers_with_timestamp(indio_dev, &data->scan,
  459. iio_get_time_ns(indio_dev));
  460. iio_trigger_notify_done(indio_dev->trig);
  461. return IRQ_HANDLED;
  462. out_unlock:
  463. mutex_unlock(&data->lock);
  464. iio_trigger_notify_done(indio_dev->trig);
  465. return IRQ_HANDLED;
  466. }
  467. static int max44000_probe(struct i2c_client *client,
  468. const struct i2c_device_id *id)
  469. {
  470. struct max44000_data *data;
  471. struct iio_dev *indio_dev;
  472. int ret, reg;
  473. indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
  474. if (!indio_dev)
  475. return -ENOMEM;
  476. data = iio_priv(indio_dev);
  477. data->regmap = devm_regmap_init_i2c(client, &max44000_regmap_config);
  478. if (IS_ERR(data->regmap)) {
  479. dev_err(&client->dev, "regmap_init failed!\n");
  480. return PTR_ERR(data->regmap);
  481. }
  482. i2c_set_clientdata(client, indio_dev);
  483. mutex_init(&data->lock);
  484. indio_dev->dev.parent = &client->dev;
  485. indio_dev->info = &max44000_info;
  486. indio_dev->name = MAX44000_DRV_NAME;
  487. indio_dev->channels = max44000_channels;
  488. indio_dev->num_channels = ARRAY_SIZE(max44000_channels);
  489. /*
  490. * The device doesn't have a reset function so we just clear some
  491. * important bits at probe time to ensure sane operation.
  492. *
  493. * Since we don't support interrupts/events the threshold values are
  494. * not important. We also don't touch trim values.
  495. */
  496. /* Reset ALS scaling bits */
  497. ret = regmap_write(data->regmap, MAX44000_REG_CFG_RX,
  498. MAX44000_REG_CFG_RX_DEFAULT);
  499. if (ret < 0) {
  500. dev_err(&client->dev, "failed to write default CFG_RX: %d\n",
  501. ret);
  502. return ret;
  503. }
  504. /*
  505. * By default the LED pulse used for the proximity sensor is disabled.
  506. * Set a middle value so that we get some sort of valid data by default.
  507. */
  508. ret = max44000_write_led_current_raw(data, MAX44000_LED_CURRENT_DEFAULT);
  509. if (ret < 0) {
  510. dev_err(&client->dev, "failed to write init config: %d\n", ret);
  511. return ret;
  512. }
  513. /* Reset CFG bits to ALS_PRX mode which allows easy reading of both values. */
  514. reg = MAX44000_CFG_TRIM | MAX44000_CFG_MODE_ALS_PRX;
  515. ret = regmap_write(data->regmap, MAX44000_REG_CFG_MAIN, reg);
  516. if (ret < 0) {
  517. dev_err(&client->dev, "failed to write init config: %d\n", ret);
  518. return ret;
  519. }
  520. /* Read status at least once to clear any stale interrupt bits. */
  521. ret = regmap_read(data->regmap, MAX44000_REG_STATUS, &reg);
  522. if (ret < 0) {
  523. dev_err(&client->dev, "failed to read init status: %d\n", ret);
  524. return ret;
  525. }
  526. ret = iio_triggered_buffer_setup(indio_dev, NULL, max44000_trigger_handler, NULL);
  527. if (ret < 0) {
  528. dev_err(&client->dev, "iio triggered buffer setup failed\n");
  529. return ret;
  530. }
  531. return iio_device_register(indio_dev);
  532. }
  533. static int max44000_remove(struct i2c_client *client)
  534. {
  535. struct iio_dev *indio_dev = i2c_get_clientdata(client);
  536. iio_device_unregister(indio_dev);
  537. iio_triggered_buffer_cleanup(indio_dev);
  538. return 0;
  539. }
  540. static const struct i2c_device_id max44000_id[] = {
  541. {"max44000", 0},
  542. { }
  543. };
  544. MODULE_DEVICE_TABLE(i2c, max44000_id);
  545. #ifdef CONFIG_ACPI
  546. static const struct acpi_device_id max44000_acpi_match[] = {
  547. {"MAX44000", 0},
  548. { }
  549. };
  550. MODULE_DEVICE_TABLE(acpi, max44000_acpi_match);
  551. #endif
  552. static struct i2c_driver max44000_driver = {
  553. .driver = {
  554. .name = MAX44000_DRV_NAME,
  555. .acpi_match_table = ACPI_PTR(max44000_acpi_match),
  556. },
  557. .probe = max44000_probe,
  558. .remove = max44000_remove,
  559. .id_table = max44000_id,
  560. };
  561. module_i2c_driver(max44000_driver);
  562. MODULE_AUTHOR("Crestez Dan Leonard <leonard.crestez@intel.com>");
  563. MODULE_DESCRIPTION("MAX44000 Ambient and Infrared Proximity Sensor");
  564. MODULE_LICENSE("GPL v2");