us5182d.c 23 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * Copyright (c) 2015 Intel Corporation
  4. *
  5. * Driver for UPISEMI us5182d Proximity and Ambient Light Sensor.
  6. *
  7. * To do: Interrupt support.
  8. */
  9. #include <linux/kernel.h>
  10. #include <linux/module.h>
  11. #include <linux/acpi.h>
  12. #include <linux/delay.h>
  13. #include <linux/i2c.h>
  14. #include <linux/iio/events.h>
  15. #include <linux/iio/iio.h>
  16. #include <linux/interrupt.h>
  17. #include <linux/irq.h>
  18. #include <linux/iio/sysfs.h>
  19. #include <linux/mutex.h>
  20. #include <linux/pm.h>
  21. #include <linux/pm_runtime.h>
  22. #define US5182D_REG_CFG0 0x00
  23. #define US5182D_CFG0_ONESHOT_EN BIT(6)
  24. #define US5182D_CFG0_SHUTDOWN_EN BIT(7)
  25. #define US5182D_CFG0_WORD_ENABLE BIT(0)
  26. #define US5182D_CFG0_PROX BIT(3)
  27. #define US5182D_CFG0_PX_IRQ BIT(2)
  28. #define US5182D_REG_CFG1 0x01
  29. #define US5182D_CFG1_ALS_RES16 BIT(4)
  30. #define US5182D_CFG1_AGAIN_DEFAULT 0x00
  31. #define US5182D_REG_CFG2 0x02
  32. #define US5182D_CFG2_PX_RES16 BIT(4)
  33. #define US5182D_CFG2_PXGAIN_DEFAULT BIT(2)
  34. #define US5182D_REG_CFG3 0x03
  35. #define US5182D_CFG3_LED_CURRENT100 (BIT(4) | BIT(5))
  36. #define US5182D_CFG3_INT_SOURCE_PX BIT(3)
  37. #define US5182D_REG_CFG4 0x10
  38. /*
  39. * Registers for tuning the auto dark current cancelling feature.
  40. * DARK_TH(reg 0x27,0x28) - threshold (counts) for auto dark cancelling.
  41. * when ALS > DARK_TH --> ALS_Code = ALS - Upper(0x2A) * Dark
  42. * when ALS < DARK_TH --> ALS_Code = ALS - Lower(0x29) * Dark
  43. */
  44. #define US5182D_REG_UDARK_TH 0x27
  45. #define US5182D_REG_DARK_AUTO_EN 0x2b
  46. #define US5182D_REG_AUTO_LDARK_GAIN 0x29
  47. #define US5182D_REG_AUTO_HDARK_GAIN 0x2a
  48. /* Thresholds for events: px low (0x08-l, 0x09-h), px high (0x0a-l 0x0b-h) */
  49. #define US5182D_REG_PXL_TH 0x08
  50. #define US5182D_REG_PXH_TH 0x0a
  51. #define US5182D_REG_PXL_TH_DEFAULT 1000
  52. #define US5182D_REG_PXH_TH_DEFAULT 30000
  53. #define US5182D_OPMODE_ALS 0x01
  54. #define US5182D_OPMODE_PX 0x02
  55. #define US5182D_OPMODE_SHIFT 4
  56. #define US5182D_REG_DARK_AUTO_EN_DEFAULT 0x80
  57. #define US5182D_REG_AUTO_LDARK_GAIN_DEFAULT 0x16
  58. #define US5182D_REG_AUTO_HDARK_GAIN_DEFAULT 0x00
  59. #define US5182D_REG_ADL 0x0c
  60. #define US5182D_REG_PDL 0x0e
  61. #define US5182D_REG_MODE_STORE 0x21
  62. #define US5182D_STORE_MODE 0x01
  63. #define US5182D_REG_CHIPID 0xb2
  64. #define US5182D_OPMODE_MASK GENMASK(5, 4)
  65. #define US5182D_AGAIN_MASK 0x07
  66. #define US5182D_RESET_CHIP 0x01
  67. #define US5182D_CHIPID 0x26
  68. #define US5182D_DRV_NAME "us5182d"
  69. #define US5182D_GA_RESOLUTION 1000
  70. #define US5182D_READ_BYTE 1
  71. #define US5182D_READ_WORD 2
  72. #define US5182D_OPSTORE_SLEEP_TIME 20 /* ms */
  73. #define US5182D_SLEEP_MS 3000 /* ms */
  74. #define US5182D_PXH_TH_DISABLE 0xffff
  75. #define US5182D_PXL_TH_DISABLE 0x0000
  76. /* Available ranges: [12354, 7065, 3998, 2202, 1285, 498, 256, 138] lux */
  77. static const int us5182d_scales[] = {188500, 107800, 61000, 33600, 19600, 7600,
  78. 3900, 2100};
  79. /*
  80. * Experimental thresholds that work with US5182D sensor on evaluation board
  81. * roughly between 12-32 lux
  82. */
  83. static u16 us5182d_dark_ths_vals[] = {170, 200, 512, 512, 800, 2000, 4000,
  84. 8000};
  85. enum mode {
  86. US5182D_ALS_PX,
  87. US5182D_ALS_ONLY,
  88. US5182D_PX_ONLY
  89. };
  90. enum pmode {
  91. US5182D_CONTINUOUS,
  92. US5182D_ONESHOT
  93. };
  94. struct us5182d_data {
  95. struct i2c_client *client;
  96. struct mutex lock;
  97. /* Glass attenuation factor */
  98. u32 ga;
  99. /* Dark gain tuning */
  100. u8 lower_dark_gain;
  101. u8 upper_dark_gain;
  102. u16 *us5182d_dark_ths;
  103. u16 px_low_th;
  104. u16 px_high_th;
  105. int rising_en;
  106. int falling_en;
  107. u8 opmode;
  108. u8 power_mode;
  109. bool als_enabled;
  110. bool px_enabled;
  111. bool default_continuous;
  112. };
  113. static IIO_CONST_ATTR(in_illuminance_scale_available,
  114. "0.0021 0.0039 0.0076 0.0196 0.0336 0.061 0.1078 0.1885");
  115. static struct attribute *us5182d_attrs[] = {
  116. &iio_const_attr_in_illuminance_scale_available.dev_attr.attr,
  117. NULL
  118. };
  119. static const struct attribute_group us5182d_attr_group = {
  120. .attrs = us5182d_attrs,
  121. };
  122. static const struct {
  123. u8 reg;
  124. u8 val;
  125. } us5182d_regvals[] = {
  126. {US5182D_REG_CFG0, US5182D_CFG0_WORD_ENABLE},
  127. {US5182D_REG_CFG1, US5182D_CFG1_ALS_RES16},
  128. {US5182D_REG_CFG2, (US5182D_CFG2_PX_RES16 |
  129. US5182D_CFG2_PXGAIN_DEFAULT)},
  130. {US5182D_REG_CFG3, US5182D_CFG3_LED_CURRENT100 |
  131. US5182D_CFG3_INT_SOURCE_PX},
  132. {US5182D_REG_CFG4, 0x00},
  133. };
  134. static const struct iio_event_spec us5182d_events[] = {
  135. {
  136. .type = IIO_EV_TYPE_THRESH,
  137. .dir = IIO_EV_DIR_RISING,
  138. .mask_separate = BIT(IIO_EV_INFO_VALUE) |
  139. BIT(IIO_EV_INFO_ENABLE),
  140. },
  141. {
  142. .type = IIO_EV_TYPE_THRESH,
  143. .dir = IIO_EV_DIR_FALLING,
  144. .mask_separate = BIT(IIO_EV_INFO_VALUE) |
  145. BIT(IIO_EV_INFO_ENABLE),
  146. },
  147. };
  148. static const struct iio_chan_spec us5182d_channels[] = {
  149. {
  150. .type = IIO_LIGHT,
  151. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW) |
  152. BIT(IIO_CHAN_INFO_SCALE),
  153. },
  154. {
  155. .type = IIO_PROXIMITY,
  156. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW),
  157. .event_spec = us5182d_events,
  158. .num_event_specs = ARRAY_SIZE(us5182d_events),
  159. }
  160. };
  161. static int us5182d_oneshot_en(struct us5182d_data *data)
  162. {
  163. int ret;
  164. ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0);
  165. if (ret < 0)
  166. return ret;
  167. /*
  168. * In oneshot mode the chip will power itself down after taking the
  169. * required measurement.
  170. */
  171. ret = ret | US5182D_CFG0_ONESHOT_EN;
  172. return i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0, ret);
  173. }
  174. static int us5182d_set_opmode(struct us5182d_data *data, u8 mode)
  175. {
  176. int ret;
  177. if (mode == data->opmode)
  178. return 0;
  179. ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0);
  180. if (ret < 0)
  181. return ret;
  182. /* update mode */
  183. ret = ret & ~US5182D_OPMODE_MASK;
  184. ret = ret | (mode << US5182D_OPMODE_SHIFT);
  185. /*
  186. * After updating the operating mode, the chip requires that
  187. * the operation is stored, by writing 1 in the STORE_MODE
  188. * register (auto-clearing).
  189. */
  190. ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0, ret);
  191. if (ret < 0)
  192. return ret;
  193. ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_MODE_STORE,
  194. US5182D_STORE_MODE);
  195. if (ret < 0)
  196. return ret;
  197. data->opmode = mode;
  198. msleep(US5182D_OPSTORE_SLEEP_TIME);
  199. return 0;
  200. }
  201. static int us5182d_als_enable(struct us5182d_data *data)
  202. {
  203. int ret;
  204. u8 mode;
  205. if (data->power_mode == US5182D_ONESHOT) {
  206. ret = us5182d_set_opmode(data, US5182D_ALS_ONLY);
  207. if (ret < 0)
  208. return ret;
  209. data->px_enabled = false;
  210. }
  211. if (data->als_enabled)
  212. return 0;
  213. mode = data->px_enabled ? US5182D_ALS_PX : US5182D_ALS_ONLY;
  214. ret = us5182d_set_opmode(data, mode);
  215. if (ret < 0)
  216. return ret;
  217. data->als_enabled = true;
  218. return 0;
  219. }
  220. static int us5182d_px_enable(struct us5182d_data *data)
  221. {
  222. int ret;
  223. u8 mode;
  224. if (data->power_mode == US5182D_ONESHOT) {
  225. ret = us5182d_set_opmode(data, US5182D_PX_ONLY);
  226. if (ret < 0)
  227. return ret;
  228. data->als_enabled = false;
  229. }
  230. if (data->px_enabled)
  231. return 0;
  232. mode = data->als_enabled ? US5182D_ALS_PX : US5182D_PX_ONLY;
  233. ret = us5182d_set_opmode(data, mode);
  234. if (ret < 0)
  235. return ret;
  236. data->px_enabled = true;
  237. return 0;
  238. }
  239. static int us5182d_get_als(struct us5182d_data *data)
  240. {
  241. int ret;
  242. unsigned long result;
  243. ret = us5182d_als_enable(data);
  244. if (ret < 0)
  245. return ret;
  246. ret = i2c_smbus_read_word_data(data->client,
  247. US5182D_REG_ADL);
  248. if (ret < 0)
  249. return ret;
  250. result = ret * data->ga / US5182D_GA_RESOLUTION;
  251. if (result > 0xffff)
  252. result = 0xffff;
  253. return result;
  254. }
  255. static int us5182d_get_px(struct us5182d_data *data)
  256. {
  257. int ret;
  258. ret = us5182d_px_enable(data);
  259. if (ret < 0)
  260. return ret;
  261. return i2c_smbus_read_word_data(data->client,
  262. US5182D_REG_PDL);
  263. }
  264. static int us5182d_shutdown_en(struct us5182d_data *data, u8 state)
  265. {
  266. int ret;
  267. if (data->power_mode == US5182D_ONESHOT)
  268. return 0;
  269. ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0);
  270. if (ret < 0)
  271. return ret;
  272. ret = ret & ~US5182D_CFG0_SHUTDOWN_EN;
  273. ret = ret | state;
  274. ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0, ret);
  275. if (ret < 0)
  276. return ret;
  277. if (state & US5182D_CFG0_SHUTDOWN_EN) {
  278. data->als_enabled = false;
  279. data->px_enabled = false;
  280. }
  281. return ret;
  282. }
  283. static int us5182d_set_power_state(struct us5182d_data *data, bool on)
  284. {
  285. int ret;
  286. if (data->power_mode == US5182D_ONESHOT)
  287. return 0;
  288. if (on) {
  289. ret = pm_runtime_resume_and_get(&data->client->dev);
  290. } else {
  291. pm_runtime_mark_last_busy(&data->client->dev);
  292. ret = pm_runtime_put_autosuspend(&data->client->dev);
  293. }
  294. return ret;
  295. }
  296. static int us5182d_read_value(struct us5182d_data *data,
  297. struct iio_chan_spec const *chan)
  298. {
  299. int ret, value;
  300. mutex_lock(&data->lock);
  301. if (data->power_mode == US5182D_ONESHOT) {
  302. ret = us5182d_oneshot_en(data);
  303. if (ret < 0)
  304. goto out_err;
  305. }
  306. ret = us5182d_set_power_state(data, true);
  307. if (ret < 0)
  308. goto out_err;
  309. if (chan->type == IIO_LIGHT)
  310. ret = us5182d_get_als(data);
  311. else
  312. ret = us5182d_get_px(data);
  313. if (ret < 0)
  314. goto out_poweroff;
  315. value = ret;
  316. ret = us5182d_set_power_state(data, false);
  317. if (ret < 0)
  318. goto out_err;
  319. mutex_unlock(&data->lock);
  320. return value;
  321. out_poweroff:
  322. us5182d_set_power_state(data, false);
  323. out_err:
  324. mutex_unlock(&data->lock);
  325. return ret;
  326. }
  327. static int us5182d_read_raw(struct iio_dev *indio_dev,
  328. struct iio_chan_spec const *chan, int *val,
  329. int *val2, long mask)
  330. {
  331. struct us5182d_data *data = iio_priv(indio_dev);
  332. int ret;
  333. switch (mask) {
  334. case IIO_CHAN_INFO_RAW:
  335. ret = us5182d_read_value(data, chan);
  336. if (ret < 0)
  337. return ret;
  338. *val = ret;
  339. return IIO_VAL_INT;
  340. case IIO_CHAN_INFO_SCALE:
  341. ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG1);
  342. if (ret < 0)
  343. return ret;
  344. *val = 0;
  345. *val2 = us5182d_scales[ret & US5182D_AGAIN_MASK];
  346. return IIO_VAL_INT_PLUS_MICRO;
  347. default:
  348. return -EINVAL;
  349. }
  350. }
  351. /**
  352. * us5182d_update_dark_th - update Darh_Th registers
  353. * @data: us5182d_data structure
  354. * @index: index in us5182d_dark_ths array to use for the updated value
  355. *
  356. * Function needs to be called with a lock held because it needs two i2c write
  357. * byte operations as these registers (0x27 0x28) don't work in word mode
  358. * accessing.
  359. */
  360. static int us5182d_update_dark_th(struct us5182d_data *data, int index)
  361. {
  362. __be16 dark_th = cpu_to_be16(data->us5182d_dark_ths[index]);
  363. int ret;
  364. ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_UDARK_TH,
  365. ((u8 *)&dark_th)[0]);
  366. if (ret < 0)
  367. return ret;
  368. return i2c_smbus_write_byte_data(data->client, US5182D_REG_UDARK_TH + 1,
  369. ((u8 *)&dark_th)[1]);
  370. }
  371. /**
  372. * us5182d_apply_scale - update the ALS scale
  373. * @data: us5182d_data structure
  374. * @index: index in us5182d_scales array to use for the updated value
  375. *
  376. * Function needs to be called with a lock held as we're having more than one
  377. * i2c operation.
  378. */
  379. static int us5182d_apply_scale(struct us5182d_data *data, int index)
  380. {
  381. int ret;
  382. ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG1);
  383. if (ret < 0)
  384. return ret;
  385. ret = ret & (~US5182D_AGAIN_MASK);
  386. ret |= index;
  387. ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG1, ret);
  388. if (ret < 0)
  389. return ret;
  390. return us5182d_update_dark_th(data, index);
  391. }
  392. static int us5182d_write_raw(struct iio_dev *indio_dev,
  393. struct iio_chan_spec const *chan, int val,
  394. int val2, long mask)
  395. {
  396. struct us5182d_data *data = iio_priv(indio_dev);
  397. int ret, i;
  398. switch (mask) {
  399. case IIO_CHAN_INFO_SCALE:
  400. if (val != 0)
  401. return -EINVAL;
  402. for (i = 0; i < ARRAY_SIZE(us5182d_scales); i++)
  403. if (val2 == us5182d_scales[i]) {
  404. mutex_lock(&data->lock);
  405. ret = us5182d_apply_scale(data, i);
  406. mutex_unlock(&data->lock);
  407. return ret;
  408. }
  409. break;
  410. default:
  411. return -EINVAL;
  412. }
  413. return -EINVAL;
  414. }
  415. static int us5182d_setup_prox(struct iio_dev *indio_dev,
  416. enum iio_event_direction dir, u16 val)
  417. {
  418. struct us5182d_data *data = iio_priv(indio_dev);
  419. if (dir == IIO_EV_DIR_FALLING)
  420. return i2c_smbus_write_word_data(data->client,
  421. US5182D_REG_PXL_TH, val);
  422. else if (dir == IIO_EV_DIR_RISING)
  423. return i2c_smbus_write_word_data(data->client,
  424. US5182D_REG_PXH_TH, val);
  425. return 0;
  426. }
  427. static int us5182d_read_thresh(struct iio_dev *indio_dev,
  428. const struct iio_chan_spec *chan, enum iio_event_type type,
  429. enum iio_event_direction dir, enum iio_event_info info, int *val,
  430. int *val2)
  431. {
  432. struct us5182d_data *data = iio_priv(indio_dev);
  433. switch (dir) {
  434. case IIO_EV_DIR_RISING:
  435. mutex_lock(&data->lock);
  436. *val = data->px_high_th;
  437. mutex_unlock(&data->lock);
  438. break;
  439. case IIO_EV_DIR_FALLING:
  440. mutex_lock(&data->lock);
  441. *val = data->px_low_th;
  442. mutex_unlock(&data->lock);
  443. break;
  444. default:
  445. return -EINVAL;
  446. }
  447. return IIO_VAL_INT;
  448. }
  449. static int us5182d_write_thresh(struct iio_dev *indio_dev,
  450. const struct iio_chan_spec *chan, enum iio_event_type type,
  451. enum iio_event_direction dir, enum iio_event_info info, int val,
  452. int val2)
  453. {
  454. struct us5182d_data *data = iio_priv(indio_dev);
  455. int ret;
  456. if (val < 0 || val > USHRT_MAX || val2 != 0)
  457. return -EINVAL;
  458. switch (dir) {
  459. case IIO_EV_DIR_RISING:
  460. mutex_lock(&data->lock);
  461. if (data->rising_en) {
  462. ret = us5182d_setup_prox(indio_dev, dir, val);
  463. if (ret < 0)
  464. goto err;
  465. }
  466. data->px_high_th = val;
  467. mutex_unlock(&data->lock);
  468. break;
  469. case IIO_EV_DIR_FALLING:
  470. mutex_lock(&data->lock);
  471. if (data->falling_en) {
  472. ret = us5182d_setup_prox(indio_dev, dir, val);
  473. if (ret < 0)
  474. goto err;
  475. }
  476. data->px_low_th = val;
  477. mutex_unlock(&data->lock);
  478. break;
  479. default:
  480. return -EINVAL;
  481. }
  482. return 0;
  483. err:
  484. mutex_unlock(&data->lock);
  485. return ret;
  486. }
  487. static int us5182d_read_event_config(struct iio_dev *indio_dev,
  488. const struct iio_chan_spec *chan, enum iio_event_type type,
  489. enum iio_event_direction dir)
  490. {
  491. struct us5182d_data *data = iio_priv(indio_dev);
  492. int ret;
  493. switch (dir) {
  494. case IIO_EV_DIR_RISING:
  495. mutex_lock(&data->lock);
  496. ret = data->rising_en;
  497. mutex_unlock(&data->lock);
  498. break;
  499. case IIO_EV_DIR_FALLING:
  500. mutex_lock(&data->lock);
  501. ret = data->falling_en;
  502. mutex_unlock(&data->lock);
  503. break;
  504. default:
  505. ret = -EINVAL;
  506. break;
  507. }
  508. return ret;
  509. }
  510. static int us5182d_write_event_config(struct iio_dev *indio_dev,
  511. const struct iio_chan_spec *chan, enum iio_event_type type,
  512. enum iio_event_direction dir, int state)
  513. {
  514. struct us5182d_data *data = iio_priv(indio_dev);
  515. int ret;
  516. u16 new_th;
  517. mutex_lock(&data->lock);
  518. switch (dir) {
  519. case IIO_EV_DIR_RISING:
  520. if (data->rising_en == state) {
  521. mutex_unlock(&data->lock);
  522. return 0;
  523. }
  524. new_th = US5182D_PXH_TH_DISABLE;
  525. if (state) {
  526. data->power_mode = US5182D_CONTINUOUS;
  527. ret = us5182d_set_power_state(data, true);
  528. if (ret < 0)
  529. goto err;
  530. ret = us5182d_px_enable(data);
  531. if (ret < 0)
  532. goto err_poweroff;
  533. new_th = data->px_high_th;
  534. }
  535. ret = us5182d_setup_prox(indio_dev, dir, new_th);
  536. if (ret < 0)
  537. goto err_poweroff;
  538. data->rising_en = state;
  539. break;
  540. case IIO_EV_DIR_FALLING:
  541. if (data->falling_en == state) {
  542. mutex_unlock(&data->lock);
  543. return 0;
  544. }
  545. new_th = US5182D_PXL_TH_DISABLE;
  546. if (state) {
  547. data->power_mode = US5182D_CONTINUOUS;
  548. ret = us5182d_set_power_state(data, true);
  549. if (ret < 0)
  550. goto err;
  551. ret = us5182d_px_enable(data);
  552. if (ret < 0)
  553. goto err_poweroff;
  554. new_th = data->px_low_th;
  555. }
  556. ret = us5182d_setup_prox(indio_dev, dir, new_th);
  557. if (ret < 0)
  558. goto err_poweroff;
  559. data->falling_en = state;
  560. break;
  561. default:
  562. ret = -EINVAL;
  563. goto err;
  564. }
  565. if (!state) {
  566. ret = us5182d_set_power_state(data, false);
  567. if (ret < 0)
  568. goto err;
  569. }
  570. if (!data->falling_en && !data->rising_en && !data->default_continuous)
  571. data->power_mode = US5182D_ONESHOT;
  572. mutex_unlock(&data->lock);
  573. return 0;
  574. err_poweroff:
  575. if (state)
  576. us5182d_set_power_state(data, false);
  577. err:
  578. mutex_unlock(&data->lock);
  579. return ret;
  580. }
  581. static const struct iio_info us5182d_info = {
  582. .read_raw = us5182d_read_raw,
  583. .write_raw = us5182d_write_raw,
  584. .attrs = &us5182d_attr_group,
  585. .read_event_value = &us5182d_read_thresh,
  586. .write_event_value = &us5182d_write_thresh,
  587. .read_event_config = &us5182d_read_event_config,
  588. .write_event_config = &us5182d_write_event_config,
  589. };
  590. static int us5182d_reset(struct iio_dev *indio_dev)
  591. {
  592. struct us5182d_data *data = iio_priv(indio_dev);
  593. return i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG3,
  594. US5182D_RESET_CHIP);
  595. }
  596. static int us5182d_init(struct iio_dev *indio_dev)
  597. {
  598. struct us5182d_data *data = iio_priv(indio_dev);
  599. int i, ret;
  600. ret = us5182d_reset(indio_dev);
  601. if (ret < 0)
  602. return ret;
  603. data->opmode = 0;
  604. data->power_mode = US5182D_CONTINUOUS;
  605. data->px_low_th = US5182D_REG_PXL_TH_DEFAULT;
  606. data->px_high_th = US5182D_REG_PXH_TH_DEFAULT;
  607. for (i = 0; i < ARRAY_SIZE(us5182d_regvals); i++) {
  608. ret = i2c_smbus_write_byte_data(data->client,
  609. us5182d_regvals[i].reg,
  610. us5182d_regvals[i].val);
  611. if (ret < 0)
  612. return ret;
  613. }
  614. data->als_enabled = true;
  615. data->px_enabled = true;
  616. if (!data->default_continuous) {
  617. ret = us5182d_shutdown_en(data, US5182D_CFG0_SHUTDOWN_EN);
  618. if (ret < 0)
  619. return ret;
  620. data->power_mode = US5182D_ONESHOT;
  621. }
  622. return ret;
  623. }
  624. static void us5182d_get_platform_data(struct iio_dev *indio_dev)
  625. {
  626. struct us5182d_data *data = iio_priv(indio_dev);
  627. if (device_property_read_u32(&data->client->dev, "upisemi,glass-coef",
  628. &data->ga))
  629. data->ga = US5182D_GA_RESOLUTION;
  630. if (device_property_read_u16_array(&data->client->dev,
  631. "upisemi,dark-ths",
  632. data->us5182d_dark_ths,
  633. ARRAY_SIZE(us5182d_dark_ths_vals)))
  634. data->us5182d_dark_ths = us5182d_dark_ths_vals;
  635. if (device_property_read_u8(&data->client->dev,
  636. "upisemi,upper-dark-gain",
  637. &data->upper_dark_gain))
  638. data->upper_dark_gain = US5182D_REG_AUTO_HDARK_GAIN_DEFAULT;
  639. if (device_property_read_u8(&data->client->dev,
  640. "upisemi,lower-dark-gain",
  641. &data->lower_dark_gain))
  642. data->lower_dark_gain = US5182D_REG_AUTO_LDARK_GAIN_DEFAULT;
  643. data->default_continuous = device_property_read_bool(&data->client->dev,
  644. "upisemi,continuous");
  645. }
  646. static int us5182d_dark_gain_config(struct iio_dev *indio_dev)
  647. {
  648. struct us5182d_data *data = iio_priv(indio_dev);
  649. int ret;
  650. ret = us5182d_update_dark_th(data, US5182D_CFG1_AGAIN_DEFAULT);
  651. if (ret < 0)
  652. return ret;
  653. ret = i2c_smbus_write_byte_data(data->client,
  654. US5182D_REG_AUTO_LDARK_GAIN,
  655. data->lower_dark_gain);
  656. if (ret < 0)
  657. return ret;
  658. ret = i2c_smbus_write_byte_data(data->client,
  659. US5182D_REG_AUTO_HDARK_GAIN,
  660. data->upper_dark_gain);
  661. if (ret < 0)
  662. return ret;
  663. return i2c_smbus_write_byte_data(data->client, US5182D_REG_DARK_AUTO_EN,
  664. US5182D_REG_DARK_AUTO_EN_DEFAULT);
  665. }
  666. static irqreturn_t us5182d_irq_thread_handler(int irq, void *private)
  667. {
  668. struct iio_dev *indio_dev = private;
  669. struct us5182d_data *data = iio_priv(indio_dev);
  670. enum iio_event_direction dir;
  671. int ret;
  672. u64 ev;
  673. ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CFG0);
  674. if (ret < 0) {
  675. dev_err(&data->client->dev, "i2c transfer error in irq\n");
  676. return IRQ_HANDLED;
  677. }
  678. dir = ret & US5182D_CFG0_PROX ? IIO_EV_DIR_RISING : IIO_EV_DIR_FALLING;
  679. ev = IIO_UNMOD_EVENT_CODE(IIO_PROXIMITY, 1, IIO_EV_TYPE_THRESH, dir);
  680. iio_push_event(indio_dev, ev, iio_get_time_ns(indio_dev));
  681. ret = i2c_smbus_write_byte_data(data->client, US5182D_REG_CFG0,
  682. ret & ~US5182D_CFG0_PX_IRQ);
  683. if (ret < 0)
  684. dev_err(&data->client->dev, "i2c transfer error in irq\n");
  685. return IRQ_HANDLED;
  686. }
  687. static int us5182d_probe(struct i2c_client *client,
  688. const struct i2c_device_id *id)
  689. {
  690. struct us5182d_data *data;
  691. struct iio_dev *indio_dev;
  692. int ret;
  693. indio_dev = devm_iio_device_alloc(&client->dev, sizeof(*data));
  694. if (!indio_dev)
  695. return -ENOMEM;
  696. data = iio_priv(indio_dev);
  697. i2c_set_clientdata(client, indio_dev);
  698. data->client = client;
  699. mutex_init(&data->lock);
  700. indio_dev->info = &us5182d_info;
  701. indio_dev->name = US5182D_DRV_NAME;
  702. indio_dev->channels = us5182d_channels;
  703. indio_dev->num_channels = ARRAY_SIZE(us5182d_channels);
  704. indio_dev->modes = INDIO_DIRECT_MODE;
  705. ret = i2c_smbus_read_byte_data(data->client, US5182D_REG_CHIPID);
  706. if (ret != US5182D_CHIPID) {
  707. dev_err(&data->client->dev,
  708. "Failed to detect US5182 light chip\n");
  709. return (ret < 0) ? ret : -ENODEV;
  710. }
  711. if (client->irq > 0) {
  712. ret = devm_request_threaded_irq(&client->dev, client->irq, NULL,
  713. us5182d_irq_thread_handler,
  714. IRQF_TRIGGER_LOW | IRQF_ONESHOT,
  715. "us5182d-irq", indio_dev);
  716. if (ret < 0)
  717. return ret;
  718. } else
  719. dev_warn(&client->dev, "no valid irq found\n");
  720. us5182d_get_platform_data(indio_dev);
  721. ret = us5182d_init(indio_dev);
  722. if (ret < 0)
  723. return ret;
  724. ret = us5182d_dark_gain_config(indio_dev);
  725. if (ret < 0)
  726. goto out_err;
  727. if (data->default_continuous) {
  728. ret = pm_runtime_set_active(&client->dev);
  729. if (ret < 0)
  730. goto out_err;
  731. }
  732. pm_runtime_enable(&client->dev);
  733. pm_runtime_set_autosuspend_delay(&client->dev,
  734. US5182D_SLEEP_MS);
  735. pm_runtime_use_autosuspend(&client->dev);
  736. ret = iio_device_register(indio_dev);
  737. if (ret < 0)
  738. goto out_err;
  739. return 0;
  740. out_err:
  741. us5182d_shutdown_en(data, US5182D_CFG0_SHUTDOWN_EN);
  742. return ret;
  743. }
  744. static void us5182d_remove(struct i2c_client *client)
  745. {
  746. struct us5182d_data *data = iio_priv(i2c_get_clientdata(client));
  747. int ret;
  748. iio_device_unregister(i2c_get_clientdata(client));
  749. pm_runtime_disable(&client->dev);
  750. pm_runtime_set_suspended(&client->dev);
  751. ret = us5182d_shutdown_en(data, US5182D_CFG0_SHUTDOWN_EN);
  752. if (ret)
  753. dev_warn(&client->dev, "Failed to shut down (%pe)\n",
  754. ERR_PTR(ret));
  755. }
  756. static int us5182d_suspend(struct device *dev)
  757. {
  758. struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
  759. struct us5182d_data *data = iio_priv(indio_dev);
  760. if (data->power_mode == US5182D_CONTINUOUS)
  761. return us5182d_shutdown_en(data, US5182D_CFG0_SHUTDOWN_EN);
  762. return 0;
  763. }
  764. static int us5182d_resume(struct device *dev)
  765. {
  766. struct iio_dev *indio_dev = i2c_get_clientdata(to_i2c_client(dev));
  767. struct us5182d_data *data = iio_priv(indio_dev);
  768. if (data->power_mode == US5182D_CONTINUOUS)
  769. return us5182d_shutdown_en(data,
  770. ~US5182D_CFG0_SHUTDOWN_EN & 0xff);
  771. return 0;
  772. }
  773. static const struct dev_pm_ops us5182d_pm_ops = {
  774. SYSTEM_SLEEP_PM_OPS(us5182d_suspend, us5182d_resume)
  775. RUNTIME_PM_OPS(us5182d_suspend, us5182d_resume, NULL)
  776. };
  777. static const struct acpi_device_id us5182d_acpi_match[] = {
  778. { "USD5182", 0 },
  779. {}
  780. };
  781. MODULE_DEVICE_TABLE(acpi, us5182d_acpi_match);
  782. static const struct i2c_device_id us5182d_id[] = {
  783. { "usd5182", 0 },
  784. {}
  785. };
  786. MODULE_DEVICE_TABLE(i2c, us5182d_id);
  787. static const struct of_device_id us5182d_of_match[] = {
  788. { .compatible = "upisemi,usd5182" },
  789. {}
  790. };
  791. MODULE_DEVICE_TABLE(of, us5182d_of_match);
  792. static struct i2c_driver us5182d_driver = {
  793. .driver = {
  794. .name = US5182D_DRV_NAME,
  795. .pm = pm_ptr(&us5182d_pm_ops),
  796. .of_match_table = us5182d_of_match,
  797. .acpi_match_table = ACPI_PTR(us5182d_acpi_match),
  798. },
  799. .probe = us5182d_probe,
  800. .remove = us5182d_remove,
  801. .id_table = us5182d_id,
  802. };
  803. module_i2c_driver(us5182d_driver);
  804. MODULE_AUTHOR("Adriana Reus <[email protected]>");
  805. MODULE_DESCRIPTION("Driver for us5182d Proximity and Light Sensor");
  806. MODULE_LICENSE("GPL v2");