Werte auslesen und in Winkel umrechnen

Dependencies:   mbed

Committer:
Heidl
Date:
Wed Sep 30 16:08:36 2015 +0000
Revision:
0:d1960beb98fe
Werte von Beschleunigungssensor auslesen

Who changed what in which revision?

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