kmx61.c 36 KB

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