This is for our FYDP project. 2 MPU6050s are used

Dependencies:   Servo mbed

Committer:
majik
Date:
Sat Mar 21 21:31:29 2015 +0000
Revision:
0:21019d94ad33
Both IMUs work now

Who changed what in which revision?

UserRevisionLine numberNew contents of line
majik 0:21019d94ad33 1 //ported from arduino library: https://github.com/jrowberg/i2cdevlib/tree/master/Arduino/MPU6050
majik 0:21019d94ad33 2 //written by szymon gaertig (email: szymon@gaertig.com.pl)
majik 0:21019d94ad33 3 //
majik 0:21019d94ad33 4 //Changelog:
majik 0:21019d94ad33 5 //2013-01-08 - first beta release
majik 0:21019d94ad33 6
majik 0:21019d94ad33 7 // I2Cdev library collection - MPU6050 I2C device class
majik 0:21019d94ad33 8 // Based on InvenSense MPU-6050 register map document rev. 2.0, 5/19/2011 (RM-MPU-6000A-00)
majik 0:21019d94ad33 9 // 10/3/2011 by Jeff Rowberg <jeff@rowberg.net>
majik 0:21019d94ad33 10 // Updates should (hopefully) always be available at https://github.com/jrowberg/i2cdevlib
majik 0:21019d94ad33 11 //
majik 0:21019d94ad33 12 // Changelog:
majik 0:21019d94ad33 13 // ... - ongoing debug release
majik 0:21019d94ad33 14
majik 0:21019d94ad33 15 // NOTE: THIS IS ONLY A PARIAL RELEASE. THIS DEVICE CLASS IS CURRENTLY UNDERGOING ACTIVE
majik 0:21019d94ad33 16 // DEVELOPMENT AND IS STILL MISSING SOME IMPORTANT FEATURES. PLEASE KEEP THIS IN MIND IF
majik 0:21019d94ad33 17 // YOU DECIDE TO USE THIS PARTICULAR CODE FOR ANYTHING.
majik 0:21019d94ad33 18
majik 0:21019d94ad33 19 /* ============================================
majik 0:21019d94ad33 20 I2Cdev device library code is placed under the MIT license
majik 0:21019d94ad33 21 Copyright (c) 2012 Jeff Rowberg
majik 0:21019d94ad33 22
majik 0:21019d94ad33 23 Permission is hereby granted, free of charge, to any person obtaining a copy
majik 0:21019d94ad33 24 of this software and associated documentation files (the "Software"), to deal
majik 0:21019d94ad33 25 in the Software without restriction, including without limitation the rights
majik 0:21019d94ad33 26 to use, copy, modify, merge, publish, distribute, sublicense, and/or sell
majik 0:21019d94ad33 27 copies of the Software, and to permit persons to whom the Software is
majik 0:21019d94ad33 28 furnished to do so, subject to the following conditions:
majik 0:21019d94ad33 29
majik 0:21019d94ad33 30 The above copyright notice and this permission notice shall be included in
majik 0:21019d94ad33 31 all copies or substantial portions of the Software.
majik 0:21019d94ad33 32
majik 0:21019d94ad33 33 THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, EXPRESS OR
majik 0:21019d94ad33 34 IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF MERCHANTABILITY,
majik 0:21019d94ad33 35 FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. IN NO EVENT SHALL THE
majik 0:21019d94ad33 36 AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY CLAIM, DAMAGES OR OTHER
majik 0:21019d94ad33 37 LIABILITY, WHETHER IN AN ACTION OF CONTRACT, TORT OR OTHERWISE, ARISING FROM,
majik 0:21019d94ad33 38 OUT OF OR IN CONNECTION WITH THE SOFTWARE OR THE USE OR OTHER DEALINGS IN
majik 0:21019d94ad33 39 THE SOFTWARE.
majik 0:21019d94ad33 40 ===============================================
majik 0:21019d94ad33 41 */
majik 0:21019d94ad33 42
majik 0:21019d94ad33 43 #ifndef _MPU6051_H_
majik 0:21019d94ad33 44 #define _MPU6051_H_
majik 0:21019d94ad33 45
majik 0:21019d94ad33 46 #include "I2Cdev2.h"
majik 0:21019d94ad33 47 #include "helper_3dmath.h"
majik 0:21019d94ad33 48
majik 0:21019d94ad33 49 #define MPU6050_ADDRESS_AD0_LOW 0x68 // address pin low (GND), default for InvenSense evaluation board
majik 0:21019d94ad33 50 #define MPU6050_ADDRESS_AD0_HIGH 0x69 // address pin high (VCC)
majik 0:21019d94ad33 51 #define MPU6050_DEFAULT_ADDRESS MPU6050_ADDRESS_AD0_LOW
majik 0:21019d94ad33 52
majik 0:21019d94ad33 53 #define MPU6050_RA_XG_OFFS_TC 0x00 //[7] PWR_MODE, [6:1] XG_OFFS_TC, [0] OTP_BNK_VLD
majik 0:21019d94ad33 54 #define MPU6050_RA_YG_OFFS_TC 0x01 //[7] PWR_MODE, [6:1] YG_OFFS_TC, [0] OTP_BNK_VLD
majik 0:21019d94ad33 55 #define MPU6050_RA_ZG_OFFS_TC 0x02 //[7] PWR_MODE, [6:1] ZG_OFFS_TC, [0] OTP_BNK_VLD
majik 0:21019d94ad33 56 #define MPU6050_RA_X_FINE_GAIN 0x03 //[7:0] X_FINE_GAIN
majik 0:21019d94ad33 57 #define MPU6050_RA_Y_FINE_GAIN 0x04 //[7:0] Y_FINE_GAIN
majik 0:21019d94ad33 58 #define MPU6050_RA_Z_FINE_GAIN 0x05 //[7:0] Z_FINE_GAIN
majik 0:21019d94ad33 59 #define MPU6050_RA_XA_OFFS_H 0x06 //[15:0] XA_OFFS
majik 0:21019d94ad33 60 #define MPU6050_RA_XA_OFFS_L_TC 0x07
majik 0:21019d94ad33 61 #define MPU6050_RA_YA_OFFS_H 0x08 //[15:0] YA_OFFS
majik 0:21019d94ad33 62 #define MPU6050_RA_YA_OFFS_L_TC 0x09
majik 0:21019d94ad33 63 #define MPU6050_RA_ZA_OFFS_H 0x0A //[15:0] ZA_OFFS
majik 0:21019d94ad33 64 #define MPU6050_RA_ZA_OFFS_L_TC 0x0B
majik 0:21019d94ad33 65 #define MPU6050_RA_XG_OFFS_USRH 0x13 //[15:0] XG_OFFS_USR
majik 0:21019d94ad33 66 #define MPU6050_RA_XG_OFFS_USRL 0x14
majik 0:21019d94ad33 67 #define MPU6050_RA_YG_OFFS_USRH 0x15 //[15:0] YG_OFFS_USR
majik 0:21019d94ad33 68 #define MPU6050_RA_YG_OFFS_USRL 0x16
majik 0:21019d94ad33 69 #define MPU6050_RA_ZG_OFFS_USRH 0x17 //[15:0] ZG_OFFS_USR
majik 0:21019d94ad33 70 #define MPU6050_RA_ZG_OFFS_USRL 0x18
majik 0:21019d94ad33 71 #define MPU6050_RA_SMPLRT_DIV 0x19
majik 0:21019d94ad33 72 #define MPU6050_RA_CONFIG 0x1A
majik 0:21019d94ad33 73 #define MPU6050_RA_GYRO_CONFIG 0x1B
majik 0:21019d94ad33 74 #define MPU6050_RA_ACCEL_CONFIG 0x1C
majik 0:21019d94ad33 75 #define MPU6050_RA_FF_THR 0x1D
majik 0:21019d94ad33 76 #define MPU6050_RA_FF_DUR 0x1E
majik 0:21019d94ad33 77 #define MPU6050_RA_MOT_THR 0x1F
majik 0:21019d94ad33 78 #define MPU6050_RA_MOT_DUR 0x20
majik 0:21019d94ad33 79 #define MPU6050_RA_ZRMOT_THR 0x21
majik 0:21019d94ad33 80 #define MPU6050_RA_ZRMOT_DUR 0x22
majik 0:21019d94ad33 81 #define MPU6050_RA_FIFO_EN 0x23
majik 0:21019d94ad33 82 #define MPU6050_RA_I2C_MST_CTRL 0x24
majik 0:21019d94ad33 83 #define MPU6050_RA_I2C_SLV0_ADDR 0x25
majik 0:21019d94ad33 84 #define MPU6050_RA_I2C_SLV0_REG 0x26
majik 0:21019d94ad33 85 #define MPU6050_RA_I2C_SLV0_CTRL 0x27
majik 0:21019d94ad33 86 #define MPU6050_RA_I2C_SLV1_ADDR 0x28
majik 0:21019d94ad33 87 #define MPU6050_RA_I2C_SLV1_REG 0x29
majik 0:21019d94ad33 88 #define MPU6050_RA_I2C_SLV1_CTRL 0x2A
majik 0:21019d94ad33 89 #define MPU6050_RA_I2C_SLV2_ADDR 0x2B
majik 0:21019d94ad33 90 #define MPU6050_RA_I2C_SLV2_REG 0x2C
majik 0:21019d94ad33 91 #define MPU6050_RA_I2C_SLV2_CTRL 0x2D
majik 0:21019d94ad33 92 #define MPU6050_RA_I2C_SLV3_ADDR 0x2E
majik 0:21019d94ad33 93 #define MPU6050_RA_I2C_SLV3_REG 0x2F
majik 0:21019d94ad33 94 #define MPU6050_RA_I2C_SLV3_CTRL 0x30
majik 0:21019d94ad33 95 #define MPU6050_RA_I2C_SLV4_ADDR 0x31
majik 0:21019d94ad33 96 #define MPU6050_RA_I2C_SLV4_REG 0x32
majik 0:21019d94ad33 97 #define MPU6050_RA_I2C_SLV4_DO 0x33
majik 0:21019d94ad33 98 #define MPU6050_RA_I2C_SLV4_CTRL 0x34
majik 0:21019d94ad33 99 #define MPU6050_RA_I2C_SLV4_DI 0x35
majik 0:21019d94ad33 100 #define MPU6050_RA_I2C_MST_STATUS 0x36
majik 0:21019d94ad33 101 #define MPU6050_RA_INT_PIN_CFG 0x37
majik 0:21019d94ad33 102 #define MPU6050_RA_INT_ENABLE 0x38
majik 0:21019d94ad33 103 #define MPU6050_RA_DMP_INT_STATUS 0x39
majik 0:21019d94ad33 104 #define MPU6050_RA_INT_STATUS 0x3A
majik 0:21019d94ad33 105
majik 0:21019d94ad33 106 #define MPU6050_RA_ACCEL_XOUT_H 0x3B
majik 0:21019d94ad33 107 #define MPU6050_RA_ACCEL_XOUT_L 0x3C
majik 0:21019d94ad33 108 #define MPU6050_RA_ACCEL_YOUT_H 0x3D
majik 0:21019d94ad33 109 #define MPU6050_RA_ACCEL_YOUT_L 0x3E
majik 0:21019d94ad33 110 #define MPU6050_RA_ACCEL_ZOUT_H 0x3F
majik 0:21019d94ad33 111 #define MPU6050_RA_ACCEL_ZOUT_L 0x40
majik 0:21019d94ad33 112
majik 0:21019d94ad33 113 #define MPU6050_RA_TEMP_OUT_H 0x41
majik 0:21019d94ad33 114 #define MPU6050_RA_TEMP_OUT_L 0x42
majik 0:21019d94ad33 115
majik 0:21019d94ad33 116 #define MPU6050_RA_GYRO_XOUT_H 0x43
majik 0:21019d94ad33 117 #define MPU6050_RA_GYRO_XOUT_L 0x44
majik 0:21019d94ad33 118 #define MPU6050_RA_GYRO_YOUT_H 0x45
majik 0:21019d94ad33 119 #define MPU6050_RA_GYRO_YOUT_L 0x46
majik 0:21019d94ad33 120 #define MPU6050_RA_GYRO_ZOUT_H 0x47
majik 0:21019d94ad33 121 #define MPU6050_RA_GYRO_ZOUT_L 0x48
majik 0:21019d94ad33 122
majik 0:21019d94ad33 123 #define MPU9150_RA_MAG_ADDRESS 0x0C
majik 0:21019d94ad33 124 #define MPU9150_RA_MAG_XOUT_L 0x03
majik 0:21019d94ad33 125 #define MPU9150_RA_MAG_XOUT_H 0x04
majik 0:21019d94ad33 126 #define MPU9150_RA_MAG_YOUT_L 0x05
majik 0:21019d94ad33 127 #define MPU9150_RA_MAG_YOUT_H 0x06
majik 0:21019d94ad33 128 #define MPU9150_RA_MAG_ZOUT_L 0x07
majik 0:21019d94ad33 129 #define MPU9150_RA_MAG_ZOUT_H 0x08
majik 0:21019d94ad33 130
majik 0:21019d94ad33 131 #define MPU6050_RA_EXT_SENS_DATA_00 0x49
majik 0:21019d94ad33 132 #define MPU6050_RA_EXT_SENS_DATA_01 0x4A
majik 0:21019d94ad33 133 #define MPU6050_RA_EXT_SENS_DATA_02 0x4B
majik 0:21019d94ad33 134 #define MPU6050_RA_EXT_SENS_DATA_03 0x4C
majik 0:21019d94ad33 135 #define MPU6050_RA_EXT_SENS_DATA_04 0x4D
majik 0:21019d94ad33 136 #define MPU6050_RA_EXT_SENS_DATA_05 0x4E
majik 0:21019d94ad33 137 #define MPU6050_RA_EXT_SENS_DATA_06 0x4F
majik 0:21019d94ad33 138 #define MPU6050_RA_EXT_SENS_DATA_07 0x50
majik 0:21019d94ad33 139 #define MPU6050_RA_EXT_SENS_DATA_08 0x51
majik 0:21019d94ad33 140 #define MPU6050_RA_EXT_SENS_DATA_09 0x52
majik 0:21019d94ad33 141 #define MPU6050_RA_EXT_SENS_DATA_10 0x53
majik 0:21019d94ad33 142 #define MPU6050_RA_EXT_SENS_DATA_11 0x54
majik 0:21019d94ad33 143 #define MPU6050_RA_EXT_SENS_DATA_12 0x55
majik 0:21019d94ad33 144 #define MPU6050_RA_EXT_SENS_DATA_13 0x56
majik 0:21019d94ad33 145 #define MPU6050_RA_EXT_SENS_DATA_14 0x57
majik 0:21019d94ad33 146 #define MPU6050_RA_EXT_SENS_DATA_15 0x58
majik 0:21019d94ad33 147 #define MPU6050_RA_EXT_SENS_DATA_16 0x59
majik 0:21019d94ad33 148 #define MPU6050_RA_EXT_SENS_DATA_17 0x5A
majik 0:21019d94ad33 149 #define MPU6050_RA_EXT_SENS_DATA_18 0x5B
majik 0:21019d94ad33 150 #define MPU6050_RA_EXT_SENS_DATA_19 0x5C
majik 0:21019d94ad33 151 #define MPU6050_RA_EXT_SENS_DATA_20 0x5D
majik 0:21019d94ad33 152 #define MPU6050_RA_EXT_SENS_DATA_21 0x5E
majik 0:21019d94ad33 153 #define MPU6050_RA_EXT_SENS_DATA_22 0x5F
majik 0:21019d94ad33 154 #define MPU6050_RA_EXT_SENS_DATA_23 0x60
majik 0:21019d94ad33 155 #define MPU6050_RA_MOT_DETECT_STATUS 0x61
majik 0:21019d94ad33 156 #define MPU6050_RA_I2C_SLV0_DO 0x63
majik 0:21019d94ad33 157 #define MPU6050_RA_I2C_SLV1_DO 0x64
majik 0:21019d94ad33 158 #define MPU6050_RA_I2C_SLV2_DO 0x65
majik 0:21019d94ad33 159 #define MPU6050_RA_I2C_SLV3_DO 0x66
majik 0:21019d94ad33 160 #define MPU6050_RA_I2C_MST_DELAY_CTRL 0x67
majik 0:21019d94ad33 161 #define MPU6050_RA_SIGNAL_PATH_RESET 0x68
majik 0:21019d94ad33 162 #define MPU6050_RA_MOT_DETECT_CTRL 0x69
majik 0:21019d94ad33 163 #define MPU6050_RA_USER_CTRL 0x6A
majik 0:21019d94ad33 164 #define MPU6050_RA_PWR_MGMT_1 0x6B
majik 0:21019d94ad33 165 #define MPU6050_RA_PWR_MGMT_2 0x6C
majik 0:21019d94ad33 166 #define MPU6050_RA_BANK_SEL 0x6D
majik 0:21019d94ad33 167 #define MPU6050_RA_MEM_START_ADDR 0x6E
majik 0:21019d94ad33 168 #define MPU6050_RA_MEM_R_W 0x6F
majik 0:21019d94ad33 169 #define MPU6050_RA_DMP_CFG_1 0x70
majik 0:21019d94ad33 170 #define MPU6050_RA_DMP_CFG_2 0x71
majik 0:21019d94ad33 171 #define MPU6050_RA_FIFO_COUNTH 0x72
majik 0:21019d94ad33 172 #define MPU6050_RA_FIFO_COUNTL 0x73
majik 0:21019d94ad33 173 #define MPU6050_RA_FIFO_R_W 0x74
majik 0:21019d94ad33 174 #define MPU6050_RA_WHO_AM_I 0x75
majik 0:21019d94ad33 175
majik 0:21019d94ad33 176 #define MPU6050_TC_PWR_MODE_BIT 7
majik 0:21019d94ad33 177 #define MPU6050_TC_OFFSET_BIT 6
majik 0:21019d94ad33 178 #define MPU6050_TC_OFFSET_LENGTH 6
majik 0:21019d94ad33 179 #define MPU6050_TC_OTP_BNK_VLD_BIT 0
majik 0:21019d94ad33 180
majik 0:21019d94ad33 181 #define MPU6050_VDDIO_LEVEL_VLOGIC 0
majik 0:21019d94ad33 182 #define MPU6050_VDDIO_LEVEL_VDD 1
majik 0:21019d94ad33 183
majik 0:21019d94ad33 184 #define MPU6050_CFG_EXT_SYNC_SET_BIT 5
majik 0:21019d94ad33 185 #define MPU6050_CFG_EXT_SYNC_SET_LENGTH 3
majik 0:21019d94ad33 186 #define MPU6050_CFG_DLPF_CFG_BIT 2
majik 0:21019d94ad33 187 #define MPU6050_CFG_DLPF_CFG_LENGTH 3
majik 0:21019d94ad33 188
majik 0:21019d94ad33 189 #define MPU6050_EXT_SYNC_DISABLED 0x0
majik 0:21019d94ad33 190 #define MPU6050_EXT_SYNC_TEMP_OUT_L 0x1
majik 0:21019d94ad33 191 #define MPU6050_EXT_SYNC_GYRO_XOUT_L 0x2
majik 0:21019d94ad33 192 #define MPU6050_EXT_SYNC_GYRO_YOUT_L 0x3
majik 0:21019d94ad33 193 #define MPU6050_EXT_SYNC_GYRO_ZOUT_L 0x4
majik 0:21019d94ad33 194 #define MPU6050_EXT_SYNC_ACCEL_XOUT_L 0x5
majik 0:21019d94ad33 195 #define MPU6050_EXT_SYNC_ACCEL_YOUT_L 0x6
majik 0:21019d94ad33 196 #define MPU6050_EXT_SYNC_ACCEL_ZOUT_L 0x7
majik 0:21019d94ad33 197
majik 0:21019d94ad33 198 #define MPU6050_DLPF_BW_256 0x00
majik 0:21019d94ad33 199 #define MPU6050_DLPF_BW_188 0x01
majik 0:21019d94ad33 200 #define MPU6050_DLPF_BW_98 0x02
majik 0:21019d94ad33 201 #define MPU6050_DLPF_BW_42 0x03
majik 0:21019d94ad33 202 #define MPU6050_DLPF_BW_20 0x04
majik 0:21019d94ad33 203 #define MPU6050_DLPF_BW_10 0x05
majik 0:21019d94ad33 204 #define MPU6050_DLPF_BW_5 0x06
majik 0:21019d94ad33 205
majik 0:21019d94ad33 206 #define MPU6050_GCONFIG_FS_SEL_BIT 4
majik 0:21019d94ad33 207 #define MPU6050_GCONFIG_FS_SEL_LENGTH 2
majik 0:21019d94ad33 208
majik 0:21019d94ad33 209 #define MPU6050_GYRO_FS_250 0x00
majik 0:21019d94ad33 210 #define MPU6050_GYRO_FS_500 0x01
majik 0:21019d94ad33 211 #define MPU6050_GYRO_FS_1000 0x02
majik 0:21019d94ad33 212 #define MPU6050_GYRO_FS_2000 0x03
majik 0:21019d94ad33 213
majik 0:21019d94ad33 214 #define MPU6050_ACONFIG_XA_ST_BIT 7
majik 0:21019d94ad33 215 #define MPU6050_ACONFIG_YA_ST_BIT 6
majik 0:21019d94ad33 216 #define MPU6050_ACONFIG_ZA_ST_BIT 5
majik 0:21019d94ad33 217 #define MPU6050_ACONFIG_AFS_SEL_BIT 4
majik 0:21019d94ad33 218 #define MPU6050_ACONFIG_AFS_SEL_LENGTH 2
majik 0:21019d94ad33 219 #define MPU6050_ACONFIG_ACCEL_HPF_BIT 2
majik 0:21019d94ad33 220 #define MPU6050_ACONFIG_ACCEL_HPF_LENGTH 3
majik 0:21019d94ad33 221
majik 0:21019d94ad33 222 #define MPU6050_ACCEL_FS_2 0x00
majik 0:21019d94ad33 223 #define MPU6050_ACCEL_FS_4 0x01
majik 0:21019d94ad33 224 #define MPU6050_ACCEL_FS_8 0x02
majik 0:21019d94ad33 225 #define MPU6050_ACCEL_FS_16 0x03
majik 0:21019d94ad33 226
majik 0:21019d94ad33 227 #define MPU6050_DHPF_RESET 0x00
majik 0:21019d94ad33 228 #define MPU6050_DHPF_5 0x01
majik 0:21019d94ad33 229 #define MPU6050_DHPF_2P5 0x02
majik 0:21019d94ad33 230 #define MPU6050_DHPF_1P25 0x03
majik 0:21019d94ad33 231 #define MPU6050_DHPF_0P63 0x04
majik 0:21019d94ad33 232 #define MPU6050_DHPF_HOLD 0x07
majik 0:21019d94ad33 233
majik 0:21019d94ad33 234 #define MPU6050_TEMP_FIFO_EN_BIT 7
majik 0:21019d94ad33 235 #define MPU6050_XG_FIFO_EN_BIT 6
majik 0:21019d94ad33 236 #define MPU6050_YG_FIFO_EN_BIT 5
majik 0:21019d94ad33 237 #define MPU6050_ZG_FIFO_EN_BIT 4
majik 0:21019d94ad33 238 #define MPU6050_ACCEL_FIFO_EN_BIT 3
majik 0:21019d94ad33 239 #define MPU6050_SLV2_FIFO_EN_BIT 2
majik 0:21019d94ad33 240 #define MPU6050_SLV1_FIFO_EN_BIT 1
majik 0:21019d94ad33 241 #define MPU6050_SLV0_FIFO_EN_BIT 0
majik 0:21019d94ad33 242
majik 0:21019d94ad33 243 #define MPU6050_MULT_MST_EN_BIT 7
majik 0:21019d94ad33 244 #define MPU6050_WAIT_FOR_ES_BIT 6
majik 0:21019d94ad33 245 #define MPU6050_SLV_3_FIFO_EN_BIT 5
majik 0:21019d94ad33 246 #define MPU6050_I2C_MST_P_NSR_BIT 4
majik 0:21019d94ad33 247 #define MPU6050_I2C_MST_CLK_BIT 3
majik 0:21019d94ad33 248 #define MPU6050_I2C_MST_CLK_LENGTH 4
majik 0:21019d94ad33 249
majik 0:21019d94ad33 250 #define MPU6050_CLOCK_DIV_348 0x0
majik 0:21019d94ad33 251 #define MPU6050_CLOCK_DIV_333 0x1
majik 0:21019d94ad33 252 #define MPU6050_CLOCK_DIV_320 0x2
majik 0:21019d94ad33 253 #define MPU6050_CLOCK_DIV_308 0x3
majik 0:21019d94ad33 254 #define MPU6050_CLOCK_DIV_296 0x4
majik 0:21019d94ad33 255 #define MPU6050_CLOCK_DIV_286 0x5
majik 0:21019d94ad33 256 #define MPU6050_CLOCK_DIV_276 0x6
majik 0:21019d94ad33 257 #define MPU6050_CLOCK_DIV_267 0x7
majik 0:21019d94ad33 258 #define MPU6050_CLOCK_DIV_258 0x8
majik 0:21019d94ad33 259 #define MPU6050_CLOCK_DIV_500 0x9
majik 0:21019d94ad33 260 #define MPU6050_CLOCK_DIV_471 0xA
majik 0:21019d94ad33 261 #define MPU6050_CLOCK_DIV_444 0xB
majik 0:21019d94ad33 262 #define MPU6050_CLOCK_DIV_421 0xC
majik 0:21019d94ad33 263 #define MPU6050_CLOCK_DIV_400 0xD
majik 0:21019d94ad33 264 #define MPU6050_CLOCK_DIV_381 0xE
majik 0:21019d94ad33 265 #define MPU6050_CLOCK_DIV_364 0xF
majik 0:21019d94ad33 266
majik 0:21019d94ad33 267 #define MPU6050_I2C_SLV_RW_BIT 7
majik 0:21019d94ad33 268 #define MPU6050_I2C_SLV_ADDR_BIT 6
majik 0:21019d94ad33 269 #define MPU6050_I2C_SLV_ADDR_LENGTH 7
majik 0:21019d94ad33 270 #define MPU6050_I2C_SLV_EN_BIT 7
majik 0:21019d94ad33 271 #define MPU6050_I2C_SLV_BYTE_SW_BIT 6
majik 0:21019d94ad33 272 #define MPU6050_I2C_SLV_REG_DIS_BIT 5
majik 0:21019d94ad33 273 #define MPU6050_I2C_SLV_GRP_BIT 4
majik 0:21019d94ad33 274 #define MPU6050_I2C_SLV_LEN_BIT 3
majik 0:21019d94ad33 275 #define MPU6050_I2C_SLV_LEN_LENGTH 4
majik 0:21019d94ad33 276
majik 0:21019d94ad33 277 #define MPU6050_I2C_SLV4_RW_BIT 7
majik 0:21019d94ad33 278 #define MPU6050_I2C_SLV4_ADDR_BIT 6
majik 0:21019d94ad33 279 #define MPU6050_I2C_SLV4_ADDR_LENGTH 7
majik 0:21019d94ad33 280 #define MPU6050_I2C_SLV4_EN_BIT 7
majik 0:21019d94ad33 281 #define MPU6050_I2C_SLV4_INT_EN_BIT 6
majik 0:21019d94ad33 282 #define MPU6050_I2C_SLV4_REG_DIS_BIT 5
majik 0:21019d94ad33 283 #define MPU6050_I2C_SLV4_MST_DLY_BIT 4
majik 0:21019d94ad33 284 #define MPU6050_I2C_SLV4_MST_DLY_LENGTH 5
majik 0:21019d94ad33 285
majik 0:21019d94ad33 286 #define MPU6050_MST_PASS_THROUGH_BIT 7
majik 0:21019d94ad33 287 #define MPU6050_MST_I2C_SLV4_DONE_BIT 6
majik 0:21019d94ad33 288 #define MPU6050_MST_I2C_LOST_ARB_BIT 5
majik 0:21019d94ad33 289 #define MPU6050_MST_I2C_SLV4_NACK_BIT 4
majik 0:21019d94ad33 290 #define MPU6050_MST_I2C_SLV3_NACK_BIT 3
majik 0:21019d94ad33 291 #define MPU6050_MST_I2C_SLV2_NACK_BIT 2
majik 0:21019d94ad33 292 #define MPU6050_MST_I2C_SLV1_NACK_BIT 1
majik 0:21019d94ad33 293 #define MPU6050_MST_I2C_SLV0_NACK_BIT 0
majik 0:21019d94ad33 294
majik 0:21019d94ad33 295 #define MPU6050_INTCFG_INT_LEVEL_BIT 7
majik 0:21019d94ad33 296 #define MPU6050_INTCFG_INT_OPEN_BIT 6
majik 0:21019d94ad33 297 #define MPU6050_INTCFG_LATCH_INT_EN_BIT 5
majik 0:21019d94ad33 298 #define MPU6050_INTCFG_INT_RD_CLEAR_BIT 4
majik 0:21019d94ad33 299 #define MPU6050_INTCFG_FSYNC_INT_LEVEL_BIT 3
majik 0:21019d94ad33 300 #define MPU6050_INTCFG_FSYNC_INT_EN_BIT 2
majik 0:21019d94ad33 301 #define MPU6050_INTCFG_I2C_BYPASS_EN_BIT 1
majik 0:21019d94ad33 302 #define MPU6050_INTCFG_CLKOUT_EN_BIT 0
majik 0:21019d94ad33 303
majik 0:21019d94ad33 304 #define MPU6050_INTMODE_ACTIVEHIGH 0x00
majik 0:21019d94ad33 305 #define MPU6050_INTMODE_ACTIVELOW 0x01
majik 0:21019d94ad33 306
majik 0:21019d94ad33 307 #define MPU6050_INTDRV_PUSHPULL 0x00
majik 0:21019d94ad33 308 #define MPU6050_INTDRV_OPENDRAIN 0x01
majik 0:21019d94ad33 309
majik 0:21019d94ad33 310 #define MPU6050_INTLATCH_50USPULSE 0x00
majik 0:21019d94ad33 311 #define MPU6050_INTLATCH_WAITCLEAR 0x01
majik 0:21019d94ad33 312
majik 0:21019d94ad33 313 #define MPU6050_INTCLEAR_STATUSREAD 0x00
majik 0:21019d94ad33 314 #define MPU6050_INTCLEAR_ANYREAD 0x01
majik 0:21019d94ad33 315
majik 0:21019d94ad33 316 #define MPU6050_INTERRUPT_FF_BIT 7
majik 0:21019d94ad33 317 #define MPU6050_INTERRUPT_MOT_BIT 6
majik 0:21019d94ad33 318 #define MPU6050_INTERRUPT_ZMOT_BIT 5
majik 0:21019d94ad33 319 #define MPU6050_INTERRUPT_FIFO_OFLOW_BIT 4
majik 0:21019d94ad33 320 #define MPU6050_INTERRUPT_I2C_MST_INT_BIT 3
majik 0:21019d94ad33 321 #define MPU6050_INTERRUPT_PLL_RDY_INT_BIT 2
majik 0:21019d94ad33 322 #define MPU6050_INTERRUPT_DMP_INT_BIT 1
majik 0:21019d94ad33 323 #define MPU6050_INTERRUPT_DATA_RDY_BIT 0
majik 0:21019d94ad33 324
majik 0:21019d94ad33 325 // TODO: figure out what these actually do
majik 0:21019d94ad33 326 // UMPL source code is not very obivous
majik 0:21019d94ad33 327 #define MPU6050_DMPINT_5_BIT 5
majik 0:21019d94ad33 328 #define MPU6050_DMPINT_4_BIT 4
majik 0:21019d94ad33 329 #define MPU6050_DMPINT_3_BIT 3
majik 0:21019d94ad33 330 #define MPU6050_DMPINT_2_BIT 2
majik 0:21019d94ad33 331 #define MPU6050_DMPINT_1_BIT 1
majik 0:21019d94ad33 332 #define MPU6050_DMPINT_0_BIT 0
majik 0:21019d94ad33 333
majik 0:21019d94ad33 334 #define MPU6050_MOTION_MOT_XNEG_BIT 7
majik 0:21019d94ad33 335 #define MPU6050_MOTION_MOT_XPOS_BIT 6
majik 0:21019d94ad33 336 #define MPU6050_MOTION_MOT_YNEG_BIT 5
majik 0:21019d94ad33 337 #define MPU6050_MOTION_MOT_YPOS_BIT 4
majik 0:21019d94ad33 338 #define MPU6050_MOTION_MOT_ZNEG_BIT 3
majik 0:21019d94ad33 339 #define MPU6050_MOTION_MOT_ZPOS_BIT 2
majik 0:21019d94ad33 340 #define MPU6050_MOTION_MOT_ZRMOT_BIT 0
majik 0:21019d94ad33 341
majik 0:21019d94ad33 342 #define MPU6050_DELAYCTRL_DELAY_ES_SHADOW_BIT 7
majik 0:21019d94ad33 343 #define MPU6050_DELAYCTRL_I2C_SLV4_DLY_EN_BIT 4
majik 0:21019d94ad33 344 #define MPU6050_DELAYCTRL_I2C_SLV3_DLY_EN_BIT 3
majik 0:21019d94ad33 345 #define MPU6050_DELAYCTRL_I2C_SLV2_DLY_EN_BIT 2
majik 0:21019d94ad33 346 #define MPU6050_DELAYCTRL_I2C_SLV1_DLY_EN_BIT 1
majik 0:21019d94ad33 347 #define MPU6050_DELAYCTRL_I2C_SLV0_DLY_EN_BIT 0
majik 0:21019d94ad33 348
majik 0:21019d94ad33 349 #define MPU6050_PATHRESET_GYRO_RESET_BIT 2
majik 0:21019d94ad33 350 #define MPU6050_PATHRESET_ACCEL_RESET_BIT 1
majik 0:21019d94ad33 351 #define MPU6050_PATHRESET_TEMP_RESET_BIT 0
majik 0:21019d94ad33 352
majik 0:21019d94ad33 353 #define MPU6050_DETECT_ACCEL_ON_DELAY_BIT 5
majik 0:21019d94ad33 354 #define MPU6050_DETECT_ACCEL_ON_DELAY_LENGTH 2
majik 0:21019d94ad33 355 #define MPU6050_DETECT_FF_COUNT_BIT 3
majik 0:21019d94ad33 356 #define MPU6050_DETECT_FF_COUNT_LENGTH 2
majik 0:21019d94ad33 357 #define MPU6050_DETECT_MOT_COUNT_BIT 1
majik 0:21019d94ad33 358 #define MPU6050_DETECT_MOT_COUNT_LENGTH 2
majik 0:21019d94ad33 359
majik 0:21019d94ad33 360 #define MPU6050_DETECT_DECREMENT_RESET 0x0
majik 0:21019d94ad33 361 #define MPU6050_DETECT_DECREMENT_1 0x1
majik 0:21019d94ad33 362 #define MPU6050_DETECT_DECREMENT_2 0x2
majik 0:21019d94ad33 363 #define MPU6050_DETECT_DECREMENT_4 0x3
majik 0:21019d94ad33 364
majik 0:21019d94ad33 365 #define MPU6050_USERCTRL_DMP_EN_BIT 7
majik 0:21019d94ad33 366 #define MPU6050_USERCTRL_FIFO_EN_BIT 6
majik 0:21019d94ad33 367 #define MPU6050_USERCTRL_I2C_MST_EN_BIT 5
majik 0:21019d94ad33 368 #define MPU6050_USERCTRL_I2C_IF_DIS_BIT 4
majik 0:21019d94ad33 369 #define MPU6050_USERCTRL_DMP_RESET_BIT 3
majik 0:21019d94ad33 370 #define MPU6050_USERCTRL_FIFO_RESET_BIT 2
majik 0:21019d94ad33 371 #define MPU6050_USERCTRL_I2C_MST_RESET_BIT 1
majik 0:21019d94ad33 372 #define MPU6050_USERCTRL_SIG_COND_RESET_BIT 0
majik 0:21019d94ad33 373
majik 0:21019d94ad33 374 #define MPU6050_PWR1_DEVICE_RESET_BIT 7
majik 0:21019d94ad33 375 #define MPU6050_PWR1_SLEEP_BIT 6
majik 0:21019d94ad33 376 #define MPU6050_PWR1_CYCLE_BIT 5
majik 0:21019d94ad33 377 #define MPU6050_PWR1_TEMP_DIS_BIT 3
majik 0:21019d94ad33 378 #define MPU6050_PWR1_CLKSEL_BIT 2
majik 0:21019d94ad33 379 #define MPU6050_PWR1_CLKSEL_LENGTH 3
majik 0:21019d94ad33 380
majik 0:21019d94ad33 381 #define MPU6050_CLOCK_INTERNAL 0x00
majik 0:21019d94ad33 382 #define MPU6050_CLOCK_PLL_XGYRO 0x01
majik 0:21019d94ad33 383 #define MPU6050_CLOCK_PLL_YGYRO 0x02
majik 0:21019d94ad33 384 #define MPU6050_CLOCK_PLL_ZGYRO 0x03
majik 0:21019d94ad33 385 #define MPU6050_CLOCK_PLL_EXT32K 0x04
majik 0:21019d94ad33 386 #define MPU6050_CLOCK_PLL_EXT19M 0x05
majik 0:21019d94ad33 387 #define MPU6050_CLOCK_KEEP_RESET 0x07
majik 0:21019d94ad33 388
majik 0:21019d94ad33 389 #define MPU6050_PWR2_LP_WAKE_CTRL_BIT 7
majik 0:21019d94ad33 390 #define MPU6050_PWR2_LP_WAKE_CTRL_LENGTH 2
majik 0:21019d94ad33 391 #define MPU6050_PWR2_STBY_XA_BIT 5
majik 0:21019d94ad33 392 #define MPU6050_PWR2_STBY_YA_BIT 4
majik 0:21019d94ad33 393 #define MPU6050_PWR2_STBY_ZA_BIT 3
majik 0:21019d94ad33 394 #define MPU6050_PWR2_STBY_XG_BIT 2
majik 0:21019d94ad33 395 #define MPU6050_PWR2_STBY_YG_BIT 1
majik 0:21019d94ad33 396 #define MPU6050_PWR2_STBY_ZG_BIT 0
majik 0:21019d94ad33 397
majik 0:21019d94ad33 398 #define MPU6050_WAKE_FREQ_1P25 0x0
majik 0:21019d94ad33 399 #define MPU6050_WAKE_FREQ_2P5 0x1
majik 0:21019d94ad33 400 #define MPU6050_WAKE_FREQ_5 0x2
majik 0:21019d94ad33 401 #define MPU6050_WAKE_FREQ_10 0x3
majik 0:21019d94ad33 402
majik 0:21019d94ad33 403 #define MPU6050_BANKSEL_PRFTCH_EN_BIT 6
majik 0:21019d94ad33 404 #define MPU6050_BANKSEL_CFG_USER_BANK_BIT 5
majik 0:21019d94ad33 405 #define MPU6050_BANKSEL_MEM_SEL_BIT 4
majik 0:21019d94ad33 406 #define MPU6050_BANKSEL_MEM_SEL_LENGTH 5
majik 0:21019d94ad33 407
majik 0:21019d94ad33 408 #define MPU6050_WHO_AM_I_BIT 6
majik 0:21019d94ad33 409 #define MPU6050_WHO_AM_I_LENGTH 6
majik 0:21019d94ad33 410
majik 0:21019d94ad33 411 #define MPU6050_DMP_MEMORY_BANKS 8
majik 0:21019d94ad33 412 #define MPU6050_DMP_MEMORY_BANK_SIZE 256
majik 0:21019d94ad33 413 #define MPU6050_DMP_MEMORY_CHUNK_SIZE 16
majik 0:21019d94ad33 414
majik 0:21019d94ad33 415 // note: DMP code memory blocks defined at end of header file
majik 0:21019d94ad33 416
majik 0:21019d94ad33 417 class MPU6051 {
majik 0:21019d94ad33 418 private:
majik 0:21019d94ad33 419 I2Cdev2 i2Cdev;
majik 0:21019d94ad33 420 // Serial debugSerial;
majik 0:21019d94ad33 421 public:
majik 0:21019d94ad33 422 MPU6051();
majik 0:21019d94ad33 423 MPU6051(uint8_t address);
majik 0:21019d94ad33 424
majik 0:21019d94ad33 425 void initialize();
majik 0:21019d94ad33 426 bool testConnection();
majik 0:21019d94ad33 427
majik 0:21019d94ad33 428 // AUX_VDDIO register
majik 0:21019d94ad33 429 uint8_t getAuxVDDIOLevel();
majik 0:21019d94ad33 430 void setAuxVDDIOLevel(uint8_t level);
majik 0:21019d94ad33 431
majik 0:21019d94ad33 432 // SMPLRT_DIV register
majik 0:21019d94ad33 433 uint8_t getRate();
majik 0:21019d94ad33 434 void setRate(uint8_t rate);
majik 0:21019d94ad33 435
majik 0:21019d94ad33 436 // CONFIG register
majik 0:21019d94ad33 437 uint8_t getExternalFrameSync();
majik 0:21019d94ad33 438 void setExternalFrameSync(uint8_t sync);
majik 0:21019d94ad33 439 uint8_t getDLPFMode();
majik 0:21019d94ad33 440 void setDLPFMode(uint8_t bandwidth);
majik 0:21019d94ad33 441
majik 0:21019d94ad33 442 // GYRO_CONFIG register
majik 0:21019d94ad33 443 uint8_t getFullScaleGyroRange();
majik 0:21019d94ad33 444 void setFullScaleGyroRange(uint8_t range);
majik 0:21019d94ad33 445
majik 0:21019d94ad33 446 // ACCEL_CONFIG register
majik 0:21019d94ad33 447 bool getAccelXSelfTest();
majik 0:21019d94ad33 448 void setAccelXSelfTest(bool enabled);
majik 0:21019d94ad33 449 bool getAccelYSelfTest();
majik 0:21019d94ad33 450 void setAccelYSelfTest(bool enabled);
majik 0:21019d94ad33 451 bool getAccelZSelfTest();
majik 0:21019d94ad33 452 void setAccelZSelfTest(bool enabled);
majik 0:21019d94ad33 453 uint8_t getFullScaleAccelRange();
majik 0:21019d94ad33 454 void setFullScaleAccelRange(uint8_t range);
majik 0:21019d94ad33 455 uint8_t getDHPFMode();
majik 0:21019d94ad33 456 void setDHPFMode(uint8_t mode);
majik 0:21019d94ad33 457
majik 0:21019d94ad33 458 // FF_THR register
majik 0:21019d94ad33 459 uint8_t getFreefallDetectionThreshold();
majik 0:21019d94ad33 460 void setFreefallDetectionThreshold(uint8_t threshold);
majik 0:21019d94ad33 461
majik 0:21019d94ad33 462 // FF_DUR register
majik 0:21019d94ad33 463 uint8_t getFreefallDetectionDuration();
majik 0:21019d94ad33 464 void setFreefallDetectionDuration(uint8_t duration);
majik 0:21019d94ad33 465
majik 0:21019d94ad33 466 // MOT_THR register
majik 0:21019d94ad33 467 uint8_t getMotionDetectionThreshold();
majik 0:21019d94ad33 468 void setMotionDetectionThreshold(uint8_t threshold);
majik 0:21019d94ad33 469
majik 0:21019d94ad33 470 // MOT_DUR register
majik 0:21019d94ad33 471 uint8_t getMotionDetectionDuration();
majik 0:21019d94ad33 472 void setMotionDetectionDuration(uint8_t duration);
majik 0:21019d94ad33 473
majik 0:21019d94ad33 474 // ZRMOT_THR register
majik 0:21019d94ad33 475 uint8_t getZeroMotionDetectionThreshold();
majik 0:21019d94ad33 476 void setZeroMotionDetectionThreshold(uint8_t threshold);
majik 0:21019d94ad33 477
majik 0:21019d94ad33 478 // ZRMOT_DUR register
majik 0:21019d94ad33 479 uint8_t getZeroMotionDetectionDuration();
majik 0:21019d94ad33 480 void setZeroMotionDetectionDuration(uint8_t duration);
majik 0:21019d94ad33 481
majik 0:21019d94ad33 482 // FIFO_EN register
majik 0:21019d94ad33 483 bool getTempFIFOEnabled();
majik 0:21019d94ad33 484 void setTempFIFOEnabled(bool enabled);
majik 0:21019d94ad33 485 bool getXGyroFIFOEnabled();
majik 0:21019d94ad33 486 void setXGyroFIFOEnabled(bool enabled);
majik 0:21019d94ad33 487 bool getYGyroFIFOEnabled();
majik 0:21019d94ad33 488 void setYGyroFIFOEnabled(bool enabled);
majik 0:21019d94ad33 489 bool getZGyroFIFOEnabled();
majik 0:21019d94ad33 490 void setZGyroFIFOEnabled(bool enabled);
majik 0:21019d94ad33 491 bool getAccelFIFOEnabled();
majik 0:21019d94ad33 492 void setAccelFIFOEnabled(bool enabled);
majik 0:21019d94ad33 493 bool getSlave2FIFOEnabled();
majik 0:21019d94ad33 494 void setSlave2FIFOEnabled(bool enabled);
majik 0:21019d94ad33 495 bool getSlave1FIFOEnabled();
majik 0:21019d94ad33 496 void setSlave1FIFOEnabled(bool enabled);
majik 0:21019d94ad33 497 bool getSlave0FIFOEnabled();
majik 0:21019d94ad33 498 void setSlave0FIFOEnabled(bool enabled);
majik 0:21019d94ad33 499
majik 0:21019d94ad33 500 // I2C_MST_CTRL register
majik 0:21019d94ad33 501 bool getMultiMasterEnabled();
majik 0:21019d94ad33 502 void setMultiMasterEnabled(bool enabled);
majik 0:21019d94ad33 503 bool getWaitForExternalSensorEnabled();
majik 0:21019d94ad33 504 void setWaitForExternalSensorEnabled(bool enabled);
majik 0:21019d94ad33 505 bool getSlave3FIFOEnabled();
majik 0:21019d94ad33 506 void setSlave3FIFOEnabled(bool enabled);
majik 0:21019d94ad33 507 bool getSlaveReadWriteTransitionEnabled();
majik 0:21019d94ad33 508 void setSlaveReadWriteTransitionEnabled(bool enabled);
majik 0:21019d94ad33 509 uint8_t getMasterClockSpeed();
majik 0:21019d94ad33 510 void setMasterClockSpeed(uint8_t speed);
majik 0:21019d94ad33 511
majik 0:21019d94ad33 512 // I2C_SLV* registers (Slave 0-3)
majik 0:21019d94ad33 513 uint8_t getSlaveAddress(uint8_t num);
majik 0:21019d94ad33 514 void setSlaveAddress(uint8_t num, uint8_t address);
majik 0:21019d94ad33 515 uint8_t getSlaveRegister(uint8_t num);
majik 0:21019d94ad33 516 void setSlaveRegister(uint8_t num, uint8_t reg);
majik 0:21019d94ad33 517 bool getSlaveEnabled(uint8_t num);
majik 0:21019d94ad33 518 void setSlaveEnabled(uint8_t num, bool enabled);
majik 0:21019d94ad33 519 bool getSlaveWordByteSwap(uint8_t num);
majik 0:21019d94ad33 520 void setSlaveWordByteSwap(uint8_t num, bool enabled);
majik 0:21019d94ad33 521 bool getSlaveWriteMode(uint8_t num);
majik 0:21019d94ad33 522 void setSlaveWriteMode(uint8_t num, bool mode);
majik 0:21019d94ad33 523 bool getSlaveWordGroupOffset(uint8_t num);
majik 0:21019d94ad33 524 void setSlaveWordGroupOffset(uint8_t num, bool enabled);
majik 0:21019d94ad33 525 uint8_t getSlaveDataLength(uint8_t num);
majik 0:21019d94ad33 526 void setSlaveDataLength(uint8_t num, uint8_t length);
majik 0:21019d94ad33 527
majik 0:21019d94ad33 528 // I2C_SLV* registers (Slave 4)
majik 0:21019d94ad33 529 uint8_t getSlave4Address();
majik 0:21019d94ad33 530 void setSlave4Address(uint8_t address);
majik 0:21019d94ad33 531 uint8_t getSlave4Register();
majik 0:21019d94ad33 532 void setSlave4Register(uint8_t reg);
majik 0:21019d94ad33 533 void setSlave4OutputByte(uint8_t data);
majik 0:21019d94ad33 534 bool getSlave4Enabled();
majik 0:21019d94ad33 535 void setSlave4Enabled(bool enabled);
majik 0:21019d94ad33 536 bool getSlave4InterruptEnabled();
majik 0:21019d94ad33 537 void setSlave4InterruptEnabled(bool enabled);
majik 0:21019d94ad33 538 bool getSlave4WriteMode();
majik 0:21019d94ad33 539 void setSlave4WriteMode(bool mode);
majik 0:21019d94ad33 540 uint8_t getSlave4MasterDelay();
majik 0:21019d94ad33 541 void setSlave4MasterDelay(uint8_t delay);
majik 0:21019d94ad33 542 uint8_t getSlate4InputByte();
majik 0:21019d94ad33 543
majik 0:21019d94ad33 544 // I2C_MST_STATUS register
majik 0:21019d94ad33 545 bool getPassthroughStatus();
majik 0:21019d94ad33 546 bool getSlave4IsDone();
majik 0:21019d94ad33 547 bool getLostArbitration();
majik 0:21019d94ad33 548 bool getSlave4Nack();
majik 0:21019d94ad33 549 bool getSlave3Nack();
majik 0:21019d94ad33 550 bool getSlave2Nack();
majik 0:21019d94ad33 551 bool getSlave1Nack();
majik 0:21019d94ad33 552 bool getSlave0Nack();
majik 0:21019d94ad33 553
majik 0:21019d94ad33 554 // INT_PIN_CFG register
majik 0:21019d94ad33 555 bool getInterruptMode();
majik 0:21019d94ad33 556 void setInterruptMode(bool mode);
majik 0:21019d94ad33 557 bool getInterruptDrive();
majik 0:21019d94ad33 558 void setInterruptDrive(bool drive);
majik 0:21019d94ad33 559 bool getInterruptLatch();
majik 0:21019d94ad33 560 void setInterruptLatch(bool latch);
majik 0:21019d94ad33 561 bool getInterruptLatchClear();
majik 0:21019d94ad33 562 void setInterruptLatchClear(bool clear);
majik 0:21019d94ad33 563 bool getFSyncInterruptLevel();
majik 0:21019d94ad33 564 void setFSyncInterruptLevel(bool level);
majik 0:21019d94ad33 565 bool getFSyncInterruptEnabled();
majik 0:21019d94ad33 566 void setFSyncInterruptEnabled(bool enabled);
majik 0:21019d94ad33 567 bool getI2CBypassEnabled();
majik 0:21019d94ad33 568 void setI2CBypassEnabled(bool enabled);
majik 0:21019d94ad33 569 bool getClockOutputEnabled();
majik 0:21019d94ad33 570 void setClockOutputEnabled(bool enabled);
majik 0:21019d94ad33 571
majik 0:21019d94ad33 572 // INT_ENABLE register
majik 0:21019d94ad33 573 uint8_t getIntEnabled();
majik 0:21019d94ad33 574 void setIntEnabled(uint8_t enabled);
majik 0:21019d94ad33 575 bool getIntFreefallEnabled();
majik 0:21019d94ad33 576 void setIntFreefallEnabled(bool enabled);
majik 0:21019d94ad33 577 bool getIntMotionEnabled();
majik 0:21019d94ad33 578 void setIntMotionEnabled(bool enabled);
majik 0:21019d94ad33 579 bool getIntZeroMotionEnabled();
majik 0:21019d94ad33 580 void setIntZeroMotionEnabled(bool enabled);
majik 0:21019d94ad33 581 bool getIntFIFOBufferOverflowEnabled();
majik 0:21019d94ad33 582 void setIntFIFOBufferOverflowEnabled(bool enabled);
majik 0:21019d94ad33 583 bool getIntI2CMasterEnabled();
majik 0:21019d94ad33 584 void setIntI2CMasterEnabled(bool enabled);
majik 0:21019d94ad33 585 bool getIntDataReadyEnabled();
majik 0:21019d94ad33 586 void setIntDataReadyEnabled(bool enabled);
majik 0:21019d94ad33 587
majik 0:21019d94ad33 588 // INT_STATUS register
majik 0:21019d94ad33 589 uint8_t getIntStatus();
majik 0:21019d94ad33 590 bool getIntFreefallStatus();
majik 0:21019d94ad33 591 bool getIntMotionStatus();
majik 0:21019d94ad33 592 bool getIntZeroMotionStatus();
majik 0:21019d94ad33 593 bool getIntFIFOBufferOverflowStatus();
majik 0:21019d94ad33 594 bool getIntI2CMasterStatus();
majik 0:21019d94ad33 595 bool getIntDataReadyStatus();
majik 0:21019d94ad33 596
majik 0:21019d94ad33 597 // ACCEL_*OUT_* registers
majik 0:21019d94ad33 598 void getMotion9(int16_t* ax, int16_t* ay, int16_t* az, int16_t* gx, int16_t* gy, int16_t* gz, int16_t* mx, int16_t* my, int16_t* mz);
majik 0:21019d94ad33 599 void getMotion6(int16_t* ax, int16_t* ay, int16_t* az, int16_t* gx, int16_t* gy, int16_t* gz);
majik 0:21019d94ad33 600 void getAcceleration(int16_t* x, int16_t* y, int16_t* z);
majik 0:21019d94ad33 601 int16_t getAccelerationX();
majik 0:21019d94ad33 602 int16_t getAccelerationY();
majik 0:21019d94ad33 603 int16_t getAccelerationZ();
majik 0:21019d94ad33 604
majik 0:21019d94ad33 605 // TEMP_OUT_* registers
majik 0:21019d94ad33 606 int16_t getTemperature();
majik 0:21019d94ad33 607
majik 0:21019d94ad33 608 // GYRO_*OUT_* registers
majik 0:21019d94ad33 609 void getRotation(int16_t* x, int16_t* y, int16_t* z);
majik 0:21019d94ad33 610 int16_t getRotationX();
majik 0:21019d94ad33 611 int16_t getRotationY();
majik 0:21019d94ad33 612 int16_t getRotationZ();
majik 0:21019d94ad33 613
majik 0:21019d94ad33 614 // EXT_SENS_DATA_* registers
majik 0:21019d94ad33 615 uint8_t getExternalSensorByte(int position);
majik 0:21019d94ad33 616 uint16_t getExternalSensorWord(int position);
majik 0:21019d94ad33 617 uint32_t getExternalSensorDWord(int position);
majik 0:21019d94ad33 618
majik 0:21019d94ad33 619 // MOT_DETECT_STATUS register
majik 0:21019d94ad33 620 bool getXNegMotionDetected();
majik 0:21019d94ad33 621 bool getXPosMotionDetected();
majik 0:21019d94ad33 622 bool getYNegMotionDetected();
majik 0:21019d94ad33 623 bool getYPosMotionDetected();
majik 0:21019d94ad33 624 bool getZNegMotionDetected();
majik 0:21019d94ad33 625 bool getZPosMotionDetected();
majik 0:21019d94ad33 626 bool getZeroMotionDetected();
majik 0:21019d94ad33 627
majik 0:21019d94ad33 628 // I2C_SLV*_DO register
majik 0:21019d94ad33 629 void setSlaveOutputByte(uint8_t num, uint8_t data);
majik 0:21019d94ad33 630
majik 0:21019d94ad33 631 // I2C_MST_DELAY_CTRL register
majik 0:21019d94ad33 632 bool getExternalShadowDelayEnabled();
majik 0:21019d94ad33 633 void setExternalShadowDelayEnabled(bool enabled);
majik 0:21019d94ad33 634 bool getSlaveDelayEnabled(uint8_t num);
majik 0:21019d94ad33 635 void setSlaveDelayEnabled(uint8_t num, bool enabled);
majik 0:21019d94ad33 636
majik 0:21019d94ad33 637 // SIGNAL_PATH_RESET register
majik 0:21019d94ad33 638 void resetGyroscopePath();
majik 0:21019d94ad33 639 void resetAccelerometerPath();
majik 0:21019d94ad33 640 void resetTemperaturePath();
majik 0:21019d94ad33 641
majik 0:21019d94ad33 642 // MOT_DETECT_CTRL register
majik 0:21019d94ad33 643 uint8_t getAccelerometerPowerOnDelay();
majik 0:21019d94ad33 644 void setAccelerometerPowerOnDelay(uint8_t delay);
majik 0:21019d94ad33 645 uint8_t getFreefallDetectionCounterDecrement();
majik 0:21019d94ad33 646 void setFreefallDetectionCounterDecrement(uint8_t decrement);
majik 0:21019d94ad33 647 uint8_t getMotionDetectionCounterDecrement();
majik 0:21019d94ad33 648 void setMotionDetectionCounterDecrement(uint8_t decrement);
majik 0:21019d94ad33 649
majik 0:21019d94ad33 650 // USER_CTRL register
majik 0:21019d94ad33 651 bool getFIFOEnabled();
majik 0:21019d94ad33 652 void setFIFOEnabled(bool enabled);
majik 0:21019d94ad33 653 bool getI2CMasterModeEnabled();
majik 0:21019d94ad33 654 void setI2CMasterModeEnabled(bool enabled);
majik 0:21019d94ad33 655 void switchSPIEnabled(bool enabled);
majik 0:21019d94ad33 656 void resetFIFO();
majik 0:21019d94ad33 657 void resetI2CMaster();
majik 0:21019d94ad33 658 void resetSensors();
majik 0:21019d94ad33 659
majik 0:21019d94ad33 660 // PWR_MGMT_1 register
majik 0:21019d94ad33 661 void reset();
majik 0:21019d94ad33 662 bool getSleepEnabled();
majik 0:21019d94ad33 663 void setSleepEnabled(bool enabled);
majik 0:21019d94ad33 664 bool getWakeCycleEnabled();
majik 0:21019d94ad33 665 void setWakeCycleEnabled(bool enabled);
majik 0:21019d94ad33 666 bool getTempSensorEnabled();
majik 0:21019d94ad33 667 void setTempSensorEnabled(bool enabled);
majik 0:21019d94ad33 668 uint8_t getClockSource();
majik 0:21019d94ad33 669 void setClockSource(uint8_t source);
majik 0:21019d94ad33 670
majik 0:21019d94ad33 671 // PWR_MGMT_2 register
majik 0:21019d94ad33 672 uint8_t getWakeFrequency();
majik 0:21019d94ad33 673 void setWakeFrequency(uint8_t frequency);
majik 0:21019d94ad33 674 bool getStandbyXAccelEnabled();
majik 0:21019d94ad33 675 void setStandbyXAccelEnabled(bool enabled);
majik 0:21019d94ad33 676 bool getStandbyYAccelEnabled();
majik 0:21019d94ad33 677 void setStandbyYAccelEnabled(bool enabled);
majik 0:21019d94ad33 678 bool getStandbyZAccelEnabled();
majik 0:21019d94ad33 679 void setStandbyZAccelEnabled(bool enabled);
majik 0:21019d94ad33 680 bool getStandbyXGyroEnabled();
majik 0:21019d94ad33 681 void setStandbyXGyroEnabled(bool enabled);
majik 0:21019d94ad33 682 bool getStandbyYGyroEnabled();
majik 0:21019d94ad33 683 void setStandbyYGyroEnabled(bool enabled);
majik 0:21019d94ad33 684 bool getStandbyZGyroEnabled();
majik 0:21019d94ad33 685 void setStandbyZGyroEnabled(bool enabled);
majik 0:21019d94ad33 686
majik 0:21019d94ad33 687 // FIFO_COUNT_* registers
majik 0:21019d94ad33 688 uint16_t getFIFOCount();
majik 0:21019d94ad33 689
majik 0:21019d94ad33 690 // FIFO_R_W register
majik 0:21019d94ad33 691 uint8_t getFIFOByte();
majik 0:21019d94ad33 692 void setFIFOByte(uint8_t data);
majik 0:21019d94ad33 693 void getFIFOBytes(uint8_t *data, uint8_t length);
majik 0:21019d94ad33 694
majik 0:21019d94ad33 695 // WHO_AM_I register
majik 0:21019d94ad33 696 uint8_t getDeviceID();
majik 0:21019d94ad33 697 void setDeviceID(uint8_t id);
majik 0:21019d94ad33 698
majik 0:21019d94ad33 699 // ======== UNDOCUMENTED/DMP REGISTERS/METHODS ========
majik 0:21019d94ad33 700
majik 0:21019d94ad33 701 // XG_OFFS_TC register
majik 0:21019d94ad33 702 uint8_t getOTPBankValid();
majik 0:21019d94ad33 703 void setOTPBankValid(bool enabled);
majik 0:21019d94ad33 704 int8_t getXGyroOffset();
majik 0:21019d94ad33 705 void setXGyroOffset(int8_t offset);
majik 0:21019d94ad33 706
majik 0:21019d94ad33 707 // YG_OFFS_TC register
majik 0:21019d94ad33 708 int8_t getYGyroOffset();
majik 0:21019d94ad33 709 void setYGyroOffset(int8_t offset);
majik 0:21019d94ad33 710
majik 0:21019d94ad33 711 // ZG_OFFS_TC register
majik 0:21019d94ad33 712 int8_t getZGyroOffset();
majik 0:21019d94ad33 713 void setZGyroOffset(int8_t offset);
majik 0:21019d94ad33 714
majik 0:21019d94ad33 715 // X_FINE_GAIN register
majik 0:21019d94ad33 716 int8_t getXFineGain();
majik 0:21019d94ad33 717 void setXFineGain(int8_t gain);
majik 0:21019d94ad33 718
majik 0:21019d94ad33 719 // Y_FINE_GAIN register
majik 0:21019d94ad33 720 int8_t getYFineGain();
majik 0:21019d94ad33 721 void setYFineGain(int8_t gain);
majik 0:21019d94ad33 722
majik 0:21019d94ad33 723 // Z_FINE_GAIN register
majik 0:21019d94ad33 724 int8_t getZFineGain();
majik 0:21019d94ad33 725 void setZFineGain(int8_t gain);
majik 0:21019d94ad33 726
majik 0:21019d94ad33 727 // XA_OFFS_* registers
majik 0:21019d94ad33 728 int16_t getXAccelOffset();
majik 0:21019d94ad33 729 void setXAccelOffset(int16_t offset);
majik 0:21019d94ad33 730
majik 0:21019d94ad33 731 // YA_OFFS_* register
majik 0:21019d94ad33 732 int16_t getYAccelOffset();
majik 0:21019d94ad33 733 void setYAccelOffset(int16_t offset);
majik 0:21019d94ad33 734
majik 0:21019d94ad33 735 // ZA_OFFS_* register
majik 0:21019d94ad33 736 int16_t getZAccelOffset();
majik 0:21019d94ad33 737 void setZAccelOffset(int16_t offset);
majik 0:21019d94ad33 738
majik 0:21019d94ad33 739 // XG_OFFS_USR* registers
majik 0:21019d94ad33 740 int16_t getXGyroOffsetUser();
majik 0:21019d94ad33 741 void setXGyroOffsetUser(int16_t offset);
majik 0:21019d94ad33 742
majik 0:21019d94ad33 743 // YG_OFFS_USR* register
majik 0:21019d94ad33 744 int16_t getYGyroOffsetUser();
majik 0:21019d94ad33 745 void setYGyroOffsetUser(int16_t offset);
majik 0:21019d94ad33 746
majik 0:21019d94ad33 747 // ZG_OFFS_USR* register
majik 0:21019d94ad33 748 int16_t getZGyroOffsetUser();
majik 0:21019d94ad33 749 void setZGyroOffsetUser(int16_t offset);
majik 0:21019d94ad33 750
majik 0:21019d94ad33 751 // INT_ENABLE register (DMP functions)
majik 0:21019d94ad33 752 bool getIntPLLReadyEnabled();
majik 0:21019d94ad33 753 void setIntPLLReadyEnabled(bool enabled);
majik 0:21019d94ad33 754 bool getIntDMPEnabled();
majik 0:21019d94ad33 755 void setIntDMPEnabled(bool enabled);
majik 0:21019d94ad33 756
majik 0:21019d94ad33 757 // DMP_INT_STATUS
majik 0:21019d94ad33 758 bool getDMPInt5Status();
majik 0:21019d94ad33 759 bool getDMPInt4Status();
majik 0:21019d94ad33 760 bool getDMPInt3Status();
majik 0:21019d94ad33 761 bool getDMPInt2Status();
majik 0:21019d94ad33 762 bool getDMPInt1Status();
majik 0:21019d94ad33 763 bool getDMPInt0Status();
majik 0:21019d94ad33 764
majik 0:21019d94ad33 765 // INT_STATUS register (DMP functions)
majik 0:21019d94ad33 766 bool getIntPLLReadyStatus();
majik 0:21019d94ad33 767 bool getIntDMPStatus();
majik 0:21019d94ad33 768
majik 0:21019d94ad33 769 // USER_CTRL register (DMP functions)
majik 0:21019d94ad33 770 bool getDMPEnabled();
majik 0:21019d94ad33 771 void setDMPEnabled(bool enabled);
majik 0:21019d94ad33 772 void resetDMP();
majik 0:21019d94ad33 773
majik 0:21019d94ad33 774 // BANK_SEL register
majik 0:21019d94ad33 775 void setMemoryBank(uint8_t bank, bool prefetchEnabled=false, bool userBank=false);
majik 0:21019d94ad33 776
majik 0:21019d94ad33 777 // MEM_START_ADDR register
majik 0:21019d94ad33 778 void setMemoryStartAddress(uint8_t address);
majik 0:21019d94ad33 779
majik 0:21019d94ad33 780 // MEM_R_W register
majik 0:21019d94ad33 781 uint8_t readMemoryByte();
majik 0:21019d94ad33 782 void writeMemoryByte(uint8_t data);
majik 0:21019d94ad33 783 void readMemoryBlock(uint8_t *data, uint16_t dataSize, uint8_t bank=0, uint8_t address=0);
majik 0:21019d94ad33 784 bool writeMemoryBlock(const uint8_t *data, uint16_t dataSize, uint8_t bank=0, uint8_t address=0, bool verify=true, bool useProgMem=false);
majik 0:21019d94ad33 785 bool writeProgMemoryBlock(const uint8_t *data, uint16_t dataSize, uint8_t bank=0, uint8_t address=0, bool verify=true);
majik 0:21019d94ad33 786
majik 0:21019d94ad33 787 bool writeDMPConfigurationSet(const uint8_t *data, uint16_t dataSize, bool useProgMem=false);
majik 0:21019d94ad33 788 bool writeProgDMPConfigurationSet(const uint8_t *data, uint16_t dataSize);
majik 0:21019d94ad33 789
majik 0:21019d94ad33 790 // DMP_CFG_1 register
majik 0:21019d94ad33 791 uint8_t getDMPConfig1();
majik 0:21019d94ad33 792 void setDMPConfig1(uint8_t config);
majik 0:21019d94ad33 793
majik 0:21019d94ad33 794 // DMP_CFG_2 register
majik 0:21019d94ad33 795 uint8_t getDMPConfig2();
majik 0:21019d94ad33 796 void setDMPConfig2(uint8_t config);
majik 0:21019d94ad33 797
majik 0:21019d94ad33 798 // special methods for MotionApps 2.0 implementation
majik 0:21019d94ad33 799 #ifdef MPU6050_INCLUDE_DMP_MOTIONAPPS20
majik 0:21019d94ad33 800 uint8_t *dmpPacketBuffer;
majik 0:21019d94ad33 801 uint16_t dmpPacketSize;
majik 0:21019d94ad33 802
majik 0:21019d94ad33 803 uint8_t dmpInitialize();
majik 0:21019d94ad33 804 bool dmpPacketAvailable();
majik 0:21019d94ad33 805
majik 0:21019d94ad33 806 uint8_t dmpSetFIFORate(uint8_t fifoRate);
majik 0:21019d94ad33 807 uint8_t dmpGetFIFORate();
majik 0:21019d94ad33 808 uint8_t dmpGetSampleStepSizeMS();
majik 0:21019d94ad33 809 uint8_t dmpGetSampleFrequency();
majik 0:21019d94ad33 810 int32_t dmpDecodeTemperature(int8_t tempReg);
majik 0:21019d94ad33 811
majik 0:21019d94ad33 812 // Register callbacks after a packet of FIFO data is processed
majik 0:21019d94ad33 813 //uint8_t dmpRegisterFIFORateProcess(inv_obj_func func, int16_t priority);
majik 0:21019d94ad33 814 //uint8_t dmpUnregisterFIFORateProcess(inv_obj_func func);
majik 0:21019d94ad33 815 uint8_t dmpRunFIFORateProcesses();
majik 0:21019d94ad33 816
majik 0:21019d94ad33 817 // Setup FIFO for various output
majik 0:21019d94ad33 818 uint8_t dmpSendQuaternion(uint_fast16_t accuracy);
majik 0:21019d94ad33 819 uint8_t dmpSendGyro(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 820 uint8_t dmpSendAccel(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 821 uint8_t dmpSendLinearAccel(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 822 uint8_t dmpSendLinearAccelInWorld(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 823 uint8_t dmpSendControlData(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 824 uint8_t dmpSendSensorData(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 825 uint8_t dmpSendExternalSensorData(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 826 uint8_t dmpSendGravity(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 827 uint8_t dmpSendPacketNumber(uint_fast16_t accuracy);
majik 0:21019d94ad33 828 uint8_t dmpSendQuantizedAccel(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 829 uint8_t dmpSendEIS(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 830
majik 0:21019d94ad33 831 // Get Fixed Point data from FIFO
majik 0:21019d94ad33 832 uint8_t dmpGetAccel(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 833 uint8_t dmpGetAccel(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 834 uint8_t dmpGetAccel(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 835 uint8_t dmpGetQuaternion(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 836 uint8_t dmpGetQuaternion(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 837 uint8_t dmpGetQuaternion(Quaternion *q, const uint8_t* packet=0);
majik 0:21019d94ad33 838 uint8_t dmpGet6AxisQuaternion(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 839 uint8_t dmpGet6AxisQuaternion(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 840 uint8_t dmpGet6AxisQuaternion(Quaternion *q, const uint8_t* packet=0);
majik 0:21019d94ad33 841 uint8_t dmpGetRelativeQuaternion(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 842 uint8_t dmpGetRelativeQuaternion(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 843 uint8_t dmpGetRelativeQuaternion(Quaternion *data, const uint8_t* packet=0);
majik 0:21019d94ad33 844 uint8_t dmpGetGyro(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 845 uint8_t dmpGetGyro(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 846 uint8_t dmpGetGyro(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 847 uint8_t dmpSetLinearAccelFilterCoefficient(float coef);
majik 0:21019d94ad33 848 uint8_t dmpGetLinearAccel(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 849 uint8_t dmpGetLinearAccel(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 850 uint8_t dmpGetLinearAccel(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 851 uint8_t dmpGetLinearAccel(VectorInt16 *v, VectorInt16 *vRaw, VectorFloat *gravity);
majik 0:21019d94ad33 852 uint8_t dmpGetLinearAccelInWorld(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 853 uint8_t dmpGetLinearAccelInWorld(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 854 uint8_t dmpGetLinearAccelInWorld(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 855 uint8_t dmpGetLinearAccelInWorld(VectorInt16 *v, VectorInt16 *vReal, Quaternion *q);
majik 0:21019d94ad33 856 uint8_t dmpGetGyroAndAccelSensor(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 857 uint8_t dmpGetGyroAndAccelSensor(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 858 uint8_t dmpGetGyroAndAccelSensor(VectorInt16 *g, VectorInt16 *a, const uint8_t* packet=0);
majik 0:21019d94ad33 859 uint8_t dmpGetGyroSensor(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 860 uint8_t dmpGetGyroSensor(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 861 uint8_t dmpGetGyroSensor(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 862 uint8_t dmpGetControlData(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 863 uint8_t dmpGetTemperature(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 864 uint8_t dmpGetGravity(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 865 uint8_t dmpGetGravity(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 866 uint8_t dmpGetGravity(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 867 uint8_t dmpGetGravity(VectorFloat *v, Quaternion *q);
majik 0:21019d94ad33 868 uint8_t dmpGetUnquantizedAccel(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 869 uint8_t dmpGetUnquantizedAccel(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 870 uint8_t dmpGetUnquantizedAccel(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 871 uint8_t dmpGetQuantizedAccel(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 872 uint8_t dmpGetQuantizedAccel(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 873 uint8_t dmpGetQuantizedAccel(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 874 uint8_t dmpGetExternalSensorData(int32_t *data, uint16_t size, const uint8_t* packet=0);
majik 0:21019d94ad33 875 uint8_t dmpGetEIS(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 876
majik 0:21019d94ad33 877 uint8_t dmpGetEuler(float *data, Quaternion *q);
majik 0:21019d94ad33 878 uint8_t dmpGetYawPitchRoll(float *data, Quaternion *q, VectorFloat *gravity);
majik 0:21019d94ad33 879
majik 0:21019d94ad33 880 // Get Floating Point data from FIFO
majik 0:21019d94ad33 881 uint8_t dmpGetAccelFloat(float *data, const uint8_t* packet=0);
majik 0:21019d94ad33 882 uint8_t dmpGetQuaternionFloat(float *data, const uint8_t* packet=0);
majik 0:21019d94ad33 883
majik 0:21019d94ad33 884 uint8_t dmpProcessFIFOPacket(const unsigned char *dmpData);
majik 0:21019d94ad33 885 uint8_t dmpReadAndProcessFIFOPacket(uint8_t numPackets, uint8_t *processed=NULL);
majik 0:21019d94ad33 886
majik 0:21019d94ad33 887 uint8_t dmpSetFIFOProcessedCallback(void (*func) (void));
majik 0:21019d94ad33 888
majik 0:21019d94ad33 889 uint8_t dmpInitFIFOParam();
majik 0:21019d94ad33 890 uint8_t dmpCloseFIFO();
majik 0:21019d94ad33 891 uint8_t dmpSetGyroDataSource(uint8_t source);
majik 0:21019d94ad33 892 uint8_t dmpDecodeQuantizedAccel();
majik 0:21019d94ad33 893 uint32_t dmpGetGyroSumOfSquare();
majik 0:21019d94ad33 894 uint32_t dmpGetAccelSumOfSquare();
majik 0:21019d94ad33 895 void dmpOverrideQuaternion(long *q);
majik 0:21019d94ad33 896 uint16_t dmpGetFIFOPacketSize();
majik 0:21019d94ad33 897 #endif
majik 0:21019d94ad33 898
majik 0:21019d94ad33 899 // special methods for MotionApps 4.1 implementation
majik 0:21019d94ad33 900 #ifdef MPU6050_INCLUDE_DMP_MOTIONAPPS41
majik 0:21019d94ad33 901 uint8_t *dmpPacketBuffer;
majik 0:21019d94ad33 902 uint16_t dmpPacketSize;
majik 0:21019d94ad33 903
majik 0:21019d94ad33 904 uint8_t dmpInitialize();
majik 0:21019d94ad33 905 bool dmpPacketAvailable();
majik 0:21019d94ad33 906
majik 0:21019d94ad33 907 uint8_t dmpSetFIFORate(uint8_t fifoRate);
majik 0:21019d94ad33 908 uint8_t dmpGetFIFORate();
majik 0:21019d94ad33 909 uint8_t dmpGetSampleStepSizeMS();
majik 0:21019d94ad33 910 uint8_t dmpGetSampleFrequency();
majik 0:21019d94ad33 911 int32_t dmpDecodeTemperature(int8_t tempReg);
majik 0:21019d94ad33 912
majik 0:21019d94ad33 913 // Register callbacks after a packet of FIFO data is processed
majik 0:21019d94ad33 914 //uint8_t dmpRegisterFIFORateProcess(inv_obj_func func, int16_t priority);
majik 0:21019d94ad33 915 //uint8_t dmpUnregisterFIFORateProcess(inv_obj_func func);
majik 0:21019d94ad33 916 uint8_t dmpRunFIFORateProcesses();
majik 0:21019d94ad33 917
majik 0:21019d94ad33 918 // Setup FIFO for various output
majik 0:21019d94ad33 919 uint8_t dmpSendQuaternion(uint_fast16_t accuracy);
majik 0:21019d94ad33 920 uint8_t dmpSendGyro(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 921 uint8_t dmpSendAccel(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 922 uint8_t dmpSendLinearAccel(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 923 uint8_t dmpSendLinearAccelInWorld(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 924 uint8_t dmpSendControlData(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 925 uint8_t dmpSendSensorData(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 926 uint8_t dmpSendExternalSensorData(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 927 uint8_t dmpSendGravity(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 928 uint8_t dmpSendPacketNumber(uint_fast16_t accuracy);
majik 0:21019d94ad33 929 uint8_t dmpSendQuantizedAccel(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 930 uint8_t dmpSendEIS(uint_fast16_t elements, uint_fast16_t accuracy);
majik 0:21019d94ad33 931
majik 0:21019d94ad33 932 // Get Fixed Point data from FIFO
majik 0:21019d94ad33 933 uint8_t dmpGetAccel(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 934 uint8_t dmpGetAccel(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 935 uint8_t dmpGetAccel(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 936 uint8_t dmpGetQuaternion(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 937 uint8_t dmpGetQuaternion(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 938 uint8_t dmpGetQuaternion(Quaternion *q, const uint8_t* packet=0);
majik 0:21019d94ad33 939 uint8_t dmpGet6AxisQuaternion(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 940 uint8_t dmpGet6AxisQuaternion(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 941 uint8_t dmpGet6AxisQuaternion(Quaternion *q, const uint8_t* packet=0);
majik 0:21019d94ad33 942 uint8_t dmpGetRelativeQuaternion(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 943 uint8_t dmpGetRelativeQuaternion(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 944 uint8_t dmpGetRelativeQuaternion(Quaternion *data, const uint8_t* packet=0);
majik 0:21019d94ad33 945 uint8_t dmpGetGyro(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 946 uint8_t dmpGetGyro(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 947 uint8_t dmpGetGyro(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 948 uint8_t dmpGetMag(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 949 uint8_t dmpSetLinearAccelFilterCoefficient(float coef);
majik 0:21019d94ad33 950 uint8_t dmpGetLinearAccel(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 951 uint8_t dmpGetLinearAccel(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 952 uint8_t dmpGetLinearAccel(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 953 uint8_t dmpGetLinearAccel(VectorInt16 *v, VectorInt16 *vRaw, VectorFloat *gravity);
majik 0:21019d94ad33 954 uint8_t dmpGetLinearAccelInWorld(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 955 uint8_t dmpGetLinearAccelInWorld(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 956 uint8_t dmpGetLinearAccelInWorld(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 957 uint8_t dmpGetLinearAccelInWorld(VectorInt16 *v, VectorInt16 *vReal, Quaternion *q);
majik 0:21019d94ad33 958 uint8_t dmpGetGyroAndAccelSensor(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 959 uint8_t dmpGetGyroAndAccelSensor(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 960 uint8_t dmpGetGyroAndAccelSensor(VectorInt16 *g, VectorInt16 *a, const uint8_t* packet=0);
majik 0:21019d94ad33 961 uint8_t dmpGetGyroSensor(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 962 uint8_t dmpGetGyroSensor(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 963 uint8_t dmpGetGyroSensor(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 964 uint8_t dmpGetControlData(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 965 uint8_t dmpGetTemperature(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 966 uint8_t dmpGetGravity(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 967 uint8_t dmpGetGravity(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 968 uint8_t dmpGetGravity(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 969 uint8_t dmpGetGravity(VectorFloat *v, Quaternion *q);
majik 0:21019d94ad33 970 uint8_t dmpGetUnquantizedAccel(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 971 uint8_t dmpGetUnquantizedAccel(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 972 uint8_t dmpGetUnquantizedAccel(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 973 uint8_t dmpGetQuantizedAccel(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 974 uint8_t dmpGetQuantizedAccel(int16_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 975 uint8_t dmpGetQuantizedAccel(VectorInt16 *v, const uint8_t* packet=0);
majik 0:21019d94ad33 976 uint8_t dmpGetExternalSensorData(int32_t *data, uint16_t size, const uint8_t* packet=0);
majik 0:21019d94ad33 977 uint8_t dmpGetEIS(int32_t *data, const uint8_t* packet=0);
majik 0:21019d94ad33 978
majik 0:21019d94ad33 979 uint8_t dmpGetEuler(float *data, Quaternion *q);
majik 0:21019d94ad33 980 uint8_t dmpGetYawPitchRoll(float *data, Quaternion *q, VectorFloat *gravity);
majik 0:21019d94ad33 981
majik 0:21019d94ad33 982 // Get Floating Point data from FIFO
majik 0:21019d94ad33 983 uint8_t dmpGetAccelFloat(float *data, const uint8_t* packet=0);
majik 0:21019d94ad33 984 uint8_t dmpGetQuaternionFloat(float *data, const uint8_t* packet=0);
majik 0:21019d94ad33 985
majik 0:21019d94ad33 986 uint8_t dmpProcessFIFOPacket(const unsigned char *dmpData);
majik 0:21019d94ad33 987 uint8_t dmpReadAndProcessFIFOPacket(uint8_t numPackets, uint8_t *processed=NULL);
majik 0:21019d94ad33 988
majik 0:21019d94ad33 989 uint8_t dmpSetFIFOProcessedCallback(void (*func) (void));
majik 0:21019d94ad33 990
majik 0:21019d94ad33 991 uint8_t dmpInitFIFOParam();
majik 0:21019d94ad33 992 uint8_t dmpCloseFIFO();
majik 0:21019d94ad33 993 uint8_t dmpSetGyroDataSource(uint8_t source);
majik 0:21019d94ad33 994 uint8_t dmpDecodeQuantizedAccel();
majik 0:21019d94ad33 995 uint32_t dmpGetGyroSumOfSquare();
majik 0:21019d94ad33 996 uint32_t dmpGetAccelSumOfSquare();
majik 0:21019d94ad33 997 void dmpOverrideQuaternion(long *q);
majik 0:21019d94ad33 998 uint16_t dmpGetFIFOPacketSize();
majik 0:21019d94ad33 999 #endif
majik 0:21019d94ad33 1000
majik 0:21019d94ad33 1001 private:
majik 0:21019d94ad33 1002 uint8_t devAddr;
majik 0:21019d94ad33 1003 uint8_t buffer[14];
majik 0:21019d94ad33 1004 };
majik 0:21019d94ad33 1005
majik 0:21019d94ad33 1006 #endif /* _MPU6050_H_ */