blob: a124d79940d104698de716e69c0e66a05699da62 (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
128
129
130
131
132
133
134
135
136
137
138
139
140
141
142
143
144
145
146
147
148
149
150
151
152
153
154
155
156
157
158
159
160
161
162
163
164
165
166
167
168
169
170
171
172
173
174
175
176
177
178
179
180
181
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196
197
198
199
200
201
202
203
204
205
206
207
208
209
210
211
212
213
214
215
216
217
218
219
220
|
/*
* Copyright © 2012 Keith Packard <keithp@keithp.com>
*
* This program is free software; you can redistribute it and/or modify
* it under the terms of the GNU General Public License as published by
* the Free Software Foundation; either version 2 of the License, or
* (at your option) any later version.
*
* This program is distributed in the hope that it will be useful, but
* WITHOUT ANY WARRANTY; without even the implied warranty of
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
* General Public License for more details.
*
* You should have received a copy of the GNU General Public License along
* with this program; if not, write to the Free Software Foundation, Inc.,
* 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA.
*/
#ifndef _AO_MPU9250_H_
#define _AO_MPU9250_H_
#ifndef M_PI
#define M_PI 3.1415926535897832384626433
#endif
#define MPU9250_ADDR_WRITE 0xd0
#define MPU9250_ADDR_READ 0xd1
/* From Tridge */
#define MPUREG_XG_OFFS_TC 0x00
#define MPUREG_YG_OFFS_TC 0x01
#define MPUREG_ZG_OFFS_TC 0x02
#define MPUREG_X_FINE_GAIN 0x03
#define MPUREG_Y_FINE_GAIN 0x04
#define MPUREG_Z_FINE_GAIN 0x05
#define MPUREG_XA_OFFS_H 0x06 // X axis accelerometer offset (high byte)
#define MPUREG_XA_OFFS_L 0x07 // X axis accelerometer offset (low byte)
#define MPUREG_YA_OFFS_H 0x08 // Y axis accelerometer offset (high byte)
#define MPUREG_YA_OFFS_L 0x09 // Y axis accelerometer offset (low byte)
#define MPUREG_ZA_OFFS_H 0x0A // Z axis accelerometer offset (high byte)
#define MPUREG_ZA_OFFS_L 0x0B // Z axis accelerometer offset (low byte)
#define MPUREG_PRODUCT_ID 0x0C // Product ID Register
#define MPUREG_XG_OFFS_USRH 0x13 // X axis gyro offset (high byte)
#define MPUREG_XG_OFFS_USRL 0x14 // X axis gyro offset (low byte)
#define MPUREG_YG_OFFS_USRH 0x15 // Y axis gyro offset (high byte)
#define MPUREG_YG_OFFS_USRL 0x16 // Y axis gyro offset (low byte)
#define MPUREG_ZG_OFFS_USRH 0x17 // Z axis gyro offset (high byte)
#define MPUREG_ZG_OFFS_USRL 0x18 // Z axis gyro offset (low byte)
#define MPU9250_SMPRT_DIV 0x19
#define MPU9250_CONFIG 0x1a
#define MPU9250_CONFIG_FIFO_MODE 6
# define MPU9250_CONFIG_FIFO_MODE_REPLACE 0
# define MPU9250_CONFIG_FIFO_MODE_DROP 1
#define MPU9250_CONFIG_EXT_SYNC_SET 3
#define MPU9250_CONFIG_EXT_SYNC_SET_DISABLED 0
#define MPU9250_CONFIG_EXT_SYNC_SET_TEMP_OUT_L 1
#define MPU9250_CONFIG_EXT_SYNC_SET_GYRO_XOUT_L 2
#define MPU9250_CONFIG_EXT_SYNC_SET_GYRO_YOUT_L 3
#define MPU9250_CONFIG_EXT_SYNC_SET_GYRO_ZOUT_L 4
#define MPU9250_CONFIG_EXT_SYNC_SET_ACCEL_XOUT_L 5
#define MPU9250_CONFIG_EXT_SYNC_SET_ACCEL_YOUT_L 6
#define MPU9250_CONFIG_EXT_SYNC_SET_ACCEL_ZOUT_L 7
#define MPU9250_CONFIG_EXT_SYNC_SET_MASK 7
#define MPU9250_CONFIG_DLPF_CFG 0
#define MPU9250_CONFIG_DLPF_CFG_250 0
#define MPU9250_CONFIG_DLPF_CFG_184 1
#define MPU9250_CONFIG_DLPF_CFG_92 2
#define MPU9250_CONFIG_DLPF_CFG_41 3
#define MPU9250_CONFIG_DLPF_CFG_20 4
#define MPU9250_CONFIG_DLPF_CFG_10 5
#define MPU9250_CONFIG_DLPF_CFG_5 6
#define MPU9250_CONFIG_DLPF_CFG_MASK 7
#define MPU9250_GYRO_CONFIG 0x1b
# define MPU9250_GYRO_CONFIG_XG_ST 7
# define MPU9250_GYRO_CONFIG_YG_ST 6
# define MPU9250_GYRO_CONFIG_ZG_ST 5
# define MPU9250_GYRO_CONFIG_FS_SEL 3
# define MPU9250_GYRO_CONFIG_FS_SEL_250 0
# define MPU9250_GYRO_CONFIG_FS_SEL_500 1
# define MPU9250_GYRO_CONFIG_FS_SEL_1000 2
# define MPU9250_GYRO_CONFIG_FS_SEL_2000 3
# define MPU9250_GYRO_CONFIG_FS_SEL_MASK 3
# define MPU9250_GYRO_CONFIG_FCHOICE_B 0
# define MPU9250_GYRO_CONFIG_FCHOICE_B_8800 3
# define MPU9250_GYRO_CONFIG_FCHOICE_B_3600 2
# define MPU9250_GYRO_CONFIG_FCHOICE_B_LOW 0
#define MPU9250_ACCEL_CONFIG 0x1c
# define MPU9250_ACCEL_CONFIG_XA_ST 7
# define MPU9250_ACCEL_CONFIG_YA_ST 6
# define MPU9250_ACCEL_CONFIG_ZA_ST 5
# define MPU9250_ACCEL_CONFIG_AFS_SEL 3
# define MPU9250_ACCEL_CONFIG_AFS_SEL_2G 0
# define MPU9250_ACCEL_CONFIG_AFS_SEL_4G 1
# define MPU9250_ACCEL_CONFIG_AFS_SEL_8G 2
# define MPU9250_ACCEL_CONFIG_AFS_SEL_16G 3
# define MPU9250_ACCEL_CONFIG_AFS_SEL_MASK 3
#define MPU9250_INT_ENABLE 0x38
#define MPU9250_INT_ENABLE_FF_EN 7
#define MPU9250_INT_ENABLE_MOT_EN 6
#define MPU9250_INT_ENABLE_ZMOT_EN 5
#define MPU9250_INT_ENABLE_FIFO_OFLOW_EN 4
#define MPU9250_INT_ENABLE_I2C_MST_INT_EN 3
#define MPU9250_INT_ENABLE_DATA_RDY_EN 0
#define MPU9250_INT_STATUS 0x3a
#define MPU9250_INT_STATUS_FF_EN 7
#define MPU9250_INT_STATUS_MOT_EN 6
#define MPU9250_INT_STATUS_ZMOT_EN 5
#define MPU9250_INT_STATUS_FIFO_OFLOW_EN 4
#define MPU9250_INT_STATUS_I2C_MST_INT_EN 3
#define MPU9250_INT_STATUS_DATA_RDY_EN 0
#define MPU9250_ACCEL_XOUT_H 0x3b
#define MPU9250_ACCEL_XOUT_L 0x3c
#define MPU9250_ACCEL_YOUT_H 0x3d
#define MPU9250_ACCEL_YOUT_L 0x3e
#define MPU9250_ACCEL_ZOUT_H 0x3f
#define MPU9250_ACCEL_ZOUT_L 0x40
#define MPU9250_TEMP_H 0x41
#define MPU9250_TEMP_L 0x42
#define MPU9250_GYRO_XOUT_H 0x43
#define MPU9250_GYRO_XOUT_L 0x44
#define MPU9250_GYRO_YOUT_H 0x45
#define MPU9250_GYRO_YOUT_L 0x46
#define MPU9250_GYRO_ZOUT_H 0x47
#define MPU9250_GYRO_ZOUT_L 0x48
#define MPU9250_SIGNAL_PATH_RESET 0x68
#define MPU9250_SIGNAL_PATH_RESET_GYRO_RESET 2
#define MPU9250_SIGNAL_PATH_RESET_ACCEL_RESET 1
#define MPU9250_SIGNAL_PATH_RESET_TEMP_RESET 0
#define MPU9250_USER_CTRL 0x6a
#define MPU9250_USER_CTRL_FIFO_EN 6
#define MPU9250_USER_CTRL_I2C_MST_EN 5
#define MPU9250_USER_CTRL_I2C_IF_DIS 4
#define MPU9250_USER_CTRL_FIFO_RESET 2
#define MPU9250_USER_CTRL_I2C_MST_RESET 1
#define MPU9250_USER_CTRL_SIG_COND_RESET 0
#define MPU9250_PWR_MGMT_1 0x6b
#define MPU9250_PWR_MGMT_1_DEVICE_RESET 7
#define MPU9250_PWR_MGMT_1_SLEEP 6
#define MPU9250_PWR_MGMT_1_CYCLE 5
#define MPU9250_PWR_MGMT_1_TEMP_DIS 3
#define MPU9250_PWR_MGMT_1_CLKSEL 0
#define MPU9250_PWR_MGMT_1_CLKSEL_INTERNAL 0
#define MPU9250_PWR_MGMT_1_CLKSEL_PLL_X_AXIS 1
#define MPU9250_PWR_MGMT_1_CLKSEL_PLL_Y_AXIS 2
#define MPU9250_PWR_MGMT_1_CLKSEL_PLL_Z_AXIS 3
#define MPU9250_PWR_MGMT_1_CLKSEL_PLL_EXTERNAL_32K 4
#define MPU9250_PWR_MGMT_1_CLKSEL_PLL_EXTERNAL_19M 5
#define MPU9250_PWR_MGMT_1_CLKSEL_STOP 7
#define MPU9250_PWR_MGMT_1_CLKSEL_MASK 7
#define MPU9250_PWR_MGMT_2 0x6c
#define MPU9250_WHO_AM_I 0x75
#define MPU9250_I_AM_9250 0x71
/* Self test acceleration is approximately 0.5g */
#define MPU9250_ST_ACCEL(full_scale) (32767 / ((full_scale) * 2))
/* Self test gyro is approximately 50°/s */
#define MPU9250_ST_GYRO(full_scale) ((int16_t) (((int32_t) 32767 * (int32_t) 50) / (full_scale)))
#define MPU9250_GYRO_FULLSCALE ((float) 2000 * M_PI/180.0)
static inline float
ao_mpu9250_gyro(float sensor) {
return sensor * ((float) (MPU9250_GYRO_FULLSCALE / 32767.0));
}
#define MPU9250_ACCEL_FULLSCALE 16
static inline float
ao_mpu9250_accel(int16_t sensor) {
return (float) sensor * ((float) (MPU9250_ACCEL_FULLSCALE * GRAVITY / 32767.0));
}
struct ao_mpu9250_sample {
int16_t accel_x;
int16_t accel_y;
int16_t accel_z;
int16_t temp;
int16_t gyro_x;
int16_t gyro_y;
int16_t gyro_z;
};
extern struct ao_mpu9250_sample ao_mpu9250_current;
void
ao_mpu9250_init(void);
/* Product ID Description for MPU9250
* high 4 bits low 4 bits
* Product Name Product Revision
*/
#define MPU9250ES_REV_C4 0x14 /* 0001 0100 */
#define MPU9250ES_REV_C5 0x15 /* 0001 0101 */
#define MPU9250ES_REV_D6 0x16 /* 0001 0110 */
#define MPU9250ES_REV_D7 0x17 /* 0001 0111 */
#define MPU9250ES_REV_D8 0x18 /* 0001 1000 */
#define MPU9250_REV_C4 0x54 /* 0101 0100 */
#define MPU9250_REV_C5 0x55 /* 0101 0101 */
#define MPU9250_REV_D6 0x56 /* 0101 0110 */
#define MPU9250_REV_D7 0x57 /* 0101 0111 */
#define MPU9250_REV_D8 0x58 /* 0101 1000 */
#define MPU9250_REV_D9 0x59 /* 0101 1001 */
#endif /* _AO_MPU9250_H_ */
|
