inv_mpu_iio.h 7.8 KB

123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256
  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/kfifo.h>
  15. #include <linux/spinlock.h>
  16. #include <linux/iio/iio.h>
  17. #include <linux/iio/buffer.h>
  18. #include <linux/iio/sysfs.h>
  19. #include <linux/iio/kfifo_buf.h>
  20. #include <linux/iio/trigger.h>
  21. #include <linux/iio/triggered_buffer.h>
  22. #include <linux/iio/trigger_consumer.h>
  23. #include <linux/platform_data/invensense_mpu6050.h>
  24. /**
  25. * struct inv_mpu6050_reg_map - Notable registers.
  26. * @sample_rate_div: Divider applied to gyro output rate.
  27. * @lpf: Configures internal low pass filter.
  28. * @user_ctrl: Enables/resets the FIFO.
  29. * @fifo_en: Determines which data will appear in FIFO.
  30. * @gyro_config: gyro config register.
  31. * @accl_config: accel config register
  32. * @fifo_count_h: Upper byte of FIFO count.
  33. * @fifo_r_w: FIFO register.
  34. * @raw_gyro: Address of first gyro register.
  35. * @raw_accl: Address of first accel register.
  36. * @temperature: temperature register
  37. * @int_enable: Interrupt enable register.
  38. * @pwr_mgmt_1: Controls chip's power state and clock source.
  39. * @pwr_mgmt_2: Controls power state of individual sensors.
  40. */
  41. struct inv_mpu6050_reg_map {
  42. u8 sample_rate_div;
  43. u8 lpf;
  44. u8 user_ctrl;
  45. u8 fifo_en;
  46. u8 gyro_config;
  47. u8 accl_config;
  48. u8 fifo_count_h;
  49. u8 fifo_r_w;
  50. u8 raw_gyro;
  51. u8 raw_accl;
  52. u8 temperature;
  53. u8 int_enable;
  54. u8 pwr_mgmt_1;
  55. u8 pwr_mgmt_2;
  56. u8 int_pin_cfg;
  57. };
  58. /*device enum */
  59. enum inv_devices {
  60. INV_MPU6050,
  61. INV_MPU6500,
  62. INV_NUM_PARTS
  63. };
  64. /**
  65. * struct inv_mpu6050_chip_config - Cached chip configuration data.
  66. * @fsr: Full scale range.
  67. * @lpf: Digital low pass filter frequency.
  68. * @accl_fs: accel full scale range.
  69. * @enable: master enable state.
  70. * @accl_fifo_enable: enable accel data output
  71. * @gyro_fifo_enable: enable gyro data output
  72. * @fifo_rate: FIFO update rate.
  73. */
  74. struct inv_mpu6050_chip_config {
  75. unsigned int fsr:2;
  76. unsigned int lpf:3;
  77. unsigned int accl_fs:2;
  78. unsigned int enable:1;
  79. unsigned int accl_fifo_enable:1;
  80. unsigned int gyro_fifo_enable:1;
  81. u16 fifo_rate;
  82. };
  83. /**
  84. * struct inv_mpu6050_hw - Other important hardware information.
  85. * @num_reg: Number of registers on device.
  86. * @name: name of the chip.
  87. * @reg: register map of the chip.
  88. * @config: configuration of the chip.
  89. */
  90. struct inv_mpu6050_hw {
  91. u8 num_reg;
  92. u8 *name;
  93. const struct inv_mpu6050_reg_map *reg;
  94. const struct inv_mpu6050_chip_config *config;
  95. };
  96. /*
  97. * struct inv_mpu6050_state - Driver state variables.
  98. * @TIMESTAMP_FIFO_SIZE: fifo size for timestamp.
  99. * @trig: IIO trigger.
  100. * @chip_config: Cached attribute information.
  101. * @reg: Map of important registers.
  102. * @hw: Other hardware-specific information.
  103. * @chip_type: chip type.
  104. * @time_stamp_lock: spin lock to time stamp.
  105. * @client: i2c client handle.
  106. * @plat_data: platform data.
  107. * @timestamps: kfifo queue to store time stamp.
  108. */
  109. struct inv_mpu6050_state {
  110. #define TIMESTAMP_FIFO_SIZE 16
  111. struct iio_trigger *trig;
  112. struct inv_mpu6050_chip_config chip_config;
  113. const struct inv_mpu6050_reg_map *reg;
  114. const struct inv_mpu6050_hw *hw;
  115. enum inv_devices chip_type;
  116. spinlock_t time_stamp_lock;
  117. struct i2c_client *client;
  118. struct i2c_adapter *mux_adapter;
  119. struct i2c_client *mux_client;
  120. unsigned int powerup_count;
  121. struct inv_mpu6050_platform_data plat_data;
  122. DECLARE_KFIFO(timestamps, long long, TIMESTAMP_FIFO_SIZE);
  123. };
  124. /*register and associated bit definition*/
  125. #define INV_MPU6050_REG_SAMPLE_RATE_DIV 0x19
  126. #define INV_MPU6050_REG_CONFIG 0x1A
  127. #define INV_MPU6050_REG_GYRO_CONFIG 0x1B
  128. #define INV_MPU6050_REG_ACCEL_CONFIG 0x1C
  129. #define INV_MPU6050_REG_FIFO_EN 0x23
  130. #define INV_MPU6050_BIT_ACCEL_OUT 0x08
  131. #define INV_MPU6050_BITS_GYRO_OUT 0x70
  132. #define INV_MPU6050_REG_INT_ENABLE 0x38
  133. #define INV_MPU6050_BIT_DATA_RDY_EN 0x01
  134. #define INV_MPU6050_BIT_DMP_INT_EN 0x02
  135. #define INV_MPU6050_REG_RAW_ACCEL 0x3B
  136. #define INV_MPU6050_REG_TEMPERATURE 0x41
  137. #define INV_MPU6050_REG_RAW_GYRO 0x43
  138. #define INV_MPU6050_REG_USER_CTRL 0x6A
  139. #define INV_MPU6050_BIT_FIFO_RST 0x04
  140. #define INV_MPU6050_BIT_DMP_RST 0x08
  141. #define INV_MPU6050_BIT_I2C_MST_EN 0x20
  142. #define INV_MPU6050_BIT_FIFO_EN 0x40
  143. #define INV_MPU6050_BIT_DMP_EN 0x80
  144. #define INV_MPU6050_REG_PWR_MGMT_1 0x6B
  145. #define INV_MPU6050_BIT_H_RESET 0x80
  146. #define INV_MPU6050_BIT_SLEEP 0x40
  147. #define INV_MPU6050_BIT_CLK_MASK 0x7
  148. #define INV_MPU6050_REG_PWR_MGMT_2 0x6C
  149. #define INV_MPU6050_BIT_PWR_ACCL_STBY 0x38
  150. #define INV_MPU6050_BIT_PWR_GYRO_STBY 0x07
  151. #define INV_MPU6050_REG_FIFO_COUNT_H 0x72
  152. #define INV_MPU6050_REG_FIFO_R_W 0x74
  153. #define INV_MPU6050_BYTES_PER_3AXIS_SENSOR 6
  154. #define INV_MPU6050_FIFO_COUNT_BYTE 2
  155. #define INV_MPU6050_FIFO_THRESHOLD 500
  156. #define INV_MPU6050_POWER_UP_TIME 100
  157. #define INV_MPU6050_TEMP_UP_TIME 100
  158. #define INV_MPU6050_SENSOR_UP_TIME 30
  159. #define INV_MPU6050_REG_UP_TIME 5
  160. #define INV_MPU6050_TEMP_OFFSET 12421
  161. #define INV_MPU6050_TEMP_SCALE 2941
  162. #define INV_MPU6050_MAX_GYRO_FS_PARAM 3
  163. #define INV_MPU6050_MAX_ACCL_FS_PARAM 3
  164. #define INV_MPU6050_THREE_AXIS 3
  165. #define INV_MPU6050_GYRO_CONFIG_FSR_SHIFT 3
  166. #define INV_MPU6050_ACCL_CONFIG_FSR_SHIFT 3
  167. /* 6 + 6 round up and plus 8 */
  168. #define INV_MPU6050_OUTPUT_DATA_SIZE 24
  169. #define INV_MPU6050_REG_INT_PIN_CFG 0x37
  170. #define INV_MPU6050_BIT_BYPASS_EN 0x2
  171. /* init parameters */
  172. #define INV_MPU6050_INIT_FIFO_RATE 50
  173. #define INV_MPU6050_TIME_STAMP_TOR 5
  174. #define INV_MPU6050_MAX_FIFO_RATE 1000
  175. #define INV_MPU6050_MIN_FIFO_RATE 4
  176. #define INV_MPU6050_ONE_K_HZ 1000
  177. /* scan element definition */
  178. enum inv_mpu6050_scan {
  179. INV_MPU6050_SCAN_ACCL_X,
  180. INV_MPU6050_SCAN_ACCL_Y,
  181. INV_MPU6050_SCAN_ACCL_Z,
  182. INV_MPU6050_SCAN_GYRO_X,
  183. INV_MPU6050_SCAN_GYRO_Y,
  184. INV_MPU6050_SCAN_GYRO_Z,
  185. INV_MPU6050_SCAN_TIMESTAMP,
  186. };
  187. enum inv_mpu6050_filter_e {
  188. INV_MPU6050_FILTER_256HZ_NOLPF2 = 0,
  189. INV_MPU6050_FILTER_188HZ,
  190. INV_MPU6050_FILTER_98HZ,
  191. INV_MPU6050_FILTER_42HZ,
  192. INV_MPU6050_FILTER_20HZ,
  193. INV_MPU6050_FILTER_10HZ,
  194. INV_MPU6050_FILTER_5HZ,
  195. INV_MPU6050_FILTER_2100HZ_NOLPF,
  196. NUM_MPU6050_FILTER
  197. };
  198. /* IIO attribute address */
  199. enum INV_MPU6050_IIO_ATTR_ADDR {
  200. ATTR_GYRO_MATRIX,
  201. ATTR_ACCL_MATRIX,
  202. };
  203. enum inv_mpu6050_accl_fs_e {
  204. INV_MPU6050_FS_02G = 0,
  205. INV_MPU6050_FS_04G,
  206. INV_MPU6050_FS_08G,
  207. INV_MPU6050_FS_16G,
  208. NUM_ACCL_FSR
  209. };
  210. enum inv_mpu6050_fsr_e {
  211. INV_MPU6050_FSR_250DPS = 0,
  212. INV_MPU6050_FSR_500DPS,
  213. INV_MPU6050_FSR_1000DPS,
  214. INV_MPU6050_FSR_2000DPS,
  215. NUM_MPU6050_FSR
  216. };
  217. enum inv_mpu6050_clock_sel_e {
  218. INV_CLK_INTERNAL = 0,
  219. INV_CLK_PLL,
  220. NUM_CLK
  221. };
  222. irqreturn_t inv_mpu6050_irq_handler(int irq, void *p);
  223. irqreturn_t inv_mpu6050_read_fifo(int irq, void *p);
  224. int inv_mpu6050_probe_trigger(struct iio_dev *indio_dev);
  225. void inv_mpu6050_remove_trigger(struct inv_mpu6050_state *st);
  226. int inv_reset_fifo(struct iio_dev *indio_dev);
  227. int inv_mpu6050_switch_engine(struct inv_mpu6050_state *st, bool en, u32 mask);
  228. int inv_mpu6050_write_reg(struct inv_mpu6050_state *st, int reg, u8 val);
  229. int inv_mpu6050_set_power_itg(struct inv_mpu6050_state *st, bool power_on);
  230. int inv_mpu_acpi_create_mux_client(struct inv_mpu6050_state *st);
  231. void inv_mpu_acpi_delete_mux_client(struct inv_mpu6050_state *st);