inv_mpu_iio.h 11 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360
  1. /*
  2. * Copyright (C) 2012 Invensense, Inc.
  3. *
  4. * This software is licensed under the terms of the GNU General Public
  5. * License version 2, as published by the Free Software Foundation, and
  6. * may be copied, distributed, and modified under those terms.
  7. *
  8. * This program is distributed in the hope that it will be useful,
  9. * but WITHOUT ANY WARRANTY; without even the implied warranty of
  10. * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
  11. * GNU General Public License for more details.
  12. */
  13. #include <linux/i2c.h>
  14. #include <linux/i2c-mux.h>
  15. #include <linux/mutex.h>
  16. #include <linux/iio/iio.h>
  17. #include <linux/iio/buffer.h>
  18. #include <linux/regmap.h>
  19. #include <linux/iio/sysfs.h>
  20. #include <linux/iio/kfifo_buf.h>
  21. #include <linux/iio/trigger.h>
  22. #include <linux/iio/triggered_buffer.h>
  23. #include <linux/iio/trigger_consumer.h>
  24. #include <linux/platform_data/invensense_mpu6050.h>
  25. /**
  26. * struct inv_mpu6050_reg_map - Notable registers.
  27. * @sample_rate_div: Divider applied to gyro output rate.
  28. * @lpf: Configures internal low pass filter.
  29. * @accel_lpf: Configures accelerometer low pass filter.
  30. * @user_ctrl: Enables/resets the FIFO.
  31. * @fifo_en: Determines which data will appear in FIFO.
  32. * @gyro_config: gyro config register.
  33. * @accl_config: accel config register
  34. * @fifo_count_h: Upper byte of FIFO count.
  35. * @fifo_r_w: FIFO register.
  36. * @raw_gyro: Address of first gyro register.
  37. * @raw_accl: Address of first accel register.
  38. * @temperature: temperature register
  39. * @int_enable: Interrupt enable register.
  40. * @int_status: Interrupt status register.
  41. * @pwr_mgmt_1: Controls chip's power state and clock source.
  42. * @pwr_mgmt_2: Controls power state of individual sensors.
  43. * @int_pin_cfg; Controls interrupt pin configuration.
  44. * @accl_offset: Controls the accelerometer calibration offset.
  45. * @gyro_offset: Controls the gyroscope calibration offset.
  46. * @i2c_if: Controls the i2c interface
  47. */
  48. struct inv_mpu6050_reg_map {
  49. u8 sample_rate_div;
  50. u8 lpf;
  51. u8 accel_lpf;
  52. u8 user_ctrl;
  53. u8 fifo_en;
  54. u8 gyro_config;
  55. u8 accl_config;
  56. u8 fifo_count_h;
  57. u8 fifo_r_w;
  58. u8 raw_gyro;
  59. u8 raw_accl;
  60. u8 temperature;
  61. u8 int_enable;
  62. u8 int_status;
  63. u8 pwr_mgmt_1;
  64. u8 pwr_mgmt_2;
  65. u8 int_pin_cfg;
  66. u8 accl_offset;
  67. u8 gyro_offset;
  68. u8 i2c_if;
  69. };
  70. /*device enum */
  71. enum inv_devices {
  72. INV_MPU6050,
  73. INV_MPU6500,
  74. INV_MPU6515,
  75. INV_MPU6000,
  76. INV_MPU9150,
  77. INV_MPU9250,
  78. INV_MPU9255,
  79. INV_ICM20608,
  80. INV_ICM20602,
  81. INV_NUM_PARTS
  82. };
  83. /**
  84. * struct inv_mpu6050_chip_config - Cached chip configuration data.
  85. * @fsr: Full scale range.
  86. * @lpf: Digital low pass filter frequency.
  87. * @accl_fs: accel full scale range.
  88. * @accl_fifo_enable: enable accel data output
  89. * @gyro_fifo_enable: enable gyro data output
  90. * @divider: chip sample rate divider (sample rate divider - 1)
  91. */
  92. struct inv_mpu6050_chip_config {
  93. unsigned int fsr:2;
  94. unsigned int lpf:3;
  95. unsigned int accl_fs:2;
  96. unsigned int accl_fifo_enable:1;
  97. unsigned int gyro_fifo_enable:1;
  98. u8 divider;
  99. u8 user_ctrl;
  100. };
  101. /**
  102. * struct inv_mpu6050_hw - Other important hardware information.
  103. * @whoami: Self identification byte from WHO_AM_I register
  104. * @name: name of the chip.
  105. * @reg: register map of the chip.
  106. * @config: configuration of the chip.
  107. * @fifo_size: size of the FIFO in bytes.
  108. * @temp: offset and scale to apply to raw temperature.
  109. */
  110. struct inv_mpu6050_hw {
  111. u8 whoami;
  112. u8 *name;
  113. const struct inv_mpu6050_reg_map *reg;
  114. const struct inv_mpu6050_chip_config *config;
  115. size_t fifo_size;
  116. struct {
  117. int offset;
  118. int scale;
  119. } temp;
  120. };
  121. /*
  122. * struct inv_mpu6050_state - Driver state variables.
  123. * @lock: Chip access lock.
  124. * @trig: IIO trigger.
  125. * @chip_config: Cached attribute information.
  126. * @reg: Map of important registers.
  127. * @hw: Other hardware-specific information.
  128. * @chip_type: chip type.
  129. * @plat_data: platform data (deprecated in favor of @orientation).
  130. * @orientation: sensor chip orientation relative to main hardware.
  131. * @map regmap pointer.
  132. * @irq interrupt number.
  133. * @irq_mask the int_pin_cfg mask to configure interrupt type.
  134. * @chip_period: chip internal period estimation (~1kHz).
  135. * @it_timestamp: timestamp from previous interrupt.
  136. * @data_timestamp: timestamp for next data sample.
  137. */
  138. struct inv_mpu6050_state {
  139. struct mutex lock;
  140. struct iio_trigger *trig;
  141. struct inv_mpu6050_chip_config chip_config;
  142. const struct inv_mpu6050_reg_map *reg;
  143. const struct inv_mpu6050_hw *hw;
  144. enum inv_devices chip_type;
  145. struct i2c_mux_core *muxc;
  146. struct i2c_client *mux_client;
  147. unsigned int powerup_count;
  148. struct inv_mpu6050_platform_data plat_data;
  149. struct iio_mount_matrix orientation;
  150. struct regmap *map;
  151. int irq;
  152. u8 irq_mask;
  153. unsigned skip_samples;
  154. s64 chip_period;
  155. s64 it_timestamp;
  156. s64 data_timestamp;
  157. };
  158. /*register and associated bit definition*/
  159. #define INV_MPU6050_REG_ACCEL_OFFSET 0x06
  160. #define INV_MPU6050_REG_GYRO_OFFSET 0x13
  161. #define INV_MPU6050_REG_SAMPLE_RATE_DIV 0x19
  162. #define INV_MPU6050_REG_CONFIG 0x1A
  163. #define INV_MPU6050_REG_GYRO_CONFIG 0x1B
  164. #define INV_MPU6050_REG_ACCEL_CONFIG 0x1C
  165. #define INV_MPU6050_REG_FIFO_EN 0x23
  166. #define INV_MPU6050_BIT_ACCEL_OUT 0x08
  167. #define INV_MPU6050_BITS_GYRO_OUT 0x70
  168. #define INV_MPU6050_REG_INT_ENABLE 0x38
  169. #define INV_MPU6050_BIT_DATA_RDY_EN 0x01
  170. #define INV_MPU6050_BIT_DMP_INT_EN 0x02
  171. #define INV_MPU6050_REG_RAW_ACCEL 0x3B
  172. #define INV_MPU6050_REG_TEMPERATURE 0x41
  173. #define INV_MPU6050_REG_RAW_GYRO 0x43
  174. #define INV_MPU6050_REG_INT_STATUS 0x3A
  175. #define INV_MPU6050_BIT_FIFO_OVERFLOW_INT 0x10
  176. #define INV_MPU6050_BIT_RAW_DATA_RDY_INT 0x01
  177. #define INV_MPU6050_REG_USER_CTRL 0x6A
  178. #define INV_MPU6050_BIT_FIFO_RST 0x04
  179. #define INV_MPU6050_BIT_DMP_RST 0x08
  180. #define INV_MPU6050_BIT_I2C_MST_EN 0x20
  181. #define INV_MPU6050_BIT_FIFO_EN 0x40
  182. #define INV_MPU6050_BIT_DMP_EN 0x80
  183. #define INV_MPU6050_BIT_I2C_IF_DIS 0x10
  184. #define INV_MPU6050_REG_PWR_MGMT_1 0x6B
  185. #define INV_MPU6050_BIT_H_RESET 0x80
  186. #define INV_MPU6050_BIT_SLEEP 0x40
  187. #define INV_MPU6050_BIT_CLK_MASK 0x7
  188. #define INV_MPU6050_REG_PWR_MGMT_2 0x6C
  189. #define INV_MPU6050_BIT_PWR_ACCL_STBY 0x38
  190. #define INV_MPU6050_BIT_PWR_GYRO_STBY 0x07
  191. /* ICM20602 register */
  192. #define INV_ICM20602_REG_I2C_IF 0x70
  193. #define INV_ICM20602_BIT_I2C_IF_DIS 0x40
  194. #define INV_MPU6050_REG_FIFO_COUNT_H 0x72
  195. #define INV_MPU6050_REG_FIFO_R_W 0x74
  196. #define INV_MPU6050_BYTES_PER_3AXIS_SENSOR 6
  197. #define INV_MPU6050_FIFO_COUNT_BYTE 2
  198. /* ICM20602 FIFO samples include temperature readings */
  199. #define INV_ICM20602_BYTES_PER_TEMP_SENSOR 2
  200. /* mpu6500 registers */
  201. #define INV_MPU6500_REG_ACCEL_CONFIG_2 0x1D
  202. #define INV_MPU6500_REG_ACCEL_OFFSET 0x77
  203. /* delay time in milliseconds */
  204. #define INV_MPU6050_POWER_UP_TIME 100
  205. #define INV_MPU6050_TEMP_UP_TIME 100
  206. #define INV_MPU6050_SENSOR_UP_TIME 30
  207. /* delay time in microseconds */
  208. #define INV_MPU6050_REG_UP_TIME_MIN 5000
  209. #define INV_MPU6050_REG_UP_TIME_MAX 10000
  210. #define INV_MPU6050_TEMP_OFFSET 12420
  211. #define INV_MPU6050_TEMP_SCALE 2941176
  212. #define INV_MPU6050_MAX_GYRO_FS_PARAM 3
  213. #define INV_MPU6050_MAX_ACCL_FS_PARAM 3
  214. #define INV_MPU6050_THREE_AXIS 3
  215. #define INV_MPU6050_GYRO_CONFIG_FSR_SHIFT 3
  216. #define INV_MPU6050_ACCL_CONFIG_FSR_SHIFT 3
  217. #define INV_MPU6500_TEMP_OFFSET 7011
  218. #define INV_MPU6500_TEMP_SCALE 2995178
  219. #define INV_ICM20608_TEMP_OFFSET 8170
  220. #define INV_ICM20608_TEMP_SCALE 3059976
  221. /* 6 + 6 round up and plus 8 */
  222. #define INV_MPU6050_OUTPUT_DATA_SIZE 24
  223. #define INV_MPU6050_REG_INT_PIN_CFG 0x37
  224. #define INV_MPU6050_ACTIVE_HIGH 0x00
  225. #define INV_MPU6050_ACTIVE_LOW 0x80
  226. /* enable level triggering */
  227. #define INV_MPU6050_LATCH_INT_EN 0x20
  228. #define INV_MPU6050_BIT_BYPASS_EN 0x2
  229. /* Allowed timestamp period jitter in percent */
  230. #define INV_MPU6050_TS_PERIOD_JITTER 4
  231. /* init parameters */
  232. #define INV_MPU6050_INIT_FIFO_RATE 50
  233. #define INV_MPU6050_MAX_FIFO_RATE 1000
  234. #define INV_MPU6050_MIN_FIFO_RATE 4
  235. /* chip internal frequency: 1KHz */
  236. #define INV_MPU6050_INTERNAL_FREQ_HZ 1000
  237. /* return the frequency divider (chip sample rate divider + 1) */
  238. #define INV_MPU6050_FREQ_DIVIDER(st) \
  239. ((st)->chip_config.divider + 1)
  240. /* chip sample rate divider to fifo rate */
  241. #define INV_MPU6050_FIFO_RATE_TO_DIVIDER(fifo_rate) \
  242. ((INV_MPU6050_INTERNAL_FREQ_HZ / (fifo_rate)) - 1)
  243. #define INV_MPU6050_DIVIDER_TO_FIFO_RATE(divider) \
  244. (INV_MPU6050_INTERNAL_FREQ_HZ / ((divider) + 1))
  245. #define INV_MPU6050_REG_WHOAMI 117
  246. #define INV_MPU6000_WHOAMI_VALUE 0x68
  247. #define INV_MPU6050_WHOAMI_VALUE 0x68
  248. #define INV_MPU6500_WHOAMI_VALUE 0x70
  249. #define INV_MPU9150_WHOAMI_VALUE 0x68
  250. #define INV_MPU9250_WHOAMI_VALUE 0x71
  251. #define INV_MPU9255_WHOAMI_VALUE 0x73
  252. #define INV_MPU6515_WHOAMI_VALUE 0x74
  253. #define INV_ICM20608_WHOAMI_VALUE 0xAF
  254. #define INV_ICM20602_WHOAMI_VALUE 0x12
  255. /* scan element definition for generic MPU6xxx devices */
  256. enum inv_mpu6050_scan {
  257. INV_MPU6050_SCAN_ACCL_X,
  258. INV_MPU6050_SCAN_ACCL_Y,
  259. INV_MPU6050_SCAN_ACCL_Z,
  260. INV_MPU6050_SCAN_GYRO_X,
  261. INV_MPU6050_SCAN_GYRO_Y,
  262. INV_MPU6050_SCAN_GYRO_Z,
  263. INV_MPU6050_SCAN_TIMESTAMP,
  264. };
  265. /* scan element definition for ICM20602, which includes temperature */
  266. enum inv_icm20602_scan {
  267. INV_ICM20602_SCAN_ACCL_X,
  268. INV_ICM20602_SCAN_ACCL_Y,
  269. INV_ICM20602_SCAN_ACCL_Z,
  270. INV_ICM20602_SCAN_TEMP,
  271. INV_ICM20602_SCAN_GYRO_X,
  272. INV_ICM20602_SCAN_GYRO_Y,
  273. INV_ICM20602_SCAN_GYRO_Z,
  274. INV_ICM20602_SCAN_TIMESTAMP,
  275. };
  276. enum inv_mpu6050_filter_e {
  277. INV_MPU6050_FILTER_256HZ_NOLPF2 = 0,
  278. INV_MPU6050_FILTER_188HZ,
  279. INV_MPU6050_FILTER_98HZ,
  280. INV_MPU6050_FILTER_42HZ,
  281. INV_MPU6050_FILTER_20HZ,
  282. INV_MPU6050_FILTER_10HZ,
  283. INV_MPU6050_FILTER_5HZ,
  284. INV_MPU6050_FILTER_2100HZ_NOLPF,
  285. NUM_MPU6050_FILTER
  286. };
  287. /* IIO attribute address */
  288. enum INV_MPU6050_IIO_ATTR_ADDR {
  289. ATTR_GYRO_MATRIX,
  290. ATTR_ACCL_MATRIX,
  291. };
  292. enum inv_mpu6050_accl_fs_e {
  293. INV_MPU6050_FS_02G = 0,
  294. INV_MPU6050_FS_04G,
  295. INV_MPU6050_FS_08G,
  296. INV_MPU6050_FS_16G,
  297. NUM_ACCL_FSR
  298. };
  299. enum inv_mpu6050_fsr_e {
  300. INV_MPU6050_FSR_250DPS = 0,
  301. INV_MPU6050_FSR_500DPS,
  302. INV_MPU6050_FSR_1000DPS,
  303. INV_MPU6050_FSR_2000DPS,
  304. NUM_MPU6050_FSR
  305. };
  306. enum inv_mpu6050_clock_sel_e {
  307. INV_CLK_INTERNAL = 0,
  308. INV_CLK_PLL,
  309. NUM_CLK
  310. };
  311. irqreturn_t inv_mpu6050_read_fifo(int irq, void *p);
  312. int inv_mpu6050_probe_trigger(struct iio_dev *indio_dev, int irq_type);
  313. int inv_reset_fifo(struct iio_dev *indio_dev);
  314. int inv_mpu6050_switch_engine(struct inv_mpu6050_state *st, bool en, u32 mask);
  315. int inv_mpu6050_write_reg(struct inv_mpu6050_state *st, int reg, u8 val);
  316. int inv_mpu6050_set_power_itg(struct inv_mpu6050_state *st, bool power_on);
  317. int inv_mpu_acpi_create_mux_client(struct i2c_client *client);
  318. void inv_mpu_acpi_delete_mux_client(struct i2c_client *client);
  319. int inv_mpu_core_probe(struct regmap *regmap, int irq, const char *name,
  320. int (*inv_mpu_bus_setup)(struct iio_dev *), int chip_type);
  321. extern const struct dev_pm_ops inv_mpu_pmops;