msa311.c 36 KB

12345678910111213141516171819202122232425262728293031323334353637383940414243444546474849505152535455565758596061626364656667686970717273747576777879808182838485868788899091929394959697989910010110210310410510610710810911011111211311411511611711811912012112212312412512612712812913013113213313413513613713813914014114214314414514614714814915015115215315415515615715815916016116216316416516616716816917017117217317417517617717817918018118218318418518618718818919019119219319419519619719819920020120220320420520620720820921021121221321421521621721821922022122222322422522622722822923023123223323423523623723823924024124224324424524624724824925025125225325425525625725825926026126226326426526626726826927027127227327427527627727827928028128228328428528628728828929029129229329429529629729829930030130230330430530630730830931031131231331431531631731831932032132232332432532632732832933033133233333433533633733833934034134234334434534634734834935035135235335435535635735835936036136236336436536636736836937037137237337437537637737837938038138238338438538638738838939039139239339439539639739839940040140240340440540640740840941041141241341441541641741841942042142242342442542642742842943043143243343443543643743843944044144244344444544644744844945045145245345445545645745845946046146246346446546646746846947047147247347447547647747847948048148248348448548648748848949049149249349449549649749849950050150250350450550650750850951051151251351451551651751851952052152252352452552652752852953053153253353453553653753853954054154254354454554654754854955055155255355455555655755855956056156256356456556656756856957057157257357457557657757857958058158258358458558658758858959059159259359459559659759859960060160260360460560660760860961061161261361461561661761861962062162262362462562662762862963063163263363463563663763863964064164264364464564664764864965065165265365465565665765865966066166266366466566666766866967067167267367467567667767867968068168268368468568668768868969069169269369469569669769869970070170270370470570670770870971071171271371471571671771871972072172272372472572672772872973073173273373473573673773873974074174274374474574674774874975075175275375475575675775875976076176276376476576676776876977077177277377477577677777877978078178278378478578678778878979079179279379479579679779879980080180280380480580680780880981081181281381481581681781881982082182282382482582682782882983083183283383483583683783883984084184284384484584684784884985085185285385485585685785885986086186286386486586686786886987087187287387487587687787887988088188288388488588688788888989089189289389489589689789889990090190290390490590690790890991091191291391491591691791891992092192292392492592692792892993093193293393493593693793893994094194294394494594694794894995095195295395495595695795895996096196296396496596696796896997097197297397497597697797897998098198298398498598698798898999099199299399499599699799899910001001100210031004100510061007100810091010101110121013101410151016101710181019102010211022102310241025102610271028102910301031103210331034103510361037103810391040104110421043104410451046104710481049105010511052105310541055105610571058105910601061106210631064106510661067106810691070107110721073107410751076107710781079108010811082108310841085108610871088108910901091109210931094109510961097109810991100110111021103110411051106110711081109111011111112111311141115111611171118111911201121112211231124112511261127112811291130113111321133113411351136113711381139114011411142114311441145114611471148114911501151115211531154115511561157115811591160116111621163116411651166116711681169117011711172117311741175117611771178117911801181118211831184118511861187118811891190119111921193119411951196119711981199120012011202120312041205120612071208120912101211121212131214121512161217121812191220122112221223122412251226122712281229123012311232123312341235123612371238123912401241124212431244124512461247124812491250125112521253125412551256125712581259126012611262126312641265126612671268126912701271127212731274127512761277127812791280128112821283128412851286128712881289129012911292129312941295129612971298129913001301130213031304130513061307
  1. // SPDX-License-Identifier: GPL-2.0
  2. /*
  3. * MEMSensing digital 3-Axis accelerometer
  4. *
  5. * MSA311 is a tri-axial, low-g accelerometer with I2C digital output for
  6. * sensitivity consumer applications. It has dynamic user-selectable full
  7. * scales range of +-2g/+-4g/+-8g/+-16g and allows acceleration measurements
  8. * with output data rates from 1Hz to 1000Hz.
  9. *
  10. * MSA311 is available in an ultra small (2mm x 2mm, height 0.95mm) LGA package
  11. * and is guaranteed to operate over -40C to +85C.
  12. *
  13. * This driver supports following MSA311 features:
  14. * - IIO interface
  15. * - Different power modes: NORMAL, SUSPEND
  16. * - ODR (Output Data Rate) selection
  17. * - Scale selection
  18. * - IIO triggered buffer
  19. * - NEW_DATA interrupt + trigger
  20. *
  21. * Below features to be done:
  22. * - Motion Events: ACTIVE, TAP, ORIENT, FREEFALL
  23. * - Low Power mode
  24. *
  25. * Copyright (c) 2022, SberDevices. All Rights Reserved.
  26. *
  27. * Author: Dmitry Rokosov <ddrokosov@sberdevices.ru>
  28. */
  29. #include <linux/i2c.h>
  30. #include <linux/mod_devicetable.h>
  31. #include <linux/module.h>
  32. #include <linux/pm.h>
  33. #include <linux/pm_runtime.h>
  34. #include <linux/regmap.h>
  35. #include <linux/string_choices.h>
  36. #include <linux/units.h>
  37. #include <linux/iio/buffer.h>
  38. #include <linux/iio/iio.h>
  39. #include <linux/iio/sysfs.h>
  40. #include <linux/iio/trigger.h>
  41. #include <linux/iio/trigger_consumer.h>
  42. #include <linux/iio/triggered_buffer.h>
  43. #define MSA311_SOFT_RESET_REG 0x00
  44. #define MSA311_PARTID_REG 0x01
  45. #define MSA311_ACC_X_REG 0x02
  46. #define MSA311_ACC_Y_REG 0x04
  47. #define MSA311_ACC_Z_REG 0x06
  48. #define MSA311_MOTION_INT_REG 0x09
  49. #define MSA311_DATA_INT_REG 0x0A
  50. #define MSA311_TAP_ACTIVE_STS_REG 0x0B
  51. #define MSA311_ORIENT_STS_REG 0x0C
  52. #define MSA311_RANGE_REG 0x0F
  53. #define MSA311_ODR_REG 0x10
  54. #define MSA311_PWR_MODE_REG 0x11
  55. #define MSA311_SWAP_POLARITY_REG 0x12
  56. #define MSA311_INT_SET_0_REG 0x16
  57. #define MSA311_INT_SET_1_REG 0x17
  58. #define MSA311_INT_MAP_0_REG 0x19
  59. #define MSA311_INT_MAP_1_REG 0x1A
  60. #define MSA311_INT_CONFIG_REG 0x20
  61. #define MSA311_INT_LATCH_REG 0x21
  62. #define MSA311_FREEFALL_DUR_REG 0x22
  63. #define MSA311_FREEFALL_TH_REG 0x23
  64. #define MSA311_FREEFALL_HY_REG 0x24
  65. #define MSA311_ACTIVE_DUR_REG 0x27
  66. #define MSA311_ACTIVE_TH_REG 0x28
  67. #define MSA311_TAP_DUR_REG 0x2A
  68. #define MSA311_TAP_TH_REG 0x2B
  69. #define MSA311_ORIENT_HY_REG 0x2C
  70. #define MSA311_Z_BLOCK_REG 0x2D
  71. #define MSA311_OFFSET_X_REG 0x38
  72. #define MSA311_OFFSET_Y_REG 0x39
  73. #define MSA311_OFFSET_Z_REG 0x3A
  74. enum msa311_fields {
  75. /* Soft_Reset */
  76. F_SOFT_RESET_I2C, F_SOFT_RESET_SPI,
  77. /* Motion_Interrupt */
  78. F_ORIENT_INT, F_S_TAP_INT, F_D_TAP_INT, F_ACTIVE_INT, F_FREEFALL_INT,
  79. /* Data_Interrupt */
  80. F_NEW_DATA_INT,
  81. /* Tap_Active_Status */
  82. F_TAP_SIGN, F_TAP_FIRST_X, F_TAP_FIRST_Y, F_TAP_FIRST_Z, F_ACTV_SIGN,
  83. F_ACTV_FIRST_X, F_ACTV_FIRST_Y, F_ACTV_FIRST_Z,
  84. /* Orientation_Status */
  85. F_ORIENT_Z, F_ORIENT_X_Y,
  86. /* Range */
  87. F_FS,
  88. /* ODR */
  89. F_X_AXIS_DIS, F_Y_AXIS_DIS, F_Z_AXIS_DIS, F_ODR,
  90. /* Power Mode/Bandwidth */
  91. F_PWR_MODE, F_LOW_POWER_BW,
  92. /* Swap_Polarity */
  93. F_X_POLARITY, F_Y_POLARITY, F_Z_POLARITY, F_X_Y_SWAP,
  94. /* Int_Set_0 */
  95. F_ORIENT_INT_EN, F_S_TAP_INT_EN, F_D_TAP_INT_EN, F_ACTIVE_INT_EN_Z,
  96. F_ACTIVE_INT_EN_Y, F_ACTIVE_INT_EN_X,
  97. /* Int_Set_1 */
  98. F_NEW_DATA_INT_EN, F_FREEFALL_INT_EN,
  99. /* Int_Map_0 */
  100. F_INT1_ORIENT, F_INT1_S_TAP, F_INT1_D_TAP, F_INT1_ACTIVE,
  101. F_INT1_FREEFALL,
  102. /* Int_Map_1 */
  103. F_INT1_NEW_DATA,
  104. /* Int_Config */
  105. F_INT1_OD, F_INT1_LVL,
  106. /* Int_Latch */
  107. F_RESET_INT, F_LATCH_INT,
  108. /* Freefall_Hy */
  109. F_FREEFALL_MODE, F_FREEFALL_HY,
  110. /* Active_Dur */
  111. F_ACTIVE_DUR,
  112. /* Tap_Dur */
  113. F_TAP_QUIET, F_TAP_SHOCK, F_TAP_DUR,
  114. /* Tap_Th */
  115. F_TAP_TH,
  116. /* Orient_Hy */
  117. F_ORIENT_HYST, F_ORIENT_BLOCKING, F_ORIENT_MODE,
  118. /* Z_Block */
  119. F_Z_BLOCKING,
  120. /* End of register map */
  121. F_MAX_FIELDS,
  122. };
  123. static const struct reg_field msa311_reg_fields[] = {
  124. /* Soft_Reset */
  125. [F_SOFT_RESET_I2C] = REG_FIELD(MSA311_SOFT_RESET_REG, 2, 2),
  126. [F_SOFT_RESET_SPI] = REG_FIELD(MSA311_SOFT_RESET_REG, 5, 5),
  127. /* Motion_Interrupt */
  128. [F_ORIENT_INT] = REG_FIELD(MSA311_MOTION_INT_REG, 6, 6),
  129. [F_S_TAP_INT] = REG_FIELD(MSA311_MOTION_INT_REG, 5, 5),
  130. [F_D_TAP_INT] = REG_FIELD(MSA311_MOTION_INT_REG, 4, 4),
  131. [F_ACTIVE_INT] = REG_FIELD(MSA311_MOTION_INT_REG, 2, 2),
  132. [F_FREEFALL_INT] = REG_FIELD(MSA311_MOTION_INT_REG, 0, 0),
  133. /* Data_Interrupt */
  134. [F_NEW_DATA_INT] = REG_FIELD(MSA311_DATA_INT_REG, 0, 0),
  135. /* Tap_Active_Status */
  136. [F_TAP_SIGN] = REG_FIELD(MSA311_TAP_ACTIVE_STS_REG, 7, 7),
  137. [F_TAP_FIRST_X] = REG_FIELD(MSA311_TAP_ACTIVE_STS_REG, 6, 6),
  138. [F_TAP_FIRST_Y] = REG_FIELD(MSA311_TAP_ACTIVE_STS_REG, 5, 5),
  139. [F_TAP_FIRST_Z] = REG_FIELD(MSA311_TAP_ACTIVE_STS_REG, 4, 4),
  140. [F_ACTV_SIGN] = REG_FIELD(MSA311_TAP_ACTIVE_STS_REG, 3, 3),
  141. [F_ACTV_FIRST_X] = REG_FIELD(MSA311_TAP_ACTIVE_STS_REG, 2, 2),
  142. [F_ACTV_FIRST_Y] = REG_FIELD(MSA311_TAP_ACTIVE_STS_REG, 1, 1),
  143. [F_ACTV_FIRST_Z] = REG_FIELD(MSA311_TAP_ACTIVE_STS_REG, 0, 0),
  144. /* Orientation_Status */
  145. [F_ORIENT_Z] = REG_FIELD(MSA311_ORIENT_STS_REG, 6, 6),
  146. [F_ORIENT_X_Y] = REG_FIELD(MSA311_ORIENT_STS_REG, 4, 5),
  147. /* Range */
  148. [F_FS] = REG_FIELD(MSA311_RANGE_REG, 0, 1),
  149. /* ODR */
  150. [F_X_AXIS_DIS] = REG_FIELD(MSA311_ODR_REG, 7, 7),
  151. [F_Y_AXIS_DIS] = REG_FIELD(MSA311_ODR_REG, 6, 6),
  152. [F_Z_AXIS_DIS] = REG_FIELD(MSA311_ODR_REG, 5, 5),
  153. [F_ODR] = REG_FIELD(MSA311_ODR_REG, 0, 3),
  154. /* Power Mode/Bandwidth */
  155. [F_PWR_MODE] = REG_FIELD(MSA311_PWR_MODE_REG, 6, 7),
  156. [F_LOW_POWER_BW] = REG_FIELD(MSA311_PWR_MODE_REG, 1, 4),
  157. /* Swap_Polarity */
  158. [F_X_POLARITY] = REG_FIELD(MSA311_SWAP_POLARITY_REG, 3, 3),
  159. [F_Y_POLARITY] = REG_FIELD(MSA311_SWAP_POLARITY_REG, 2, 2),
  160. [F_Z_POLARITY] = REG_FIELD(MSA311_SWAP_POLARITY_REG, 1, 1),
  161. [F_X_Y_SWAP] = REG_FIELD(MSA311_SWAP_POLARITY_REG, 0, 0),
  162. /* Int_Set_0 */
  163. [F_ORIENT_INT_EN] = REG_FIELD(MSA311_INT_SET_0_REG, 6, 6),
  164. [F_S_TAP_INT_EN] = REG_FIELD(MSA311_INT_SET_0_REG, 5, 5),
  165. [F_D_TAP_INT_EN] = REG_FIELD(MSA311_INT_SET_0_REG, 4, 4),
  166. [F_ACTIVE_INT_EN_Z] = REG_FIELD(MSA311_INT_SET_0_REG, 2, 2),
  167. [F_ACTIVE_INT_EN_Y] = REG_FIELD(MSA311_INT_SET_0_REG, 1, 1),
  168. [F_ACTIVE_INT_EN_X] = REG_FIELD(MSA311_INT_SET_0_REG, 0, 0),
  169. /* Int_Set_1 */
  170. [F_NEW_DATA_INT_EN] = REG_FIELD(MSA311_INT_SET_1_REG, 4, 4),
  171. [F_FREEFALL_INT_EN] = REG_FIELD(MSA311_INT_SET_1_REG, 3, 3),
  172. /* Int_Map_0 */
  173. [F_INT1_ORIENT] = REG_FIELD(MSA311_INT_MAP_0_REG, 6, 6),
  174. [F_INT1_S_TAP] = REG_FIELD(MSA311_INT_MAP_0_REG, 5, 5),
  175. [F_INT1_D_TAP] = REG_FIELD(MSA311_INT_MAP_0_REG, 4, 4),
  176. [F_INT1_ACTIVE] = REG_FIELD(MSA311_INT_MAP_0_REG, 2, 2),
  177. [F_INT1_FREEFALL] = REG_FIELD(MSA311_INT_MAP_0_REG, 0, 0),
  178. /* Int_Map_1 */
  179. [F_INT1_NEW_DATA] = REG_FIELD(MSA311_INT_MAP_1_REG, 0, 0),
  180. /* Int_Config */
  181. [F_INT1_OD] = REG_FIELD(MSA311_INT_CONFIG_REG, 1, 1),
  182. [F_INT1_LVL] = REG_FIELD(MSA311_INT_CONFIG_REG, 0, 0),
  183. /* Int_Latch */
  184. [F_RESET_INT] = REG_FIELD(MSA311_INT_LATCH_REG, 7, 7),
  185. [F_LATCH_INT] = REG_FIELD(MSA311_INT_LATCH_REG, 0, 3),
  186. /* Freefall_Hy */
  187. [F_FREEFALL_MODE] = REG_FIELD(MSA311_FREEFALL_HY_REG, 2, 2),
  188. [F_FREEFALL_HY] = REG_FIELD(MSA311_FREEFALL_HY_REG, 0, 1),
  189. /* Active_Dur */
  190. [F_ACTIVE_DUR] = REG_FIELD(MSA311_ACTIVE_DUR_REG, 0, 1),
  191. /* Tap_Dur */
  192. [F_TAP_QUIET] = REG_FIELD(MSA311_TAP_DUR_REG, 7, 7),
  193. [F_TAP_SHOCK] = REG_FIELD(MSA311_TAP_DUR_REG, 6, 6),
  194. [F_TAP_DUR] = REG_FIELD(MSA311_TAP_DUR_REG, 0, 2),
  195. /* Tap_Th */
  196. [F_TAP_TH] = REG_FIELD(MSA311_TAP_TH_REG, 0, 4),
  197. /* Orient_Hy */
  198. [F_ORIENT_HYST] = REG_FIELD(MSA311_ORIENT_HY_REG, 4, 6),
  199. [F_ORIENT_BLOCKING] = REG_FIELD(MSA311_ORIENT_HY_REG, 2, 3),
  200. [F_ORIENT_MODE] = REG_FIELD(MSA311_ORIENT_HY_REG, 0, 1),
  201. /* Z_Block */
  202. [F_Z_BLOCKING] = REG_FIELD(MSA311_Z_BLOCK_REG, 0, 3),
  203. };
  204. #define MSA311_WHO_AM_I 0x13
  205. /*
  206. * Possible Full Scale ranges
  207. *
  208. * Axis data is 12-bit signed value, so
  209. *
  210. * fs0 = (2 + 2) * 9.81 / (2^11) = 0.009580
  211. * fs1 = (4 + 4) * 9.81 / (2^11) = 0.019160
  212. * fs2 = (8 + 8) * 9.81 / (2^11) = 0.038320
  213. * fs3 = (16 + 16) * 9.81 / (2^11) = 0.076641
  214. */
  215. enum {
  216. MSA311_FS_2G,
  217. MSA311_FS_4G,
  218. MSA311_FS_8G,
  219. MSA311_FS_16G,
  220. };
  221. struct iio_decimal_fract {
  222. int integral;
  223. int microfract;
  224. };
  225. static const struct iio_decimal_fract msa311_fs_table[] = {
  226. {0, 9580}, {0, 19160}, {0, 38320}, {0, 76641},
  227. };
  228. /* Possible Output Data Rate values */
  229. enum {
  230. MSA311_ODR_1_HZ,
  231. MSA311_ODR_1_95_HZ,
  232. MSA311_ODR_3_9_HZ,
  233. MSA311_ODR_7_81_HZ,
  234. MSA311_ODR_15_63_HZ,
  235. MSA311_ODR_31_25_HZ,
  236. MSA311_ODR_62_5_HZ,
  237. MSA311_ODR_125_HZ,
  238. MSA311_ODR_250_HZ,
  239. MSA311_ODR_500_HZ,
  240. MSA311_ODR_1000_HZ,
  241. };
  242. static const struct iio_decimal_fract msa311_odr_table[] = {
  243. {1, 0}, {1, 950000}, {3, 900000}, {7, 810000}, {15, 630000},
  244. {31, 250000}, {62, 500000}, {125, 0}, {250, 0}, {500, 0}, {1000, 0},
  245. };
  246. /* All supported power modes */
  247. #define MSA311_PWR_MODE_NORMAL 0b00
  248. #define MSA311_PWR_MODE_LOW 0b01
  249. #define MSA311_PWR_MODE_UNKNOWN 0b10
  250. #define MSA311_PWR_MODE_SUSPEND 0b11
  251. static const char * const msa311_pwr_modes[] = {
  252. [MSA311_PWR_MODE_NORMAL] = "normal",
  253. [MSA311_PWR_MODE_LOW] = "low",
  254. [MSA311_PWR_MODE_UNKNOWN] = "unknown",
  255. [MSA311_PWR_MODE_SUSPEND] = "suspend",
  256. };
  257. /* Autosuspend delay */
  258. #define MSA311_PWR_SLEEP_DELAY_MS 2000
  259. /* Possible INT1 types and levels */
  260. enum {
  261. MSA311_INT1_OD_PUSH_PULL,
  262. MSA311_INT1_OD_OPEN_DRAIN,
  263. };
  264. enum {
  265. MSA311_INT1_LVL_LOW,
  266. MSA311_INT1_LVL_HIGH,
  267. };
  268. /* Latch INT modes */
  269. #define MSA311_LATCH_INT_NOT_LATCHED 0b0000
  270. #define MSA311_LATCH_INT_250MS 0b0001
  271. #define MSA311_LATCH_INT_500MS 0b0010
  272. #define MSA311_LATCH_INT_1S 0b0011
  273. #define MSA311_LATCH_INT_2S 0b0100
  274. #define MSA311_LATCH_INT_4S 0b0101
  275. #define MSA311_LATCH_INT_8S 0b0110
  276. #define MSA311_LATCH_INT_1MS 0b1010
  277. #define MSA311_LATCH_INT_2MS 0b1011
  278. #define MSA311_LATCH_INT_25MS 0b1100
  279. #define MSA311_LATCH_INT_50MS 0b1101
  280. #define MSA311_LATCH_INT_100MS 0b1110
  281. #define MSA311_LATCH_INT_LATCHED 0b0111
  282. static const struct regmap_range msa311_readonly_registers[] = {
  283. regmap_reg_range(MSA311_PARTID_REG, MSA311_ORIENT_STS_REG),
  284. };
  285. static const struct regmap_access_table msa311_writeable_table = {
  286. .no_ranges = msa311_readonly_registers,
  287. .n_no_ranges = ARRAY_SIZE(msa311_readonly_registers),
  288. };
  289. static const struct regmap_range msa311_writeonly_registers[] = {
  290. regmap_reg_range(MSA311_SOFT_RESET_REG, MSA311_SOFT_RESET_REG),
  291. };
  292. static const struct regmap_access_table msa311_readable_table = {
  293. .no_ranges = msa311_writeonly_registers,
  294. .n_no_ranges = ARRAY_SIZE(msa311_writeonly_registers),
  295. };
  296. static const struct regmap_range msa311_volatile_registers[] = {
  297. regmap_reg_range(MSA311_ACC_X_REG, MSA311_ORIENT_STS_REG),
  298. };
  299. static const struct regmap_access_table msa311_volatile_table = {
  300. .yes_ranges = msa311_volatile_registers,
  301. .n_yes_ranges = ARRAY_SIZE(msa311_volatile_registers),
  302. };
  303. static const struct regmap_config msa311_regmap_config = {
  304. .name = "msa311",
  305. .reg_bits = 8,
  306. .val_bits = 8,
  307. .max_register = MSA311_OFFSET_Z_REG,
  308. .wr_table = &msa311_writeable_table,
  309. .rd_table = &msa311_readable_table,
  310. .volatile_table = &msa311_volatile_table,
  311. .cache_type = REGCACHE_RBTREE,
  312. };
  313. #define MSA311_GENMASK(field) ({ \
  314. typeof(&(msa311_reg_fields)[0]) _field; \
  315. _field = &msa311_reg_fields[(field)]; \
  316. GENMASK(_field->msb, _field->lsb); \
  317. })
  318. /**
  319. * struct msa311_priv - MSA311 internal private state
  320. * @regs: Underlying I2C bus adapter used to abstract slave
  321. * register accesses
  322. * @fields: Abstract objects for each registers fields access
  323. * @dev: Device handler associated with appropriate bus client
  324. * @lock: Protects msa311 device state between setup and data access routines
  325. * (power transitions, samp_freq/scale tune, retrieving axes data, etc)
  326. * @chip_name: Chip name in the format "msa311-%02x" % partid
  327. * @new_data_trig: Optional NEW_DATA interrupt driven trigger used
  328. * to notify external consumers a new sample is ready
  329. */
  330. struct msa311_priv {
  331. struct regmap *regs;
  332. struct regmap_field *fields[F_MAX_FIELDS];
  333. struct device *dev;
  334. struct mutex lock;
  335. char *chip_name;
  336. struct iio_trigger *new_data_trig;
  337. };
  338. enum msa311_si {
  339. MSA311_SI_X,
  340. MSA311_SI_Y,
  341. MSA311_SI_Z,
  342. MSA311_SI_TIMESTAMP,
  343. };
  344. #define MSA311_ACCEL_CHANNEL(axis) { \
  345. .type = IIO_ACCEL, \
  346. .modified = 1, \
  347. .channel2 = IIO_MOD_##axis, \
  348. .info_mask_separate = BIT(IIO_CHAN_INFO_RAW), \
  349. .info_mask_shared_by_type = BIT(IIO_CHAN_INFO_SCALE) | \
  350. BIT(IIO_CHAN_INFO_SAMP_FREQ), \
  351. .info_mask_shared_by_type_available = BIT(IIO_CHAN_INFO_SCALE) | \
  352. BIT(IIO_CHAN_INFO_SAMP_FREQ), \
  353. .scan_index = MSA311_SI_##axis, \
  354. .scan_type = { \
  355. .sign = 's', \
  356. .realbits = 12, \
  357. .storagebits = 16, \
  358. .shift = 4, \
  359. .endianness = IIO_LE, \
  360. }, \
  361. .datasheet_name = "ACC_"#axis, \
  362. }
  363. static const struct iio_chan_spec msa311_channels[] = {
  364. MSA311_ACCEL_CHANNEL(X),
  365. MSA311_ACCEL_CHANNEL(Y),
  366. MSA311_ACCEL_CHANNEL(Z),
  367. IIO_CHAN_SOFT_TIMESTAMP(MSA311_SI_TIMESTAMP),
  368. };
  369. /**
  370. * msa311_get_odr() - Read Output Data Rate (ODR) value from MSA311 accel
  371. * @msa311: MSA311 internal private state
  372. * @odr: output ODR value
  373. *
  374. * This function should be called under msa311->lock.
  375. *
  376. * Return: 0 on success, -ERRNO in other failures
  377. */
  378. static int msa311_get_odr(struct msa311_priv *msa311, unsigned int *odr)
  379. {
  380. int err;
  381. err = regmap_field_read(msa311->fields[F_ODR], odr);
  382. if (err)
  383. return err;
  384. /*
  385. * Filter the same 1000Hz ODR register values based on datasheet info.
  386. * ODR can be equal to 1010-1111 for 1000Hz, but function returns 1010
  387. * all the time.
  388. */
  389. if (*odr > MSA311_ODR_1000_HZ)
  390. *odr = MSA311_ODR_1000_HZ;
  391. return 0;
  392. }
  393. /**
  394. * msa311_set_odr() - Setup Output Data Rate (ODR) value for MSA311 accel
  395. * @msa311: MSA311 internal private state
  396. * @odr: requested ODR value
  397. *
  398. * This function should be called under msa311->lock. Possible ODR values:
  399. * - 1Hz (not available in normal mode)
  400. * - 1.95Hz (not available in normal mode)
  401. * - 3.9Hz
  402. * - 7.81Hz
  403. * - 15.63Hz
  404. * - 31.25Hz
  405. * - 62.5Hz
  406. * - 125Hz
  407. * - 250Hz
  408. * - 500Hz
  409. * - 1000Hz
  410. *
  411. * Return: 0 on success, -EINVAL for bad ODR value in the certain power mode,
  412. * -ERRNO in other failures
  413. */
  414. static int msa311_set_odr(struct msa311_priv *msa311, unsigned int odr)
  415. {
  416. struct device *dev = msa311->dev;
  417. unsigned int pwr_mode;
  418. bool good_odr;
  419. int err;
  420. err = regmap_field_read(msa311->fields[F_PWR_MODE], &pwr_mode);
  421. if (err)
  422. return err;
  423. /* Filter bad ODR values */
  424. if (pwr_mode == MSA311_PWR_MODE_NORMAL)
  425. good_odr = (odr > MSA311_ODR_1_95_HZ);
  426. else
  427. good_odr = false;
  428. if (!good_odr) {
  429. dev_err(dev,
  430. "can't set odr %u.%06uHz, not available in %s mode\n",
  431. msa311_odr_table[odr].integral,
  432. msa311_odr_table[odr].microfract,
  433. msa311_pwr_modes[pwr_mode]);
  434. return -EINVAL;
  435. }
  436. return regmap_field_write(msa311->fields[F_ODR], odr);
  437. }
  438. /**
  439. * msa311_wait_for_next_data() - Wait next accel data available after resume
  440. * @msa311: MSA311 internal private state
  441. *
  442. * Return: 0 on success, -EINTR if msleep() was interrupted,
  443. * -ERRNO in other failures
  444. */
  445. static int msa311_wait_for_next_data(struct msa311_priv *msa311)
  446. {
  447. static const unsigned int unintr_thresh_ms = 20;
  448. struct device *dev = msa311->dev;
  449. unsigned long freq_uhz;
  450. unsigned long wait_ms;
  451. unsigned int odr;
  452. int err;
  453. err = msa311_get_odr(msa311, &odr);
  454. if (err) {
  455. dev_err(dev, "can't get actual frequency (%pe)\n",
  456. ERR_PTR(err));
  457. return err;
  458. }
  459. /*
  460. * After msa311 resuming is done, we need to wait for data
  461. * to be refreshed by accel logic.
  462. * A certain timeout is calculated based on the current ODR value.
  463. * If requested timeout isn't so long (let's assume 20ms),
  464. * we can wait for next data in uninterruptible sleep.
  465. */
  466. freq_uhz = msa311_odr_table[odr].integral * MICROHZ_PER_HZ +
  467. msa311_odr_table[odr].microfract;
  468. wait_ms = (MICROHZ_PER_HZ / freq_uhz) * MSEC_PER_SEC;
  469. if (wait_ms < unintr_thresh_ms)
  470. usleep_range(wait_ms * USEC_PER_MSEC,
  471. unintr_thresh_ms * USEC_PER_MSEC);
  472. else if (msleep_interruptible(wait_ms))
  473. return -EINTR;
  474. return 0;
  475. }
  476. /**
  477. * msa311_set_pwr_mode() - Install certain MSA311 power mode
  478. * @msa311: MSA311 internal private state
  479. * @mode: Power mode can be equal to NORMAL or SUSPEND
  480. *
  481. * This function should be called under msa311->lock.
  482. *
  483. * Return: 0 on success, -ERRNO on failure
  484. */
  485. static int msa311_set_pwr_mode(struct msa311_priv *msa311, unsigned int mode)
  486. {
  487. struct device *dev = msa311->dev;
  488. unsigned int prev_mode;
  489. int err;
  490. if (mode >= ARRAY_SIZE(msa311_pwr_modes))
  491. return -EINVAL;
  492. dev_dbg(dev, "transition to %s mode\n", msa311_pwr_modes[mode]);
  493. err = regmap_field_read(msa311->fields[F_PWR_MODE], &prev_mode);
  494. if (err)
  495. return err;
  496. err = regmap_field_write(msa311->fields[F_PWR_MODE], mode);
  497. if (err)
  498. return err;
  499. /* Wait actual data if we wake up */
  500. if (prev_mode == MSA311_PWR_MODE_SUSPEND &&
  501. mode == MSA311_PWR_MODE_NORMAL)
  502. return msa311_wait_for_next_data(msa311);
  503. return 0;
  504. }
  505. /**
  506. * msa311_get_axis() - Read MSA311 accel data for certain IIO channel axis spec
  507. * @msa311: MSA311 internal private state
  508. * @chan: IIO channel specification
  509. * @axis: Output accel axis data for requested IIO channel spec
  510. *
  511. * This function should be called under msa311->lock.
  512. *
  513. * Return: 0 on success, -EINVAL for unknown IIO channel specification,
  514. * -ERRNO in other failures
  515. */
  516. static int msa311_get_axis(struct msa311_priv *msa311,
  517. const struct iio_chan_spec * const chan,
  518. __le16 *axis)
  519. {
  520. struct device *dev = msa311->dev;
  521. unsigned int axis_reg;
  522. if (chan->scan_index < MSA311_SI_X || chan->scan_index > MSA311_SI_Z) {
  523. dev_err(dev, "invalid scan_index value [%d]\n",
  524. chan->scan_index);
  525. return -EINVAL;
  526. }
  527. /* Axes data layout has 2 byte gap for each axis starting from X axis */
  528. axis_reg = MSA311_ACC_X_REG + (chan->scan_index << 1);
  529. return regmap_bulk_read(msa311->regs, axis_reg, axis, sizeof(*axis));
  530. }
  531. static int msa311_read_raw_data(struct iio_dev *indio_dev,
  532. struct iio_chan_spec const *chan,
  533. int *val, int *val2)
  534. {
  535. struct msa311_priv *msa311 = iio_priv(indio_dev);
  536. struct device *dev = msa311->dev;
  537. __le16 axis;
  538. int err;
  539. err = iio_device_claim_direct_mode(indio_dev);
  540. if (err)
  541. return err;
  542. err = pm_runtime_resume_and_get(dev);
  543. if (err) {
  544. iio_device_release_direct_mode(indio_dev);
  545. return err;
  546. }
  547. mutex_lock(&msa311->lock);
  548. err = msa311_get_axis(msa311, chan, &axis);
  549. mutex_unlock(&msa311->lock);
  550. pm_runtime_mark_last_busy(dev);
  551. pm_runtime_put_autosuspend(dev);
  552. iio_device_release_direct_mode(indio_dev);
  553. if (err) {
  554. dev_err(dev, "can't get axis %s (%pe)\n",
  555. chan->datasheet_name, ERR_PTR(err));
  556. return err;
  557. }
  558. /*
  559. * Axis data format is:
  560. * ACC_X = (ACC_X_MSB[7:0] << 4) | ACC_X_LSB[7:4]
  561. */
  562. *val = sign_extend32(le16_to_cpu(axis) >> chan->scan_type.shift,
  563. chan->scan_type.realbits - 1);
  564. return IIO_VAL_INT;
  565. }
  566. static int msa311_read_scale(struct iio_dev *indio_dev, int *val, int *val2)
  567. {
  568. struct msa311_priv *msa311 = iio_priv(indio_dev);
  569. struct device *dev = msa311->dev;
  570. unsigned int fs;
  571. int err;
  572. mutex_lock(&msa311->lock);
  573. err = regmap_field_read(msa311->fields[F_FS], &fs);
  574. mutex_unlock(&msa311->lock);
  575. if (err) {
  576. dev_err(dev, "can't get actual scale (%pe)\n", ERR_PTR(err));
  577. return err;
  578. }
  579. *val = msa311_fs_table[fs].integral;
  580. *val2 = msa311_fs_table[fs].microfract;
  581. return IIO_VAL_INT_PLUS_MICRO;
  582. }
  583. static int msa311_read_samp_freq(struct iio_dev *indio_dev,
  584. int *val, int *val2)
  585. {
  586. struct msa311_priv *msa311 = iio_priv(indio_dev);
  587. struct device *dev = msa311->dev;
  588. unsigned int odr;
  589. int err;
  590. mutex_lock(&msa311->lock);
  591. err = msa311_get_odr(msa311, &odr);
  592. mutex_unlock(&msa311->lock);
  593. if (err) {
  594. dev_err(dev, "can't get actual frequency (%pe)\n",
  595. ERR_PTR(err));
  596. return err;
  597. }
  598. *val = msa311_odr_table[odr].integral;
  599. *val2 = msa311_odr_table[odr].microfract;
  600. return IIO_VAL_INT_PLUS_MICRO;
  601. }
  602. static int msa311_read_raw(struct iio_dev *indio_dev,
  603. struct iio_chan_spec const *chan,
  604. int *val, int *val2, long mask)
  605. {
  606. switch (mask) {
  607. case IIO_CHAN_INFO_RAW:
  608. return msa311_read_raw_data(indio_dev, chan, val, val2);
  609. case IIO_CHAN_INFO_SCALE:
  610. return msa311_read_scale(indio_dev, val, val2);
  611. case IIO_CHAN_INFO_SAMP_FREQ:
  612. return msa311_read_samp_freq(indio_dev, val, val2);
  613. default:
  614. return -EINVAL;
  615. }
  616. }
  617. static int msa311_read_avail(struct iio_dev *indio_dev,
  618. struct iio_chan_spec const *chan,
  619. const int **vals, int *type,
  620. int *length, long mask)
  621. {
  622. switch (mask) {
  623. case IIO_CHAN_INFO_SAMP_FREQ:
  624. *vals = (int *)msa311_odr_table;
  625. *type = IIO_VAL_INT_PLUS_MICRO;
  626. /* ODR value has 2 ints (integer and fractional parts) */
  627. *length = ARRAY_SIZE(msa311_odr_table) * 2;
  628. return IIO_AVAIL_LIST;
  629. case IIO_CHAN_INFO_SCALE:
  630. *vals = (int *)msa311_fs_table;
  631. *type = IIO_VAL_INT_PLUS_MICRO;
  632. /* FS value has 2 ints (integer and fractional parts) */
  633. *length = ARRAY_SIZE(msa311_fs_table) * 2;
  634. return IIO_AVAIL_LIST;
  635. default:
  636. return -EINVAL;
  637. }
  638. }
  639. static int msa311_write_scale(struct iio_dev *indio_dev, int val, int val2)
  640. {
  641. struct msa311_priv *msa311 = iio_priv(indio_dev);
  642. struct device *dev = msa311->dev;
  643. unsigned int fs;
  644. int err;
  645. /* We do not have fs >= 1, so skip such values */
  646. if (val)
  647. return 0;
  648. err = pm_runtime_resume_and_get(dev);
  649. if (err)
  650. return err;
  651. err = -EINVAL;
  652. for (fs = 0; fs < ARRAY_SIZE(msa311_fs_table); fs++)
  653. /* Do not check msa311_fs_table[fs].integral, it's always 0 */
  654. if (val2 == msa311_fs_table[fs].microfract) {
  655. mutex_lock(&msa311->lock);
  656. err = regmap_field_write(msa311->fields[F_FS], fs);
  657. mutex_unlock(&msa311->lock);
  658. break;
  659. }
  660. pm_runtime_mark_last_busy(dev);
  661. pm_runtime_put_autosuspend(dev);
  662. if (err)
  663. dev_err(dev, "can't update scale (%pe)\n", ERR_PTR(err));
  664. return err;
  665. }
  666. static int msa311_write_samp_freq(struct iio_dev *indio_dev, int val, int val2)
  667. {
  668. struct msa311_priv *msa311 = iio_priv(indio_dev);
  669. struct device *dev = msa311->dev;
  670. unsigned int odr;
  671. int err;
  672. /*
  673. * Sampling frequency changing is prohibited when buffer mode is
  674. * enabled, because sometimes MSA311 chip returns outliers during
  675. * frequency values growing up in the read operation moment.
  676. */
  677. err = iio_device_claim_direct_mode(indio_dev);
  678. if (err)
  679. return err;
  680. err = pm_runtime_resume_and_get(dev);
  681. if (err) {
  682. iio_device_release_direct_mode(indio_dev);
  683. return err;
  684. }
  685. err = -EINVAL;
  686. for (odr = 0; odr < ARRAY_SIZE(msa311_odr_table); odr++)
  687. if (val == msa311_odr_table[odr].integral &&
  688. val2 == msa311_odr_table[odr].microfract) {
  689. mutex_lock(&msa311->lock);
  690. err = msa311_set_odr(msa311, odr);
  691. mutex_unlock(&msa311->lock);
  692. break;
  693. }
  694. pm_runtime_mark_last_busy(dev);
  695. pm_runtime_put_autosuspend(dev);
  696. iio_device_release_direct_mode(indio_dev);
  697. if (err)
  698. dev_err(dev, "can't update frequency (%pe)\n", ERR_PTR(err));
  699. return err;
  700. }
  701. static int msa311_write_raw(struct iio_dev *indio_dev,
  702. struct iio_chan_spec const *chan,
  703. int val, int val2, long mask)
  704. {
  705. switch (mask) {
  706. case IIO_CHAN_INFO_SCALE:
  707. return msa311_write_scale(indio_dev, val, val2);
  708. case IIO_CHAN_INFO_SAMP_FREQ:
  709. return msa311_write_samp_freq(indio_dev, val, val2);
  710. default:
  711. return -EINVAL;
  712. }
  713. }
  714. static int msa311_debugfs_reg_access(struct iio_dev *indio_dev,
  715. unsigned int reg, unsigned int writeval,
  716. unsigned int *readval)
  717. {
  718. struct msa311_priv *msa311 = iio_priv(indio_dev);
  719. struct device *dev = msa311->dev;
  720. int err;
  721. if (reg > regmap_get_max_register(msa311->regs))
  722. return -EINVAL;
  723. err = pm_runtime_resume_and_get(dev);
  724. if (err)
  725. return err;
  726. mutex_lock(&msa311->lock);
  727. if (readval)
  728. err = regmap_read(msa311->regs, reg, readval);
  729. else
  730. err = regmap_write(msa311->regs, reg, writeval);
  731. mutex_unlock(&msa311->lock);
  732. pm_runtime_mark_last_busy(dev);
  733. pm_runtime_put_autosuspend(dev);
  734. if (err)
  735. dev_err(dev, "can't %s register %u from debugfs (%pe)\n",
  736. str_read_write(readval), reg, ERR_PTR(err));
  737. return err;
  738. }
  739. static int msa311_buffer_preenable(struct iio_dev *indio_dev)
  740. {
  741. struct msa311_priv *msa311 = iio_priv(indio_dev);
  742. struct device *dev = msa311->dev;
  743. return pm_runtime_resume_and_get(dev);
  744. }
  745. static int msa311_buffer_postdisable(struct iio_dev *indio_dev)
  746. {
  747. struct msa311_priv *msa311 = iio_priv(indio_dev);
  748. struct device *dev = msa311->dev;
  749. pm_runtime_mark_last_busy(dev);
  750. pm_runtime_put_autosuspend(dev);
  751. return 0;
  752. }
  753. static int msa311_set_new_data_trig_state(struct iio_trigger *trig, bool state)
  754. {
  755. struct iio_dev *indio_dev = iio_trigger_get_drvdata(trig);
  756. struct msa311_priv *msa311 = iio_priv(indio_dev);
  757. struct device *dev = msa311->dev;
  758. int err;
  759. mutex_lock(&msa311->lock);
  760. err = regmap_field_write(msa311->fields[F_NEW_DATA_INT_EN], state);
  761. mutex_unlock(&msa311->lock);
  762. if (err)
  763. dev_err(dev,
  764. "can't %s buffer due to new_data_int failure (%pe)\n",
  765. str_enable_disable(state), ERR_PTR(err));
  766. return err;
  767. }
  768. static int msa311_validate_device(struct iio_trigger *trig,
  769. struct iio_dev *indio_dev)
  770. {
  771. return iio_trigger_get_drvdata(trig) == indio_dev ? 0 : -EINVAL;
  772. }
  773. static irqreturn_t msa311_buffer_thread(int irq, void *p)
  774. {
  775. struct iio_poll_func *pf = p;
  776. struct msa311_priv *msa311 = iio_priv(pf->indio_dev);
  777. struct iio_dev *indio_dev = pf->indio_dev;
  778. const struct iio_chan_spec *chan;
  779. struct device *dev = msa311->dev;
  780. int bit, err, i = 0;
  781. __le16 axis;
  782. struct {
  783. __le16 channels[MSA311_SI_Z + 1];
  784. s64 ts __aligned(8);
  785. } buf;
  786. memset(&buf, 0, sizeof(buf));
  787. mutex_lock(&msa311->lock);
  788. iio_for_each_active_channel(indio_dev, bit) {
  789. chan = &msa311_channels[bit];
  790. err = msa311_get_axis(msa311, chan, &axis);
  791. if (err) {
  792. mutex_unlock(&msa311->lock);
  793. dev_err(dev, "can't get axis %s (%pe)\n",
  794. chan->datasheet_name, ERR_PTR(err));
  795. goto notify_done;
  796. }
  797. buf.channels[i++] = axis;
  798. }
  799. mutex_unlock(&msa311->lock);
  800. iio_push_to_buffers_with_timestamp(indio_dev, &buf,
  801. iio_get_time_ns(indio_dev));
  802. notify_done:
  803. iio_trigger_notify_done(indio_dev->trig);
  804. return IRQ_HANDLED;
  805. }
  806. static irqreturn_t msa311_irq_thread(int irq, void *p)
  807. {
  808. struct msa311_priv *msa311 = iio_priv(p);
  809. unsigned int new_data_int_enabled;
  810. struct device *dev = msa311->dev;
  811. int err;
  812. mutex_lock(&msa311->lock);
  813. /*
  814. * We do not check NEW_DATA int status, because based on the
  815. * specification it's cleared automatically after a fixed time.
  816. * So just check that is enabled by driver logic.
  817. */
  818. err = regmap_field_read(msa311->fields[F_NEW_DATA_INT_EN],
  819. &new_data_int_enabled);
  820. mutex_unlock(&msa311->lock);
  821. if (err) {
  822. dev_err(dev, "can't read new_data interrupt state (%pe)\n",
  823. ERR_PTR(err));
  824. return IRQ_NONE;
  825. }
  826. if (new_data_int_enabled)
  827. iio_trigger_poll_nested(msa311->new_data_trig);
  828. return IRQ_HANDLED;
  829. }
  830. static const struct iio_info msa311_info = {
  831. .read_raw = msa311_read_raw,
  832. .read_avail = msa311_read_avail,
  833. .write_raw = msa311_write_raw,
  834. .debugfs_reg_access = msa311_debugfs_reg_access,
  835. };
  836. static const struct iio_buffer_setup_ops msa311_buffer_setup_ops = {
  837. .preenable = msa311_buffer_preenable,
  838. .postdisable = msa311_buffer_postdisable,
  839. };
  840. static const struct iio_trigger_ops msa311_new_data_trig_ops = {
  841. .set_trigger_state = msa311_set_new_data_trig_state,
  842. .validate_device = msa311_validate_device,
  843. };
  844. static int msa311_check_partid(struct msa311_priv *msa311)
  845. {
  846. struct device *dev = msa311->dev;
  847. unsigned int partid;
  848. int err;
  849. err = regmap_read(msa311->regs, MSA311_PARTID_REG, &partid);
  850. if (err)
  851. return dev_err_probe(dev, err, "failed to read partid\n");
  852. if (partid != MSA311_WHO_AM_I)
  853. dev_warn(dev, "invalid partid (%#x), expected (%#x)\n",
  854. partid, MSA311_WHO_AM_I);
  855. msa311->chip_name = devm_kasprintf(dev, GFP_KERNEL,
  856. "msa311-%02x", partid);
  857. if (!msa311->chip_name)
  858. return dev_err_probe(dev, -ENOMEM, "can't alloc chip name\n");
  859. return 0;
  860. }
  861. static int msa311_soft_reset(struct msa311_priv *msa311)
  862. {
  863. struct device *dev = msa311->dev;
  864. int err;
  865. err = regmap_write(msa311->regs, MSA311_SOFT_RESET_REG,
  866. MSA311_GENMASK(F_SOFT_RESET_I2C) |
  867. MSA311_GENMASK(F_SOFT_RESET_SPI));
  868. if (err)
  869. return dev_err_probe(dev, err, "can't soft reset all logic\n");
  870. return 0;
  871. }
  872. static int msa311_chip_init(struct msa311_priv *msa311)
  873. {
  874. struct device *dev = msa311->dev;
  875. const char zero_bulk[2] = { };
  876. int err;
  877. err = regmap_write(msa311->regs, MSA311_RANGE_REG, MSA311_FS_16G);
  878. if (err)
  879. return dev_err_probe(dev, err, "failed to setup accel range\n");
  880. /* Disable all interrupts by default */
  881. err = regmap_bulk_write(msa311->regs, MSA311_INT_SET_0_REG,
  882. zero_bulk, sizeof(zero_bulk));
  883. if (err)
  884. return dev_err_probe(dev, err,
  885. "can't disable set0/set1 interrupts\n");
  886. /* Unmap all INT1 interrupts by default */
  887. err = regmap_bulk_write(msa311->regs, MSA311_INT_MAP_0_REG,
  888. zero_bulk, sizeof(zero_bulk));
  889. if (err)
  890. return dev_err_probe(dev, err,
  891. "failed to unmap map0/map1 interrupts\n");
  892. /* Disable all axes by default */
  893. err = regmap_clear_bits(msa311->regs, MSA311_ODR_REG,
  894. MSA311_GENMASK(F_X_AXIS_DIS) |
  895. MSA311_GENMASK(F_Y_AXIS_DIS) |
  896. MSA311_GENMASK(F_Z_AXIS_DIS));
  897. if (err)
  898. return dev_err_probe(dev, err, "can't enable all axes\n");
  899. err = msa311_set_odr(msa311, MSA311_ODR_125_HZ);
  900. if (err)
  901. return dev_err_probe(dev, err,
  902. "failed to set accel frequency\n");
  903. return 0;
  904. }
  905. static int msa311_setup_interrupts(struct msa311_priv *msa311)
  906. {
  907. struct device *dev = msa311->dev;
  908. struct i2c_client *i2c = to_i2c_client(dev);
  909. struct iio_dev *indio_dev = i2c_get_clientdata(i2c);
  910. struct iio_trigger *trig;
  911. int err;
  912. /* Keep going without interrupts if no initialized I2C IRQ */
  913. if (i2c->irq <= 0)
  914. return 0;
  915. err = devm_request_threaded_irq(&i2c->dev, i2c->irq, NULL,
  916. msa311_irq_thread, IRQF_ONESHOT,
  917. msa311->chip_name, indio_dev);
  918. if (err)
  919. return dev_err_probe(dev, err, "failed to request IRQ\n");
  920. trig = devm_iio_trigger_alloc(dev, "%s-new-data", msa311->chip_name);
  921. if (!trig)
  922. return dev_err_probe(dev, -ENOMEM,
  923. "can't allocate newdata trigger\n");
  924. msa311->new_data_trig = trig;
  925. msa311->new_data_trig->ops = &msa311_new_data_trig_ops;
  926. iio_trigger_set_drvdata(msa311->new_data_trig, indio_dev);
  927. err = devm_iio_trigger_register(dev, msa311->new_data_trig);
  928. if (err)
  929. return dev_err_probe(dev, err,
  930. "can't register newdata trigger\n");
  931. err = regmap_field_write(msa311->fields[F_INT1_OD],
  932. MSA311_INT1_OD_PUSH_PULL);
  933. if (err)
  934. return dev_err_probe(dev, err,
  935. "can't enable push-pull interrupt\n");
  936. err = regmap_field_write(msa311->fields[F_INT1_LVL],
  937. MSA311_INT1_LVL_HIGH);
  938. if (err)
  939. return dev_err_probe(dev, err,
  940. "can't set active interrupt level\n");
  941. err = regmap_field_write(msa311->fields[F_LATCH_INT],
  942. MSA311_LATCH_INT_LATCHED);
  943. if (err)
  944. return dev_err_probe(dev, err,
  945. "can't latch interrupt\n");
  946. err = regmap_field_write(msa311->fields[F_RESET_INT], 1);
  947. if (err)
  948. return dev_err_probe(dev, err,
  949. "can't reset interrupt\n");
  950. err = regmap_field_write(msa311->fields[F_INT1_NEW_DATA], 1);
  951. if (err)
  952. return dev_err_probe(dev, err,
  953. "can't map new data interrupt\n");
  954. return 0;
  955. }
  956. static int msa311_regmap_init(struct msa311_priv *msa311)
  957. {
  958. struct regmap_field **fields = msa311->fields;
  959. struct device *dev = msa311->dev;
  960. struct i2c_client *i2c = to_i2c_client(dev);
  961. struct regmap *regmap;
  962. int i;
  963. regmap = devm_regmap_init_i2c(i2c, &msa311_regmap_config);
  964. if (IS_ERR(regmap))
  965. return dev_err_probe(dev, PTR_ERR(regmap),
  966. "failed to register i2c regmap\n");
  967. msa311->regs = regmap;
  968. for (i = 0; i < F_MAX_FIELDS; i++) {
  969. fields[i] = devm_regmap_field_alloc(dev,
  970. msa311->regs,
  971. msa311_reg_fields[i]);
  972. if (IS_ERR(msa311->fields[i]))
  973. return dev_err_probe(dev, PTR_ERR(msa311->fields[i]),
  974. "can't alloc field[%d]\n", i);
  975. }
  976. return 0;
  977. }
  978. static void msa311_powerdown(void *msa311)
  979. {
  980. msa311_set_pwr_mode(msa311, MSA311_PWR_MODE_SUSPEND);
  981. }
  982. static int msa311_probe(struct i2c_client *i2c)
  983. {
  984. struct device *dev = &i2c->dev;
  985. struct msa311_priv *msa311;
  986. struct iio_dev *indio_dev;
  987. int err;
  988. indio_dev = devm_iio_device_alloc(dev, sizeof(*msa311));
  989. if (!indio_dev)
  990. return dev_err_probe(dev, -ENOMEM,
  991. "IIO device allocation failed\n");
  992. msa311 = iio_priv(indio_dev);
  993. msa311->dev = dev;
  994. i2c_set_clientdata(i2c, indio_dev);
  995. err = msa311_regmap_init(msa311);
  996. if (err)
  997. return err;
  998. mutex_init(&msa311->lock);
  999. err = devm_regulator_get_enable(dev, "vdd");
  1000. if (err)
  1001. return dev_err_probe(dev, err, "can't get vdd supply\n");
  1002. err = msa311_check_partid(msa311);
  1003. if (err)
  1004. return err;
  1005. err = msa311_soft_reset(msa311);
  1006. if (err)
  1007. return err;
  1008. err = msa311_set_pwr_mode(msa311, MSA311_PWR_MODE_NORMAL);
  1009. if (err)
  1010. return dev_err_probe(dev, err, "failed to power on device\n");
  1011. /*
  1012. * Register powerdown deferred callback which suspends the chip
  1013. * after module unloaded.
  1014. *
  1015. * MSA311 should be in SUSPEND mode in the two cases:
  1016. * 1) When driver is loaded, but we do not have any data or
  1017. * configuration requests to it (we are solving it using
  1018. * autosuspend feature).
  1019. * 2) When driver is unloaded and device is not used (devm action is
  1020. * used in this case).
  1021. */
  1022. err = devm_add_action_or_reset(dev, msa311_powerdown, msa311);
  1023. if (err)
  1024. return dev_err_probe(dev, err, "can't add powerdown action\n");
  1025. err = pm_runtime_set_active(dev);
  1026. if (err)
  1027. return err;
  1028. err = devm_pm_runtime_enable(dev);
  1029. if (err)
  1030. return err;
  1031. pm_runtime_get_noresume(dev);
  1032. pm_runtime_set_autosuspend_delay(dev, MSA311_PWR_SLEEP_DELAY_MS);
  1033. pm_runtime_use_autosuspend(dev);
  1034. err = msa311_chip_init(msa311);
  1035. if (err)
  1036. return err;
  1037. indio_dev->modes = INDIO_DIRECT_MODE;
  1038. indio_dev->channels = msa311_channels;
  1039. indio_dev->num_channels = ARRAY_SIZE(msa311_channels);
  1040. indio_dev->name = msa311->chip_name;
  1041. indio_dev->info = &msa311_info;
  1042. err = devm_iio_triggered_buffer_setup(dev, indio_dev,
  1043. iio_pollfunc_store_time,
  1044. msa311_buffer_thread,
  1045. &msa311_buffer_setup_ops);
  1046. if (err)
  1047. return dev_err_probe(dev, err,
  1048. "can't setup IIO trigger buffer\n");
  1049. err = msa311_setup_interrupts(msa311);
  1050. if (err)
  1051. return err;
  1052. pm_runtime_mark_last_busy(dev);
  1053. pm_runtime_put_autosuspend(dev);
  1054. err = devm_iio_device_register(dev, indio_dev);
  1055. if (err)
  1056. return dev_err_probe(dev, err, "IIO device register failed\n");
  1057. return 0;
  1058. }
  1059. static int msa311_runtime_suspend(struct device *dev)
  1060. {
  1061. struct iio_dev *indio_dev = dev_get_drvdata(dev);
  1062. struct msa311_priv *msa311 = iio_priv(indio_dev);
  1063. int err;
  1064. mutex_lock(&msa311->lock);
  1065. err = msa311_set_pwr_mode(msa311, MSA311_PWR_MODE_SUSPEND);
  1066. mutex_unlock(&msa311->lock);
  1067. if (err)
  1068. dev_err(dev, "failed to power off device (%pe)\n",
  1069. ERR_PTR(err));
  1070. return err;
  1071. }
  1072. static int msa311_runtime_resume(struct device *dev)
  1073. {
  1074. struct iio_dev *indio_dev = dev_get_drvdata(dev);
  1075. struct msa311_priv *msa311 = iio_priv(indio_dev);
  1076. int err;
  1077. mutex_lock(&msa311->lock);
  1078. err = msa311_set_pwr_mode(msa311, MSA311_PWR_MODE_NORMAL);
  1079. mutex_unlock(&msa311->lock);
  1080. if (err)
  1081. dev_err(dev, "failed to power on device (%pe)\n",
  1082. ERR_PTR(err));
  1083. return err;
  1084. }
  1085. static DEFINE_RUNTIME_DEV_PM_OPS(msa311_pm_ops, msa311_runtime_suspend,
  1086. msa311_runtime_resume, NULL);
  1087. static const struct i2c_device_id msa311_i2c_id[] = {
  1088. { .name = "msa311" },
  1089. { }
  1090. };
  1091. MODULE_DEVICE_TABLE(i2c, msa311_i2c_id);
  1092. static const struct of_device_id msa311_of_match[] = {
  1093. { .compatible = "memsensing,msa311" },
  1094. { }
  1095. };
  1096. MODULE_DEVICE_TABLE(of, msa311_of_match);
  1097. static struct i2c_driver msa311_driver = {
  1098. .driver = {
  1099. .name = "msa311",
  1100. .of_match_table = msa311_of_match,
  1101. .pm = pm_ptr(&msa311_pm_ops),
  1102. },
  1103. .probe = msa311_probe,
  1104. .id_table = msa311_i2c_id,
  1105. };
  1106. module_i2c_driver(msa311_driver);
  1107. MODULE_AUTHOR("Dmitry Rokosov <ddrokosov@sberdevices.ru>");
  1108. MODULE_DESCRIPTION("MEMSensing MSA311 3-axis accelerometer driver");
  1109. MODULE_LICENSE("GPL");