kmx61.c 36 KB

1234567891011121314151617181920212223242526272829303132333435363738394041424344454647484950515253545556575859606162636465666768697071727374757677787980818283848586878889909192939495969798991001011021031041051061071081091101111121131141151161171181191201211221231241251261271281291301311321331341351361371381391401411421431441451461471481491501511521531541551561571581591601611621631641651661671681691701711721731741751761771781791801811821831841851861871881891901911921931941951961971981992002012022032042052062072082092102112122132142152162172182192202212222232242252262272282292302312322332342352362372382392402412422432442452462472482492502512522532542552562572582592602612622632642652662672682692702712722732742752762772782792802812822832842852862872882892902912922932942952962972982993003013023033043053063073083093103113123133143153163173183193203213223233243253263273283293303313323333343353363373383393403413423433443453463473483493503513523533543553563573583593603613623633643653663673683693703713723733743753763773783793803813823833843853863873883893903913923933943953963973983994004014024034044054064074084094104114124134144154164174184194204214224234244254264274284294304314324334344354364374384394404414424434444454464474484494504514524534544554564574584594604614624634644654664674684694704714724734744754764774784794804814824834844854864874884894904914924934944954964974984995005015025035045055065075085095105115125135145155165175185195205215225235245255265275285295305315325335345355365375385395405415425435445455465475485495505515525535545555565575585595605615625635645655665675685695705715725735745755765775785795805815825835845855865875885895905915925935945955965975985996006016026036046056066076086096106116126136146156166176186196206216226236246256266276286296306316326336346356366376386396406416426436446456466476486496506516526536546556566576586596606616626636646656666676686696706716726736746756766776786796806816826836846856866876886896906916926936946956966976986997007017027037047057067077087097107117127137147157167177187197207217227237247257267277287297307317327337347357367377387397407417427437447457467477487497507517527537547557567577587597607617627637647657667677687697707717727737747757767777787797807817827837847857867877887897907917927937947957967977987998008018028038048058068078088098108118128138148158168178188198208218228238248258268278288298308318328338348358368378388398408418428438448458468478488498508518528538548558568578588598608618628638648658668678688698708718728738748758768778788798808818828838848858868878888898908918928938948958968978988999009019029039049059069079089099109119129139149159169179189199209219229239249259269279289299309319329339349359369379389399409419429439449459469479489499509519529539549559569579589599609619629639649659669679689699709719729739749759769779789799809819829839849859869879889899909919929939949959969979989991000100110021003100410051006100710081009101010111012101310141015101610171018101910201021102210231024102510261027102810291030103110321033103410351036103710381039104010411042104310441045104610471048104910501051105210531054105510561057105810591060106110621063106410651066106710681069107010711072107310741075107610771078107910801081108210831084108510861087108810891090109110921093109410951096109710981099110011011102110311041105110611071108110911101111111211131114111511161117111811191120112111221123112411251126112711281129113011311132113311341135113611371138113911401141114211431144114511461147114811491150115111521153115411551156115711581159116011611162116311641165116611671168116911701171117211731174117511761177117811791180118111821183118411851186118711881189119011911192119311941195119611971198119912001201120212031204120512061207120812091210121112121213121412151216121712181219122012211222122312241225122612271228122912301231123212331234123512361237123812391240124112421243124412451246124712481249125012511252125312541255125612571258125912601261126212631264126512661267126812691270127112721273127412751276127712781279128012811282128312841285128612871288128912901291129212931294129512961297129812991300130113021303130413051306130713081309131013111312131313141315131613171318131913201321132213231324132513261327132813291330133113321333133413351336133713381339134013411342134313441345134613471348134913501351135213531354135513561357135813591360136113621363136413651366136713681369137013711372137313741375137613771378137913801381138213831384138513861387138813891390139113921393139413951396139713981399140014011402140314041405140614071408140914101411141214131414141514161417141814191420142114221423142414251426142714281429143014311432143314341435143614371438143914401441144214431444144514461447144814491450145114521453145414551456145714581459146014611462146314641465146614671468146914701471147214731474147514761477147814791480148114821483148414851486148714881489149014911492149314941495149614971498149915001501150215031504150515061507150815091510151115121513151415151516151715181519152015211522152315241525152615271528
  1. // SPDX-License-Identifier: GPL-2.0-only
  2. /*
  3. * KMX61 - Kionix 6-axis Accelerometer/Magnetometer
  4. *
  5. * Copyright (c) 2014, Intel Corporation.
  6. *
  7. * IIO driver for KMX61 (7-bit I2C slave address 0x0E or 0x0F).
  8. */
  9. #include <linux/module.h>
  10. #include <linux/i2c.h>
  11. #include <linux/acpi.h>
  12. #include <linux/interrupt.h>
  13. #include <linux/pm.h>
  14. #include <linux/pm_runtime.h>
  15. #include <linux/iio/iio.h>
  16. #include <linux/iio/sysfs.h>
  17. #include <linux/iio/events.h>
  18. #include <linux/iio/trigger.h>
  19. #include <linux/iio/buffer.h>
  20. #include <linux/iio/triggered_buffer.h>
  21. #include <linux/iio/trigger_consumer.h>
  22. #define KMX61_DRV_NAME "kmx61"
  23. #define KMX61_IRQ_NAME "kmx61_event"
  24. #define KMX61_REG_WHO_AM_I 0x00
  25. #define KMX61_REG_INS1 0x01
  26. #define KMX61_REG_INS2 0x02
  27. /*
  28. * three 16-bit accelerometer output registers for X/Y/Z axis
  29. * we use only XOUT_L as a base register, all other addresses
  30. * can be obtained by applying an offset and are provided here
  31. * only for clarity.
  32. */
  33. #define KMX61_ACC_XOUT_L 0x0A
  34. #define KMX61_ACC_XOUT_H 0x0B
  35. #define KMX61_ACC_YOUT_L 0x0C
  36. #define KMX61_ACC_YOUT_H 0x0D
  37. #define KMX61_ACC_ZOUT_L 0x0E
  38. #define KMX61_ACC_ZOUT_H 0x0F
  39. /*
  40. * one 16-bit temperature output register
  41. */
  42. #define KMX61_TEMP_L 0x10
  43. #define KMX61_TEMP_H 0x11
  44. /*
  45. * three 16-bit magnetometer output registers for X/Y/Z axis
  46. */
  47. #define KMX61_MAG_XOUT_L 0x12
  48. #define KMX61_MAG_XOUT_H 0x13
  49. #define KMX61_MAG_YOUT_L 0x14
  50. #define KMX61_MAG_YOUT_H 0x15
  51. #define KMX61_MAG_ZOUT_L 0x16
  52. #define KMX61_MAG_ZOUT_H 0x17
  53. #define KMX61_REG_INL 0x28
  54. #define KMX61_REG_STBY 0x29
  55. #define KMX61_REG_CTRL1 0x2A
  56. #define KMX61_REG_CTRL2 0x2B
  57. #define KMX61_REG_ODCNTL 0x2C
  58. #define KMX61_REG_INC1 0x2D
  59. #define KMX61_REG_WUF_THRESH 0x3D
  60. #define KMX61_REG_WUF_TIMER 0x3E
  61. #define KMX61_ACC_STBY_BIT BIT(0)
  62. #define KMX61_MAG_STBY_BIT BIT(1)
  63. #define KMX61_ACT_STBY_BIT BIT(7)
  64. #define KMX61_ALL_STBY (KMX61_ACC_STBY_BIT | KMX61_MAG_STBY_BIT)
  65. #define KMX61_REG_INS1_BIT_WUFS BIT(1)
  66. #define KMX61_REG_INS2_BIT_ZP BIT(0)
  67. #define KMX61_REG_INS2_BIT_ZN BIT(1)
  68. #define KMX61_REG_INS2_BIT_YP BIT(2)
  69. #define KMX61_REG_INS2_BIT_YN BIT(3)
  70. #define KMX61_REG_INS2_BIT_XP BIT(4)
  71. #define KMX61_REG_INS2_BIT_XN BIT(5)
  72. #define KMX61_REG_CTRL1_GSEL_MASK 0x03
  73. #define KMX61_REG_CTRL1_BIT_RES BIT(4)
  74. #define KMX61_REG_CTRL1_BIT_DRDYE BIT(5)
  75. #define KMX61_REG_CTRL1_BIT_WUFE BIT(6)
  76. #define KMX61_REG_CTRL1_BIT_BTSE BIT(7)
  77. #define KMX61_REG_INC1_BIT_WUFS BIT(0)
  78. #define KMX61_REG_INC1_BIT_DRDYM BIT(1)
  79. #define KMX61_REG_INC1_BIT_DRDYA BIT(2)
  80. #define KMX61_REG_INC1_BIT_IEN BIT(5)
  81. #define KMX61_ACC_ODR_SHIFT 0
  82. #define KMX61_MAG_ODR_SHIFT 4
  83. #define KMX61_ACC_ODR_MASK 0x0F
  84. #define KMX61_MAG_ODR_MASK 0xF0
  85. #define KMX61_OWUF_MASK 0x7
  86. #define KMX61_DEFAULT_WAKE_THRESH 1
  87. #define KMX61_DEFAULT_WAKE_DURATION 1
  88. #define KMX61_SLEEP_DELAY_MS 2000
  89. #define KMX61_CHIP_ID 0x12
  90. /* KMX61 devices */
  91. #define KMX61_ACC 0x01
  92. #define KMX61_MAG 0x02
  93. struct kmx61_data {
  94. struct i2c_client *client;
  95. /* serialize access to non-atomic ops, e.g set_mode */
  96. struct mutex lock;
  97. /* standby state */
  98. bool acc_stby;
  99. bool mag_stby;
  100. /* power state */
  101. bool acc_ps;
  102. bool mag_ps;
  103. /* config bits */
  104. u8 range;
  105. u8 odr_bits;
  106. u8 wake_thresh;
  107. u8 wake_duration;
  108. /* accelerometer specific data */
  109. struct iio_dev *acc_indio_dev;
  110. struct iio_trigger *acc_dready_trig;
  111. struct iio_trigger *motion_trig;
  112. bool acc_dready_trig_on;
  113. bool motion_trig_on;
  114. bool ev_enable_state;
  115. /* magnetometer specific data */
  116. struct iio_dev *mag_indio_dev;
  117. struct iio_trigger *mag_dready_trig;
  118. bool mag_dready_trig_on;
  119. };
  120. enum kmx61_range {
  121. KMX61_RANGE_2G,
  122. KMX61_RANGE_4G,
  123. KMX61_RANGE_8G,
  124. };
  125. enum kmx61_axis {
  126. KMX61_AXIS_X,
  127. KMX61_AXIS_Y,
  128. KMX61_AXIS_Z,
  129. };
  130. static const u16 kmx61_uscale_table[] = {9582, 19163, 38326};
  131. static const struct {
  132. int val;
  133. int val2;
  134. } kmx61_samp_freq_table[] = { {12, 500000},
  135. {25, 0},
  136. {50, 0},
  137. {100, 0},
  138. {200, 0},
  139. {400, 0},
  140. {800, 0},
  141. {1600, 0},
  142. {0, 781000},
  143. {1, 563000},
  144. {3, 125000},
  145. {6, 250000} };
  146. static const struct {
  147. int val;
  148. int val2;
  149. int odr_bits;
  150. } kmx61_wake_up_odr_table[] = { {0, 781000, 0x00},
  151. {1, 563000, 0x01},
  152. {3, 125000, 0x02},
  153. {6, 250000, 0x03},
  154. {12, 500000, 0x04},
  155. {25, 0, 0x05},
  156. {50, 0, 0x06},
  157. {100, 0, 0x06},
  158. {200, 0, 0x06},
  159. {400, 0, 0x06},
  160. {800, 0, 0x06},
  161. {1600, 0, 0x06} };
  162. static IIO_CONST_ATTR(accel_scale_available, "0.009582 0.019163 0.038326");
  163. static IIO_CONST_ATTR(magn_scale_available, "0.001465");
  164. static IIO_CONST_ATTR_SAMP_FREQ_AVAIL(
  165. "0.781000 1.563000 3.125000 6.250000 12.500000 25 50 100 200 400 800");
  166. static struct attribute *kmx61_acc_attributes[] = {
  167. &iio_const_attr_accel_scale_available.dev_attr.attr,
  168. &iio_const_attr_sampling_frequency_available.dev_attr.attr,
  169. NULL,
  170. };
  171. static struct attribute *kmx61_mag_attributes[] = {
  172. &iio_const_attr_magn_scale_available.dev_attr.attr,
  173. &iio_const_attr_sampling_frequency_available.dev_attr.attr,
  174. NULL,
  175. };
  176. static const struct attribute_group kmx61_acc_attribute_group = {
  177. .attrs = kmx61_acc_attributes,
  178. };
  179. static const struct attribute_group kmx61_mag_attribute_group = {
  180. .attrs = kmx61_mag_attributes,
  181. };
  182. static const struct iio_event_spec kmx61_event = {
  183. .type = IIO_EV_TYPE_THRESH,
  184. .dir = IIO_EV_DIR_EITHER,
  185. .mask_separate = BIT(IIO_EV_INFO_VALUE) |
  186. BIT(IIO_EV_INFO_ENABLE) |
  187. BIT(IIO_EV_INFO_PERIOD),
  188. };
  189. #define KMX61_ACC_CHAN(_axis) { \
  190. .type = IIO_ACCEL, \
  191. .modified = 1, \
  192. .channel2 = IIO_MOD_ ## _axis, \
  193. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
  194. .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
  195. BIT(IIO_CHAN_INFO_SAMP_FREQ), \
  196. .address = KMX61_ACC, \
  197. .scan_index = KMX61_AXIS_ ## _axis, \
  198. .scan_type = { \
  199. .sign = 's', \
  200. .realbits = 12, \
  201. .storagebits = 16, \
  202. .shift = 4, \
  203. .endianness = IIO_LE, \
  204. }, \
  205. .event_spec = &kmx61_event, \
  206. .num_event_specs = 1 \
  207. }
  208. #define KMX61_MAG_CHAN(_axis) { \
  209. .type = IIO_MAGN, \
  210. .modified = 1, \
  211. .channel2 = IIO_MOD_ ## _axis, \
  212. .address = KMX61_MAG, \
  213. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
  214. .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
  215. BIT(IIO_CHAN_INFO_SAMP_FREQ), \
  216. .scan_index = KMX61_AXIS_ ## _axis, \
  217. .scan_type = { \
  218. .sign = 's', \
  219. .realbits = 14, \
  220. .storagebits = 16, \
  221. .shift = 2, \
  222. .endianness = IIO_LE, \
  223. }, \
  224. }
  225. static const struct iio_chan_spec kmx61_acc_channels[] = {
  226. KMX61_ACC_CHAN(X),
  227. KMX61_ACC_CHAN(Y),
  228. KMX61_ACC_CHAN(Z),
  229. };
  230. static const struct iio_chan_spec kmx61_mag_channels[] = {
  231. KMX61_MAG_CHAN(X),
  232. KMX61_MAG_CHAN(Y),
  233. KMX61_MAG_CHAN(Z),
  234. };
  235. static void kmx61_set_data(struct iio_dev *indio_dev, struct kmx61_data *data)
  236. {
  237. struct kmx61_data **priv = iio_priv(indio_dev);
  238. *priv = data;
  239. }
  240. static struct kmx61_data *kmx61_get_data(struct iio_dev *indio_dev)
  241. {
  242. return *(struct kmx61_data **)iio_priv(indio_dev);
  243. }
  244. static int kmx61_convert_freq_to_bit(int val, int val2)
  245. {
  246. int i;
  247. for (i = 0; i < ARRAY_SIZE(kmx61_samp_freq_table); i++)
  248. if (val == kmx61_samp_freq_table[i].val &&
  249. val2 == kmx61_samp_freq_table[i].val2)
  250. return i;
  251. return -EINVAL;
  252. }
  253. static int kmx61_convert_wake_up_odr_to_bit(int val, int val2)
  254. {
  255. int i;
  256. for (i = 0; i < ARRAY_SIZE(kmx61_wake_up_odr_table); ++i)
  257. if (kmx61_wake_up_odr_table[i].val == val &&
  258. kmx61_wake_up_odr_table[i].val2 == val2)
  259. return kmx61_wake_up_odr_table[i].odr_bits;
  260. return -EINVAL;
  261. }
  262. /**
  263. * kmx61_set_mode() - set KMX61 device operating mode
  264. * @data: kmx61 device private data pointer
  265. * @mode: bitmask, indicating operating mode for @device
  266. * @device: bitmask, indicating device for which @mode needs to be set
  267. * @update: update stby bits stored in device's private @data
  268. *
  269. * For each sensor (accelerometer/magnetometer) there are two operating modes
  270. * STANDBY and OPERATION. Neither accel nor magn can be disabled independently
  271. * if they are both enabled. Internal sensors state is saved in acc_stby and
  272. * mag_stby members of driver's private @data.
  273. */
  274. static int kmx61_set_mode(struct kmx61_data *data, u8 mode, u8 device,
  275. bool update)
  276. {
  277. int ret;
  278. int acc_stby = -1, mag_stby = -1;
  279. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_STBY);
  280. if (ret < 0) {
  281. dev_err(&data->client->dev, "Error reading reg_stby\n");
  282. return ret;
  283. }
  284. if (device & KMX61_ACC) {
  285. if (mode & KMX61_ACC_STBY_BIT) {
  286. ret |= KMX61_ACC_STBY_BIT;
  287. acc_stby = 1;
  288. } else {
  289. ret &= ~KMX61_ACC_STBY_BIT;
  290. acc_stby = 0;
  291. }
  292. }
  293. if (device & KMX61_MAG) {
  294. if (mode & KMX61_MAG_STBY_BIT) {
  295. ret |= KMX61_MAG_STBY_BIT;
  296. mag_stby = 1;
  297. } else {
  298. ret &= ~KMX61_MAG_STBY_BIT;
  299. mag_stby = 0;
  300. }
  301. }
  302. if (mode & KMX61_ACT_STBY_BIT)
  303. ret |= KMX61_ACT_STBY_BIT;
  304. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_STBY, ret);
  305. if (ret < 0) {
  306. dev_err(&data->client->dev, "Error writing reg_stby\n");
  307. return ret;
  308. }
  309. if (acc_stby != -1 && update)
  310. data->acc_stby = acc_stby;
  311. if (mag_stby != -1 && update)
  312. data->mag_stby = mag_stby;
  313. return 0;
  314. }
  315. static int kmx61_get_mode(struct kmx61_data *data, u8 *mode, u8 device)
  316. {
  317. int ret;
  318. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_STBY);
  319. if (ret < 0) {
  320. dev_err(&data->client->dev, "Error reading reg_stby\n");
  321. return ret;
  322. }
  323. *mode = 0;
  324. if (device & KMX61_ACC) {
  325. if (ret & KMX61_ACC_STBY_BIT)
  326. *mode |= KMX61_ACC_STBY_BIT;
  327. else
  328. *mode &= ~KMX61_ACC_STBY_BIT;
  329. }
  330. if (device & KMX61_MAG) {
  331. if (ret & KMX61_MAG_STBY_BIT)
  332. *mode |= KMX61_MAG_STBY_BIT;
  333. else
  334. *mode &= ~KMX61_MAG_STBY_BIT;
  335. }
  336. return 0;
  337. }
  338. static int kmx61_set_wake_up_odr(struct kmx61_data *data, int val, int val2)
  339. {
  340. int ret, odr_bits;
  341. odr_bits = kmx61_convert_wake_up_odr_to_bit(val, val2);
  342. if (odr_bits < 0)
  343. return odr_bits;
  344. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL2,
  345. odr_bits);
  346. if (ret < 0)
  347. dev_err(&data->client->dev, "Error writing reg_ctrl2\n");
  348. return ret;
  349. }
  350. static int kmx61_set_odr(struct kmx61_data *data, int val, int val2, u8 device)
  351. {
  352. int ret;
  353. u8 mode;
  354. int lodr_bits, odr_bits;
  355. ret = kmx61_get_mode(data, &mode, KMX61_ACC | KMX61_MAG);
  356. if (ret < 0)
  357. return ret;
  358. lodr_bits = kmx61_convert_freq_to_bit(val, val2);
  359. if (lodr_bits < 0)
  360. return lodr_bits;
  361. /* To change ODR, accel and magn must be in STDBY */
  362. ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG,
  363. true);
  364. if (ret < 0)
  365. return ret;
  366. odr_bits = 0;
  367. if (device & KMX61_ACC)
  368. odr_bits |= lodr_bits << KMX61_ACC_ODR_SHIFT;
  369. if (device & KMX61_MAG)
  370. odr_bits |= lodr_bits << KMX61_MAG_ODR_SHIFT;
  371. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_ODCNTL,
  372. odr_bits);
  373. if (ret < 0)
  374. return ret;
  375. data->odr_bits = odr_bits;
  376. if (device & KMX61_ACC) {
  377. ret = kmx61_set_wake_up_odr(data, val, val2);
  378. if (ret)
  379. return ret;
  380. }
  381. return kmx61_set_mode(data, mode, KMX61_ACC | KMX61_MAG, true);
  382. }
  383. static int kmx61_get_odr(struct kmx61_data *data, int *val, int *val2,
  384. u8 device)
  385. {
  386. u8 lodr_bits;
  387. if (device & KMX61_ACC)
  388. lodr_bits = (data->odr_bits >> KMX61_ACC_ODR_SHIFT) &
  389. KMX61_ACC_ODR_MASK;
  390. else if (device & KMX61_MAG)
  391. lodr_bits = (data->odr_bits >> KMX61_MAG_ODR_SHIFT) &
  392. KMX61_MAG_ODR_MASK;
  393. else
  394. return -EINVAL;
  395. if (lodr_bits >= ARRAY_SIZE(kmx61_samp_freq_table))
  396. return -EINVAL;
  397. *val = kmx61_samp_freq_table[lodr_bits].val;
  398. *val2 = kmx61_samp_freq_table[lodr_bits].val2;
  399. return 0;
  400. }
  401. static int kmx61_set_range(struct kmx61_data *data, u8 range)
  402. {
  403. int ret;
  404. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_CTRL1);
  405. if (ret < 0) {
  406. dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
  407. return ret;
  408. }
  409. ret &= ~KMX61_REG_CTRL1_GSEL_MASK;
  410. ret |= range & KMX61_REG_CTRL1_GSEL_MASK;
  411. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL1, ret);
  412. if (ret < 0) {
  413. dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
  414. return ret;
  415. }
  416. data->range = range;
  417. return 0;
  418. }
  419. static int kmx61_set_scale(struct kmx61_data *data, u16 uscale)
  420. {
  421. int ret, i;
  422. u8 mode;
  423. for (i = 0; i < ARRAY_SIZE(kmx61_uscale_table); i++) {
  424. if (kmx61_uscale_table[i] == uscale) {
  425. ret = kmx61_get_mode(data, &mode,
  426. KMX61_ACC | KMX61_MAG);
  427. if (ret < 0)
  428. return ret;
  429. ret = kmx61_set_mode(data, KMX61_ALL_STBY,
  430. KMX61_ACC | KMX61_MAG, true);
  431. if (ret < 0)
  432. return ret;
  433. ret = kmx61_set_range(data, i);
  434. if (ret < 0)
  435. return ret;
  436. return kmx61_set_mode(data, mode,
  437. KMX61_ACC | KMX61_MAG, true);
  438. }
  439. }
  440. return -EINVAL;
  441. }
  442. static int kmx61_chip_init(struct kmx61_data *data)
  443. {
  444. int ret, val, val2;
  445. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_WHO_AM_I);
  446. if (ret < 0) {
  447. dev_err(&data->client->dev, "Error reading who_am_i\n");
  448. return ret;
  449. }
  450. if (ret != KMX61_CHIP_ID) {
  451. dev_err(&data->client->dev,
  452. "Wrong chip id, got %x expected %x\n",
  453. ret, KMX61_CHIP_ID);
  454. return -EINVAL;
  455. }
  456. /* set accel 12bit, 4g range */
  457. ret = kmx61_set_range(data, KMX61_RANGE_4G);
  458. if (ret < 0)
  459. return ret;
  460. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_ODCNTL);
  461. if (ret < 0) {
  462. dev_err(&data->client->dev, "Error reading reg_odcntl\n");
  463. return ret;
  464. }
  465. data->odr_bits = ret;
  466. /*
  467. * set output data rate for wake up (motion detection) function
  468. * to match data rate for accelerometer sampling
  469. */
  470. ret = kmx61_get_odr(data, &val, &val2, KMX61_ACC);
  471. if (ret < 0)
  472. return ret;
  473. ret = kmx61_set_wake_up_odr(data, val, val2);
  474. if (ret < 0)
  475. return ret;
  476. /* set acc/magn to OPERATION mode */
  477. ret = kmx61_set_mode(data, 0, KMX61_ACC | KMX61_MAG, true);
  478. if (ret < 0)
  479. return ret;
  480. data->wake_thresh = KMX61_DEFAULT_WAKE_THRESH;
  481. data->wake_duration = KMX61_DEFAULT_WAKE_DURATION;
  482. return 0;
  483. }
  484. static int kmx61_setup_new_data_interrupt(struct kmx61_data *data,
  485. bool status, u8 device)
  486. {
  487. u8 mode;
  488. int ret;
  489. ret = kmx61_get_mode(data, &mode, KMX61_ACC | KMX61_MAG);
  490. if (ret < 0)
  491. return ret;
  492. ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true);
  493. if (ret < 0)
  494. return ret;
  495. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INC1);
  496. if (ret < 0) {
  497. dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
  498. return ret;
  499. }
  500. if (status) {
  501. ret |= KMX61_REG_INC1_BIT_IEN;
  502. if (device & KMX61_ACC)
  503. ret |= KMX61_REG_INC1_BIT_DRDYA;
  504. if (device & KMX61_MAG)
  505. ret |= KMX61_REG_INC1_BIT_DRDYM;
  506. } else {
  507. ret &= ~KMX61_REG_INC1_BIT_IEN;
  508. if (device & KMX61_ACC)
  509. ret &= ~KMX61_REG_INC1_BIT_DRDYA;
  510. if (device & KMX61_MAG)
  511. ret &= ~KMX61_REG_INC1_BIT_DRDYM;
  512. }
  513. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_INC1, ret);
  514. if (ret < 0) {
  515. dev_err(&data->client->dev, "Error writing reg_int_ctrl1\n");
  516. return ret;
  517. }
  518. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_CTRL1);
  519. if (ret < 0) {
  520. dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
  521. return ret;
  522. }
  523. if (status)
  524. ret |= KMX61_REG_CTRL1_BIT_DRDYE;
  525. else
  526. ret &= ~KMX61_REG_CTRL1_BIT_DRDYE;
  527. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL1, ret);
  528. if (ret < 0) {
  529. dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
  530. return ret;
  531. }
  532. return kmx61_set_mode(data, mode, KMX61_ACC | KMX61_MAG, true);
  533. }
  534. static int kmx61_chip_update_thresholds(struct kmx61_data *data)
  535. {
  536. int ret;
  537. ret = i2c_smbus_write_byte_data(data->client,
  538. KMX61_REG_WUF_TIMER,
  539. data->wake_duration);
  540. if (ret < 0) {
  541. dev_err(&data->client->dev, "Error writing reg_wuf_timer\n");
  542. return ret;
  543. }
  544. ret = i2c_smbus_write_byte_data(data->client,
  545. KMX61_REG_WUF_THRESH,
  546. data->wake_thresh);
  547. if (ret < 0)
  548. dev_err(&data->client->dev, "Error writing reg_wuf_thresh\n");
  549. return ret;
  550. }
  551. static int kmx61_setup_any_motion_interrupt(struct kmx61_data *data,
  552. bool status)
  553. {
  554. u8 mode;
  555. int ret;
  556. ret = kmx61_get_mode(data, &mode, KMX61_ACC | KMX61_MAG);
  557. if (ret < 0)
  558. return ret;
  559. ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true);
  560. if (ret < 0)
  561. return ret;
  562. ret = kmx61_chip_update_thresholds(data);
  563. if (ret < 0)
  564. return ret;
  565. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INC1);
  566. if (ret < 0) {
  567. dev_err(&data->client->dev, "Error reading reg_inc1\n");
  568. return ret;
  569. }
  570. if (status)
  571. ret |= (KMX61_REG_INC1_BIT_IEN | KMX61_REG_INC1_BIT_WUFS);
  572. else
  573. ret &= ~(KMX61_REG_INC1_BIT_IEN | KMX61_REG_INC1_BIT_WUFS);
  574. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_INC1, ret);
  575. if (ret < 0) {
  576. dev_err(&data->client->dev, "Error writing reg_inc1\n");
  577. return ret;
  578. }
  579. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_CTRL1);
  580. if (ret < 0) {
  581. dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
  582. return ret;
  583. }
  584. if (status)
  585. ret |= KMX61_REG_CTRL1_BIT_WUFE | KMX61_REG_CTRL1_BIT_BTSE;
  586. else
  587. ret &= ~(KMX61_REG_CTRL1_BIT_WUFE | KMX61_REG_CTRL1_BIT_BTSE);
  588. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL1, ret);
  589. if (ret < 0) {
  590. dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
  591. return ret;
  592. }
  593. mode |= KMX61_ACT_STBY_BIT;
  594. return kmx61_set_mode(data, mode, KMX61_ACC | KMX61_MAG, true);
  595. }
  596. /**
  597. * kmx61_set_power_state() - set power state for kmx61 @device
  598. * @data: kmx61 device private pointer
  599. * @on: power state to be set for @device
  600. * @device: bitmask indicating device for which @on state needs to be set
  601. *
  602. * Notice that when ACC power state needs to be set to ON and MAG is in
  603. * OPERATION then we know that kmx61_runtime_resume was already called
  604. * so we must set ACC OPERATION mode here. The same happens when MAG power
  605. * state needs to be set to ON and ACC is in OPERATION.
  606. */
  607. static int kmx61_set_power_state(struct kmx61_data *data, bool on, u8 device)
  608. {
  609. #ifdef CONFIG_PM
  610. int ret;
  611. if (device & KMX61_ACC) {
  612. if (on && !data->acc_ps && !data->mag_stby) {
  613. ret = kmx61_set_mode(data, 0, KMX61_ACC, true);
  614. if (ret < 0)
  615. return ret;
  616. }
  617. data->acc_ps = on;
  618. }
  619. if (device & KMX61_MAG) {
  620. if (on && !data->mag_ps && !data->acc_stby) {
  621. ret = kmx61_set_mode(data, 0, KMX61_MAG, true);
  622. if (ret < 0)
  623. return ret;
  624. }
  625. data->mag_ps = on;
  626. }
  627. if (on) {
  628. ret = pm_runtime_resume_and_get(&data->client->dev);
  629. } else {
  630. pm_runtime_mark_last_busy(&data->client->dev);
  631. ret = pm_runtime_put_autosuspend(&data->client->dev);
  632. }
  633. if (ret < 0) {
  634. dev_err(&data->client->dev,
  635. "Failed: kmx61_set_power_state for %d, ret %d\n",
  636. on, ret);
  637. return ret;
  638. }
  639. #endif
  640. return 0;
  641. }
  642. static int kmx61_read_measurement(struct kmx61_data *data, u8 base, u8 offset)
  643. {
  644. int ret;
  645. u8 reg = base + offset * 2;
  646. ret = i2c_smbus_read_word_data(data->client, reg);
  647. if (ret < 0)
  648. dev_err(&data->client->dev, "failed to read reg at %x\n", reg);
  649. return ret;
  650. }
  651. static int kmx61_read_raw(struct iio_dev *indio_dev,
  652. struct iio_chan_spec const *chan, int *val,
  653. int *val2, long mask)
  654. {
  655. int ret;
  656. u8 base_reg;
  657. struct kmx61_data *data = kmx61_get_data(indio_dev);
  658. switch (mask) {
  659. case IIO_CHAN_INFO_RAW:
  660. switch (chan->type) {
  661. case IIO_ACCEL:
  662. base_reg = KMX61_ACC_XOUT_L;
  663. break;
  664. case IIO_MAGN:
  665. base_reg = KMX61_MAG_XOUT_L;
  666. break;
  667. default:
  668. return -EINVAL;
  669. }
  670. mutex_lock(&data->lock);
  671. ret = kmx61_set_power_state(data, true, chan->address);
  672. if (ret) {
  673. mutex_unlock(&data->lock);
  674. return ret;
  675. }
  676. ret = kmx61_read_measurement(data, base_reg, chan->scan_index);
  677. if (ret < 0) {
  678. kmx61_set_power_state(data, false, chan->address);
  679. mutex_unlock(&data->lock);
  680. return ret;
  681. }
  682. *val = sign_extend32(ret >> chan->scan_type.shift,
  683. chan->scan_type.realbits - 1);
  684. ret = kmx61_set_power_state(data, false, chan->address);
  685. mutex_unlock(&data->lock);
  686. if (ret)
  687. return ret;
  688. return IIO_VAL_INT;
  689. case IIO_CHAN_INFO_SCALE:
  690. switch (chan->type) {
  691. case IIO_ACCEL:
  692. *val = 0;
  693. *val2 = kmx61_uscale_table[data->range];
  694. return IIO_VAL_INT_PLUS_MICRO;
  695. case IIO_MAGN:
  696. /* 14 bits res, 1465 microGauss per magn count */
  697. *val = 0;
  698. *val2 = 1465;
  699. return IIO_VAL_INT_PLUS_MICRO;
  700. default:
  701. return -EINVAL;
  702. }
  703. case IIO_CHAN_INFO_SAMP_FREQ:
  704. if (chan->type != IIO_ACCEL && chan->type != IIO_MAGN)
  705. return -EINVAL;
  706. mutex_lock(&data->lock);
  707. ret = kmx61_get_odr(data, val, val2, chan->address);
  708. mutex_unlock(&data->lock);
  709. if (ret)
  710. return -EINVAL;
  711. return IIO_VAL_INT_PLUS_MICRO;
  712. }
  713. return -EINVAL;
  714. }
  715. static int kmx61_write_raw(struct iio_dev *indio_dev,
  716. struct iio_chan_spec const *chan, int val,
  717. int val2, long mask)
  718. {
  719. int ret;
  720. struct kmx61_data *data = kmx61_get_data(indio_dev);
  721. switch (mask) {
  722. case IIO_CHAN_INFO_SAMP_FREQ:
  723. if (chan->type != IIO_ACCEL && chan->type != IIO_MAGN)
  724. return -EINVAL;
  725. mutex_lock(&data->lock);
  726. ret = kmx61_set_odr(data, val, val2, chan->address);
  727. mutex_unlock(&data->lock);
  728. return ret;
  729. case IIO_CHAN_INFO_SCALE:
  730. switch (chan->type) {
  731. case IIO_ACCEL:
  732. if (val != 0)
  733. return -EINVAL;
  734. mutex_lock(&data->lock);
  735. ret = kmx61_set_scale(data, val2);
  736. mutex_unlock(&data->lock);
  737. return ret;
  738. default:
  739. return -EINVAL;
  740. }
  741. default:
  742. return -EINVAL;
  743. }
  744. }
  745. static int kmx61_read_event(struct iio_dev *indio_dev,
  746. const struct iio_chan_spec *chan,
  747. enum iio_event_type type,
  748. enum iio_event_direction dir,
  749. enum iio_event_info info,
  750. int *val, int *val2)
  751. {
  752. struct kmx61_data *data = kmx61_get_data(indio_dev);
  753. *val2 = 0;
  754. switch (info) {
  755. case IIO_EV_INFO_VALUE:
  756. *val = data->wake_thresh;
  757. return IIO_VAL_INT;
  758. case IIO_EV_INFO_PERIOD:
  759. *val = data->wake_duration;
  760. return IIO_VAL_INT;
  761. default:
  762. return -EINVAL;
  763. }
  764. }
  765. static int kmx61_write_event(struct iio_dev *indio_dev,
  766. const struct iio_chan_spec *chan,
  767. enum iio_event_type type,
  768. enum iio_event_direction dir,
  769. enum iio_event_info info,
  770. int val, int val2)
  771. {
  772. struct kmx61_data *data = kmx61_get_data(indio_dev);
  773. if (data->ev_enable_state)
  774. return -EBUSY;
  775. switch (info) {
  776. case IIO_EV_INFO_VALUE:
  777. data->wake_thresh = val;
  778. return IIO_VAL_INT;
  779. case IIO_EV_INFO_PERIOD:
  780. data->wake_duration = val;
  781. return IIO_VAL_INT;
  782. default:
  783. return -EINVAL;
  784. }
  785. }
  786. static int kmx61_read_event_config(struct iio_dev *indio_dev,
  787. const struct iio_chan_spec *chan,
  788. enum iio_event_type type,
  789. enum iio_event_direction dir)
  790. {
  791. struct kmx61_data *data = kmx61_get_data(indio_dev);
  792. return data->ev_enable_state;
  793. }
  794. static int kmx61_write_event_config(struct iio_dev *indio_dev,
  795. const struct iio_chan_spec *chan,
  796. enum iio_event_type type,
  797. enum iio_event_direction dir,
  798. int state)
  799. {
  800. struct kmx61_data *data = kmx61_get_data(indio_dev);
  801. int ret = 0;
  802. if (state && data->ev_enable_state)
  803. return 0;
  804. mutex_lock(&data->lock);
  805. if (!state && data->motion_trig_on) {
  806. data->ev_enable_state = false;
  807. goto err_unlock;
  808. }
  809. ret = kmx61_set_power_state(data, state, KMX61_ACC);
  810. if (ret < 0)
  811. goto err_unlock;
  812. ret = kmx61_setup_any_motion_interrupt(data, state);
  813. if (ret < 0) {
  814. kmx61_set_power_state(data, false, KMX61_ACC);
  815. goto err_unlock;
  816. }
  817. data->ev_enable_state = state;
  818. err_unlock:
  819. mutex_unlock(&data->lock);
  820. return ret;
  821. }
  822. static int kmx61_acc_validate_trigger(struct iio_dev *indio_dev,
  823. struct iio_trigger *trig)
  824. {
  825. struct kmx61_data *data = kmx61_get_data(indio_dev);
  826. if (data->acc_dready_trig != trig && data->motion_trig != trig)
  827. return -EINVAL;
  828. return 0;
  829. }
  830. static int kmx61_mag_validate_trigger(struct iio_dev *indio_dev,
  831. struct iio_trigger *trig)
  832. {
  833. struct kmx61_data *data = kmx61_get_data(indio_dev);
  834. if (data->mag_dready_trig != trig)
  835. return -EINVAL;
  836. return 0;
  837. }
  838. static const struct iio_info kmx61_acc_info = {
  839. .read_raw = kmx61_read_raw,
  840. .write_raw = kmx61_write_raw,
  841. .attrs = &kmx61_acc_attribute_group,
  842. .read_event_value = kmx61_read_event,
  843. .write_event_value = kmx61_write_event,
  844. .read_event_config = kmx61_read_event_config,
  845. .write_event_config = kmx61_write_event_config,
  846. .validate_trigger = kmx61_acc_validate_trigger,
  847. };
  848. static const struct iio_info kmx61_mag_info = {
  849. .read_raw = kmx61_read_raw,
  850. .write_raw = kmx61_write_raw,
  851. .attrs = &kmx61_mag_attribute_group,
  852. .validate_trigger = kmx61_mag_validate_trigger,
  853. };
  854. static int kmx61_data_rdy_trigger_set_state(struct iio_trigger *trig,
  855. bool state)
  856. {
  857. int ret = 0;
  858. u8 device;
  859. struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
  860. struct kmx61_data *data = kmx61_get_data(indio_dev);
  861. mutex_lock(&data->lock);
  862. if (!state && data->ev_enable_state && data->motion_trig_on) {
  863. data->motion_trig_on = false;
  864. goto err_unlock;
  865. }
  866. if (data->acc_dready_trig == trig || data->motion_trig == trig)
  867. device = KMX61_ACC;
  868. else
  869. device = KMX61_MAG;
  870. ret = kmx61_set_power_state(data, state, device);
  871. if (ret < 0)
  872. goto err_unlock;
  873. if (data->acc_dready_trig == trig || data->mag_dready_trig == trig)
  874. ret = kmx61_setup_new_data_interrupt(data, state, device);
  875. else
  876. ret = kmx61_setup_any_motion_interrupt(data, state);
  877. if (ret < 0) {
  878. kmx61_set_power_state(data, false, device);
  879. goto err_unlock;
  880. }
  881. if (data->acc_dready_trig == trig)
  882. data->acc_dready_trig_on = state;
  883. else if (data->mag_dready_trig == trig)
  884. data->mag_dready_trig_on = state;
  885. else
  886. data->motion_trig_on = state;
  887. err_unlock:
  888. mutex_unlock(&data->lock);
  889. return ret;
  890. }
  891. static void kmx61_trig_reenable(struct iio_trigger *trig)
  892. {
  893. struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
  894. struct kmx61_data *data = kmx61_get_data(indio_dev);
  895. int ret;
  896. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INL);
  897. if (ret < 0)
  898. dev_err(&data->client->dev, "Error reading reg_inl\n");
  899. }
  900. static const struct iio_trigger_ops kmx61_trigger_ops = {
  901. .set_trigger_state = kmx61_data_rdy_trigger_set_state,
  902. .reenable = kmx61_trig_reenable,
  903. };
  904. static irqreturn_t kmx61_event_handler(int irq, void *private)
  905. {
  906. struct kmx61_data *data = private;
  907. struct iio_dev *indio_dev = data->acc_indio_dev;
  908. int ret;
  909. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INS1);
  910. if (ret < 0) {
  911. dev_err(&data->client->dev, "Error reading reg_ins1\n");
  912. goto ack_intr;
  913. }
  914. if (ret & KMX61_REG_INS1_BIT_WUFS) {
  915. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INS2);
  916. if (ret < 0) {
  917. dev_err(&data->client->dev, "Error reading reg_ins2\n");
  918. goto ack_intr;
  919. }
  920. if (ret & KMX61_REG_INS2_BIT_XN)
  921. iio_push_event(indio_dev,
  922. IIO_MOD_EVENT_CODE(IIO_ACCEL,
  923. 0,
  924. IIO_MOD_X,
  925. IIO_EV_TYPE_THRESH,
  926. IIO_EV_DIR_FALLING),
  927. 0);
  928. if (ret & KMX61_REG_INS2_BIT_XP)
  929. iio_push_event(indio_dev,
  930. IIO_MOD_EVENT_CODE(IIO_ACCEL,
  931. 0,
  932. IIO_MOD_X,
  933. IIO_EV_TYPE_THRESH,
  934. IIO_EV_DIR_RISING),
  935. 0);
  936. if (ret & KMX61_REG_INS2_BIT_YN)
  937. iio_push_event(indio_dev,
  938. IIO_MOD_EVENT_CODE(IIO_ACCEL,
  939. 0,
  940. IIO_MOD_Y,
  941. IIO_EV_TYPE_THRESH,
  942. IIO_EV_DIR_FALLING),
  943. 0);
  944. if (ret & KMX61_REG_INS2_BIT_YP)
  945. iio_push_event(indio_dev,
  946. IIO_MOD_EVENT_CODE(IIO_ACCEL,
  947. 0,
  948. IIO_MOD_Y,
  949. IIO_EV_TYPE_THRESH,
  950. IIO_EV_DIR_RISING),
  951. 0);
  952. if (ret & KMX61_REG_INS2_BIT_ZN)
  953. iio_push_event(indio_dev,
  954. IIO_MOD_EVENT_CODE(IIO_ACCEL,
  955. 0,
  956. IIO_MOD_Z,
  957. IIO_EV_TYPE_THRESH,
  958. IIO_EV_DIR_FALLING),
  959. 0);
  960. if (ret & KMX61_REG_INS2_BIT_ZP)
  961. iio_push_event(indio_dev,
  962. IIO_MOD_EVENT_CODE(IIO_ACCEL,
  963. 0,
  964. IIO_MOD_Z,
  965. IIO_EV_TYPE_THRESH,
  966. IIO_EV_DIR_RISING),
  967. 0);
  968. }
  969. ack_intr:
  970. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_CTRL1);
  971. if (ret < 0)
  972. dev_err(&data->client->dev, "Error reading reg_ctrl1\n");
  973. ret |= KMX61_REG_CTRL1_BIT_RES;
  974. ret = i2c_smbus_write_byte_data(data->client, KMX61_REG_CTRL1, ret);
  975. if (ret < 0)
  976. dev_err(&data->client->dev, "Error writing reg_ctrl1\n");
  977. ret = i2c_smbus_read_byte_data(data->client, KMX61_REG_INL);
  978. if (ret < 0)
  979. dev_err(&data->client->dev, "Error reading reg_inl\n");
  980. return IRQ_HANDLED;
  981. }
  982. static irqreturn_t kmx61_data_rdy_trig_poll(int irq, void *private)
  983. {
  984. struct kmx61_data *data = private;
  985. if (data->acc_dready_trig_on)
  986. iio_trigger_poll(data->acc_dready_trig);
  987. if (data->mag_dready_trig_on)
  988. iio_trigger_poll(data->mag_dready_trig);
  989. if (data->motion_trig_on)
  990. iio_trigger_poll(data->motion_trig);
  991. if (data->ev_enable_state)
  992. return IRQ_WAKE_THREAD;
  993. return IRQ_HANDLED;
  994. }
  995. static irqreturn_t kmx61_trigger_handler(int irq, void *p)
  996. {
  997. struct iio_poll_func *pf = p;
  998. struct iio_dev *indio_dev = pf->indio_dev;
  999. struct kmx61_data *data = kmx61_get_data(indio_dev);
  1000. int bit, ret, i = 0;
  1001. u8 base;
  1002. s16 buffer[8] = { };
  1003. if (indio_dev == data->acc_indio_dev)
  1004. base = KMX61_ACC_XOUT_L;
  1005. else
  1006. base = KMX61_MAG_XOUT_L;
  1007. mutex_lock(&data->lock);
  1008. iio_for_each_active_channel(indio_dev, bit) {
  1009. ret = kmx61_read_measurement(data, base, bit);
  1010. if (ret < 0) {
  1011. mutex_unlock(&data->lock);
  1012. goto err;
  1013. }
  1014. buffer[i++] = ret;
  1015. }
  1016. mutex_unlock(&data->lock);
  1017. iio_push_to_buffers(indio_dev, buffer);
  1018. err:
  1019. iio_trigger_notify_done(indio_dev->trig);
  1020. return IRQ_HANDLED;
  1021. }
  1022. static const char *kmx61_match_acpi_device(struct device *dev)
  1023. {
  1024. const struct acpi_device_id *id;
  1025. id = acpi_match_device(dev->driver->acpi_match_table, dev);
  1026. if (!id)
  1027. return NULL;
  1028. return dev_name(dev);
  1029. }
  1030. static struct iio_dev *kmx61_indiodev_setup(struct kmx61_data *data,
  1031. const struct iio_info *info,
  1032. const struct iio_chan_spec *chan,
  1033. int num_channels,
  1034. const char *name)
  1035. {
  1036. struct iio_dev *indio_dev;
  1037. indio_dev = devm_iio_device_alloc(&data->client->dev, sizeof(data));
  1038. if (!indio_dev)
  1039. return ERR_PTR(-ENOMEM);
  1040. kmx61_set_data(indio_dev, data);
  1041. indio_dev->channels = chan;
  1042. indio_dev->num_channels = num_channels;
  1043. indio_dev->name = name;
  1044. indio_dev->modes = INDIO_DIRECT_MODE;
  1045. indio_dev->info = info;
  1046. return indio_dev;
  1047. }
  1048. static struct iio_trigger *kmx61_trigger_setup(struct kmx61_data *data,
  1049. struct iio_dev *indio_dev,
  1050. const char *tag)
  1051. {
  1052. struct iio_trigger *trig;
  1053. int ret;
  1054. trig = devm_iio_trigger_alloc(&data->client->dev,
  1055. "%s-%s-dev%d",
  1056. indio_dev->name,
  1057. tag,
  1058. iio_device_id(indio_dev));
  1059. if (!trig)
  1060. return ERR_PTR(-ENOMEM);
  1061. trig->ops = &kmx61_trigger_ops;
  1062. iio_trigger_set_drvdata(trig, indio_dev);
  1063. ret = iio_trigger_register(trig);
  1064. if (ret)
  1065. return ERR_PTR(ret);
  1066. return trig;
  1067. }
  1068. static int kmx61_probe(struct i2c_client *client)
  1069. {
  1070. const struct i2c_device_id *id = i2c_client_get_device_id(client);
  1071. int ret;
  1072. struct kmx61_data *data;
  1073. const char *name = NULL;
  1074. data = devm_kzalloc(&client->dev, sizeof(*data), GFP_KERNEL);
  1075. if (!data)
  1076. return -ENOMEM;
  1077. i2c_set_clientdata(client, data);
  1078. data->client = client;
  1079. mutex_init(&data->lock);
  1080. if (id)
  1081. name = id->name;
  1082. else if (ACPI_HANDLE(&client->dev))
  1083. name = kmx61_match_acpi_device(&client->dev);
  1084. else
  1085. return -ENODEV;
  1086. data->acc_indio_dev =
  1087. kmx61_indiodev_setup(data, &kmx61_acc_info,
  1088. kmx61_acc_channels,
  1089. ARRAY_SIZE(kmx61_acc_channels),
  1090. name);
  1091. if (IS_ERR(data->acc_indio_dev))
  1092. return PTR_ERR(data->acc_indio_dev);
  1093. data->mag_indio_dev =
  1094. kmx61_indiodev_setup(data, &kmx61_mag_info,
  1095. kmx61_mag_channels,
  1096. ARRAY_SIZE(kmx61_mag_channels),
  1097. name);
  1098. if (IS_ERR(data->mag_indio_dev))
  1099. return PTR_ERR(data->mag_indio_dev);
  1100. ret = kmx61_chip_init(data);
  1101. if (ret < 0)
  1102. return ret;
  1103. if (client->irq > 0) {
  1104. ret = devm_request_threaded_irq(&client->dev, client->irq,
  1105. kmx61_data_rdy_trig_poll,
  1106. kmx61_event_handler,
  1107. IRQF_TRIGGER_RISING,
  1108. KMX61_IRQ_NAME,
  1109. data);
  1110. if (ret)
  1111. goto err_chip_uninit;
  1112. data->acc_dready_trig =
  1113. kmx61_trigger_setup(data, data->acc_indio_dev,
  1114. "dready");
  1115. if (IS_ERR(data->acc_dready_trig)) {
  1116. ret = PTR_ERR(data->acc_dready_trig);
  1117. goto err_chip_uninit;
  1118. }
  1119. data->mag_dready_trig =
  1120. kmx61_trigger_setup(data, data->mag_indio_dev,
  1121. "dready");
  1122. if (IS_ERR(data->mag_dready_trig)) {
  1123. ret = PTR_ERR(data->mag_dready_trig);
  1124. goto err_trigger_unregister_acc_dready;
  1125. }
  1126. data->motion_trig =
  1127. kmx61_trigger_setup(data, data->acc_indio_dev,
  1128. "any-motion");
  1129. if (IS_ERR(data->motion_trig)) {
  1130. ret = PTR_ERR(data->motion_trig);
  1131. goto err_trigger_unregister_mag_dready;
  1132. }
  1133. ret = iio_triggered_buffer_setup(data->acc_indio_dev,
  1134. &iio_pollfunc_store_time,
  1135. kmx61_trigger_handler,
  1136. NULL);
  1137. if (ret < 0) {
  1138. dev_err(&data->client->dev,
  1139. "Failed to setup acc triggered buffer\n");
  1140. goto err_trigger_unregister_motion;
  1141. }
  1142. ret = iio_triggered_buffer_setup(data->mag_indio_dev,
  1143. &iio_pollfunc_store_time,
  1144. kmx61_trigger_handler,
  1145. NULL);
  1146. if (ret < 0) {
  1147. dev_err(&data->client->dev,
  1148. "Failed to setup mag triggered buffer\n");
  1149. goto err_buffer_cleanup_acc;
  1150. }
  1151. }
  1152. ret = pm_runtime_set_active(&client->dev);
  1153. if (ret < 0)
  1154. goto err_buffer_cleanup_mag;
  1155. pm_runtime_enable(&client->dev);
  1156. pm_runtime_set_autosuspend_delay(&client->dev, KMX61_SLEEP_DELAY_MS);
  1157. pm_runtime_use_autosuspend(&client->dev);
  1158. ret = iio_device_register(data->acc_indio_dev);
  1159. if (ret < 0) {
  1160. dev_err(&client->dev, "Failed to register acc iio device\n");
  1161. goto err_pm_cleanup;
  1162. }
  1163. ret = iio_device_register(data->mag_indio_dev);
  1164. if (ret < 0) {
  1165. dev_err(&client->dev, "Failed to register mag iio device\n");
  1166. goto err_iio_unregister_acc;
  1167. }
  1168. return 0;
  1169. err_iio_unregister_acc:
  1170. iio_device_unregister(data->acc_indio_dev);
  1171. err_pm_cleanup:
  1172. pm_runtime_dont_use_autosuspend(&client->dev);
  1173. pm_runtime_disable(&client->dev);
  1174. err_buffer_cleanup_mag:
  1175. if (client->irq > 0)
  1176. iio_triggered_buffer_cleanup(data->mag_indio_dev);
  1177. err_buffer_cleanup_acc:
  1178. if (client->irq > 0)
  1179. iio_triggered_buffer_cleanup(data->acc_indio_dev);
  1180. err_trigger_unregister_motion:
  1181. iio_trigger_unregister(data->motion_trig);
  1182. err_trigger_unregister_mag_dready:
  1183. iio_trigger_unregister(data->mag_dready_trig);
  1184. err_trigger_unregister_acc_dready:
  1185. iio_trigger_unregister(data->acc_dready_trig);
  1186. err_chip_uninit:
  1187. kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true);
  1188. return ret;
  1189. }
  1190. static void kmx61_remove(struct i2c_client *client)
  1191. {
  1192. struct kmx61_data *data = i2c_get_clientdata(client);
  1193. iio_device_unregister(data->acc_indio_dev);
  1194. iio_device_unregister(data->mag_indio_dev);
  1195. pm_runtime_disable(&client->dev);
  1196. pm_runtime_set_suspended(&client->dev);
  1197. if (client->irq > 0) {
  1198. iio_triggered_buffer_cleanup(data->acc_indio_dev);
  1199. iio_triggered_buffer_cleanup(data->mag_indio_dev);
  1200. iio_trigger_unregister(data->acc_dready_trig);
  1201. iio_trigger_unregister(data->mag_dready_trig);
  1202. iio_trigger_unregister(data->motion_trig);
  1203. }
  1204. mutex_lock(&data->lock);
  1205. kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true);
  1206. mutex_unlock(&data->lock);
  1207. }
  1208. static int kmx61_suspend(struct device *dev)
  1209. {
  1210. int ret;
  1211. struct kmx61_data *data = i2c_get_clientdata(to_i2c_client(dev));
  1212. mutex_lock(&data->lock);
  1213. ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG,
  1214. false);
  1215. mutex_unlock(&data->lock);
  1216. return ret;
  1217. }
  1218. static int kmx61_resume(struct device *dev)
  1219. {
  1220. u8 stby = 0;
  1221. struct kmx61_data *data = i2c_get_clientdata(to_i2c_client(dev));
  1222. if (data->acc_stby)
  1223. stby |= KMX61_ACC_STBY_BIT;
  1224. if (data->mag_stby)
  1225. stby |= KMX61_MAG_STBY_BIT;
  1226. return kmx61_set_mode(data, stby, KMX61_ACC | KMX61_MAG, true);
  1227. }
  1228. static int kmx61_runtime_suspend(struct device *dev)
  1229. {
  1230. struct kmx61_data *data = i2c_get_clientdata(to_i2c_client(dev));
  1231. int ret;
  1232. mutex_lock(&data->lock);
  1233. ret = kmx61_set_mode(data, KMX61_ALL_STBY, KMX61_ACC | KMX61_MAG, true);
  1234. mutex_unlock(&data->lock);
  1235. return ret;
  1236. }
  1237. static int kmx61_runtime_resume(struct device *dev)
  1238. {
  1239. struct kmx61_data *data = i2c_get_clientdata(to_i2c_client(dev));
  1240. u8 stby = 0;
  1241. if (!data->acc_ps)
  1242. stby |= KMX61_ACC_STBY_BIT;
  1243. if (!data->mag_ps)
  1244. stby |= KMX61_MAG_STBY_BIT;
  1245. return kmx61_set_mode(data, stby, KMX61_ACC | KMX61_MAG, true);
  1246. }
  1247. static const struct dev_pm_ops kmx61_pm_ops = {
  1248. SYSTEM_SLEEP_PM_OPS(kmx61_suspend, kmx61_resume)
  1249. RUNTIME_PM_OPS(kmx61_runtime_suspend, kmx61_runtime_resume, NULL)
  1250. };
  1251. static const struct acpi_device_id kmx61_acpi_match[] = {
  1252. {"KMX61021", 0},
  1253. {}
  1254. };
  1255. MODULE_DEVICE_TABLE(acpi, kmx61_acpi_match);
  1256. static const struct i2c_device_id kmx61_id[] = {
  1257. { "kmx611021" },
  1258. {}
  1259. };
  1260. MODULE_DEVICE_TABLE(i2c, kmx61_id);
  1261. static struct i2c_driver kmx61_driver = {
  1262. .driver = {
  1263. .name = KMX61_DRV_NAME,
  1264. .acpi_match_table = kmx61_acpi_match,
  1265. .pm = pm_ptr(&kmx61_pm_ops),
  1266. },
  1267. .probe = kmx61_probe,
  1268. .remove = kmx61_remove,
  1269. .id_table = kmx61_id,
  1270. };
  1271. module_i2c_driver(kmx61_driver);
  1272. MODULE_AUTHOR("Daniel Baluta <daniel.baluta@intel.com>");
  1273. MODULE_DESCRIPTION("KMX61 accelerometer/magnetometer driver");
  1274. MODULE_LICENSE("GPL v2");