MPU6050 Accelerometer<\/h1>\n\n\n\n
Today\u2019s patient will be the MPU6050<\/a> from InvenSense. <\/em>It\u2019s a 6\u2011degree\u2011of\u2011freedom IMU. Thanks to the built\u2011in gyroscope it extends the basic 3 degrees from the accelerometer by another 3 from the gyroscope. Thus, with it we can measure acceleration (accelerometer) and angular velocity (gyroscope) around each axis. This sensor is a MEMS (M<\/em>icroelectromechanical System)<\/i>, which means that in addition to electronics it also contains mechanical (moving) elements in its structure.<\/p>\n\n\n <\/p>\n\n\n\n The chip is very small. Its dimensions are only 4 x 4 x 0.9 mm, which makes it ideal for use in small devices such as smartphones, watches or drones. The MPU6050 has six 16\u2011bit converters built in, one for each measured value. The measured acceleration and rotational speed ranges are set in software. The accelerometer can measure within \u00b12g, \u00b14g, \u00b18g or \u00b116g, while the gyroscope within \u00b1250, \u00b1500, \u00b11000, \u00b12000\u00b0\/sec (aka dps \u2013 degrees per second<\/em>).<\/p>\n\n\n\n The chip has a built\u2011in 1024\u2011byte FIFO queue. Thanks to this, you can read from the chip less often and save more power if the device is battery\u2011powered.<\/p>\n\n\n\n To offload the microcontroller that will fetch data from the accelerometer, the MPU6050<\/a> has a built\u2011in \u2018motion processor\u2019 DMP (Digital Motion Process<\/em>). This unit allows, for example, motion detection or free\u2011fall detection as well as many other useful things. Unfortunately, the user has no direct access to it. Even the documentation doesn\u2019t say much about the DMP. On the Internet there are many results of reverse engineering that allow you to use part of the DMP\u2019s features. To fully enjoy the motion processor assistance, you should use the libraries provided by InvenSense<\/em>.<\/p>\n\n\n\n As for electrical parameters, the supply voltage tolerated by the chip is in the range 2.375\u20133.46 V. The interface through which you can talk to the IMU is I\u00b2C. Interestingly, the chip itself allows the I\u00b2C logic to operate at voltages as low as 1.71 V. However, Chinese modules do not allow this\u2014all of the chip\u2019s power pins are connected to 3.3 V.<\/p>\n\n\n\n An interesting tidbit is the built\u2011in temperature sensor, which we can simply use.<\/p>\n\n\n\n Another interesting thing is the ability to connect additional I\u00b2C devices to the MPU6050. The chip can communicate with other devices and collect data from them. You can use, for example, an external magnetometer\/compass and thus add another three degrees of freedom. We can simultaneously handle four different I\u00b2C devices via the MPU6050\u2019s external I\u00b2C lines.<\/p>\n\n\n\n More data such as current consumption under various conditions and configurations can be found in the documentation: Today I\u2019ll use the Nucleo board with the STM32F401RE microcontroller.<\/a><\/p>\n\n\n My module with the MPU6050 is the popular GY-521<\/a>. The wiring diagram is as follows:<\/p>\n\n\n <\/p>\n\n\n\n The Cube configuration is simple\u2014I\u00b2C and an external interrupt on pin PA6. I\u00b2C can be sped up to 400 kHz. I pulled the interrupt down to ground with an external resistor, and in the configuration I chose no internal pull\u2011up. Of course, you can use the internal ones. UART, LED and TEST are for testing and debugging purposes.<\/p>\n\n\n <\/p>\n\n\n\n The code can basically be divided into 4 sections:<\/p>\n\n\n\n In the configuration part there\u2019s the standard device initialization function.<\/p>\n\n\n\n It resets the accelerometer to default values, sets the clock source, and sets the measurement ranges for acceleration and angular velocity to \u00b12g and \u00b1250\u00b0\/sec.<\/p>\n\n\n\n Besides that, a number of functions handle configuration. The names really speak for themselves. You can reset the MPU6050, set the clocks, put the individual sensors to sleep or disable them. If needed, you can also increase the measurement range of the accelerometer and gyroscope.<\/p>\n\n\n\n Probably the most important part from the user\u2019s point of view is reading data from the accelerometer. I prepared several functions returning data in different variants. Functions with the RAW suffix return exactly what\u2019s in the registers. The Scaled<\/em> functions return values scaled to the selected maximum range, i.e., directly in units of gravitational acceleration, angular velocity in degrees per second, or degrees Celsius. The last function returns Pitch<\/em> and Roll<\/em>, i.e., in short, the tilt around the Y and X axes with respect to the Earth. I have one note regarding temperature. In my opinion the MPU6050 slightly overestimates the readings by about 3\u20134\u00baC. However, I didn\u2019t modify the formula provided by the datasheet.<\/p>\n\n\n\n In the interrupt configuration section, a significant part is taken by functions concerning the INT pin. You can choose, for example, the level with which it signals an interrupt and how the interrupt flag is cleared. The accelerometer offers three interrupts as standard:<\/p>\n\n\n\n I haven\u2019t dealt with the FIFO for now. Same for the I\u00b2C Master function. The DataReady<\/em> interrupt can be said to be almost always active because the accelerometer by default continuously generates data.<\/p>\n\n\n\n So what the heck do we need this interrupt for? Well, the MPU6050<\/a> has a built\u2011in DMP which is not described in the sensor documentation nor in the register map. Probably because InvenSense provides its extensive driver for this purpose. The Internet, of course, never sleeps and has figured out a few things. Thanks to that we have easy access to basic motion processor functions.<\/p>\n\n\n\n The DMP gives us three very useful interrupts. These are:<\/p>\n\n\n\n The chip can process the sensor data itself and assert the appropriate interrupt. I\u2019ve included all three in the library. There are also a few options around them to set.<\/p>\n\n\n\n The first function reads the status register responsible for detected motion. It contains information about which direction of motion triggered the MotionDetect<\/em> interrupt. Maybe someone will find it useful. At the moment I don\u2019t see an application for it in my case.<\/p>\n\n\n\n The second function sets the high\u2011pass filter for the DMP. I didn\u2019t notice any effect on the interrupts\u2019 behavior. Maybe someone knows more details about this filter? I recommend setting it to the value MPU6050_DHPF_5 as I did.<\/p>\n\n\n\n And then there are the functions responsible for event detection. First, you can use them in two ways: with the INT pin, or without it by polling the interrupt status cyclically. I don\u2019t see a reason to poll the MPU for interrupt status. It\u2019s better to have this handled in hardware, which you enable with the appropriate functions.<\/p>\n\n\n\n Next come the settings for the conditions under which an interrupt occurs. Threshold<\/em> is the change in acceleration at which the internal counter starts counting. Duration<\/em> is the value of that counter after which the interrupt will be asserted. If the acceleration value drops below the threshold before the interrupt, the counter resets.<\/p>\n\n\n\n The threshold is expressed in mg (milli\u2011g), and the value written is multiplied by 2. The duration is in milliseconds. So by writing Threshold = 2, Duration = 5<\/em> into the MotionCapture<\/em> registers, the interrupt will occur 5 milliseconds after exceeding a 4 mg difference compared to the rest state. It may sound a bit complicated, so I recommend experimenting. I tested all the interrupts and they definitely work. A tap on the desk triggers the appropriate Motion<\/em> and ZeroMotion<\/em>.<\/p>\n\n\n <\/p>\n\n\n\n Dropping the sensor will generate the Freefall<\/em> interrupt.<\/p>\n\n\n <\/p>\n\n\n\n Unfortunately, IMU chips, like everything in electronics, are imperfect. You can feel this most on the gyroscope. It has something called drift, i.e., it constantly indicates some value even though it\u2019s standing still. This can be seen in the terminal screenshot below.<\/p>\n\n\n <\/p>\n\n\n\n MPU6050<\/a> I have on my desk has quite a large drift on the X axis. From this it follows that in about 180 seconds it makes a full rotation around X. I\u2019ll tell you, I\u2019m looking at it and to me it\u2019s not spinning on this desk at all \ud83d\ude41<\/p>\n\n\n\n One way to minimize this error is filtering. The most effective here is the Kalman filter, which will have a separate post.<\/p>\n\n\n\n <\/p>\n\n\n\n MEMS systems are very interesting creations. Thanks to them you can easily bring \u201cmechanical quantities\u201d into the world of electronics and thus easily process them. Without accelerometers there would be no drones or VR glasses.<\/p>\n\n\n\n Thanks to the built\u2011in DMP you can save many CPU cycles or even use interrupts for cool purposes. I see, for example, putting a smartwatch to sleep and waking it based on detected motion\/no\u2011motion. There are certainly many other applications for this kind of detection. Share your ideas in the comments.<\/p>\n\n\n\n If you like the chip, you can buy it in my store<\/a>.<\/p>\n\n\n\n You can find the code on my GitHub as usual: link<\/a><\/p>\n\n\n\n If you noticed any mistake, disagree with something, would like to add something important, or simply feel like discussing this topic, write a comment. Remember that the discussion should be polite and consistent with the rules of the Polish language.<\/span><\/p>\n\n\n![\"\"](\"http:\/\/msalamon.pl\/wp-content\/uploads\/2019\/03\/MPU6050_baner-1024x341.jpg\")
<\/a><\/figure>\n<\/div>\n\n\nParameters<\/h2>\n\n\n\n
MPU60X0 Datasheet.pdf<\/a><\/p>\n\n\n\nSchematic and configuration<\/h2>\n\n\n\n
![\"\"](\"http:\/\/msalamon.pl\/wp-content\/uploads\/2020\/07\/Nucleo-64-baner.jpg\")
<\/a><\/figure>\n<\/div>\n\n\n![\"\"](\"http:\/\/msalamon.pl\/wp-content\/uploads\/2018\/11\/mpu6050_schematic.jpg\")
<\/a><\/figure>\n<\/div>\n\n\n![\"\"](\"http:\/\/msalamon.pl\/wp-content\/uploads\/2018\/11\/mpu6050_cube_i2c.jpg\")
<\/a><\/figure>\n<\/div>\n\n![\"\"](\"http:\/\/msalamon.pl\/wp-content\/uploads\/2018\/11\/mpu6050_cube_exti.jpg\")
<\/a><\/figure>\n<\/div>\n\n\nCode<\/h2>\n\n\n\n
\n
void MPU6050_Init(I2C_HandleTypeDef *hi2c);<\/pre>\n\n\n\n
\/\/\n\/\/ PWR_MGMT_1\n\/\/\nvoid MPU6050_DeviceReset(uint8_t Reset);\nvoid MPU6050_SetClockSource(uint8_t Source);\nvoid MPU6050_SetSleepEnabled(uint8_t Enable);\nvoid MPU6050_SetCycleEnabled(uint8_t Enable);\nvoid MPU6050_SetTemperatureSensorDisbled(uint8_t Disable);\n\n\/\/\n\/\/ PWR_MGMT_2\n\/\/\nvoid MPU6050_SetLowPowerWakeUpFrequency(uint8_t Frequency);\nvoid MPU6050_AccelerometerAxisStandby(uint8_t XA_Stby, uint8_t YA_Stby, uint8_t ZA_Stby);\nvoid MPU6050_GyroscopeAxisStandby(uint8_t XG_Stby, uint8_t YG_Stby, uint8_t ZG_Stby);\n\n\/\/\n\/\/ Measurement scale configuration\n\/\/\nvoid MPU6050_SetFullScaleGyroRange(uint8_t Range);\nvoid MPU6050_SetFullScaleAccelRange(uint8_t Range);<\/pre>\n\n\n\n
int16_t MPU6050_GetTemperatureRAW(void);\nfloat MPU6050_GetTemperatureCelsius(void);\n\nint16_t MPU6050_GetAccelerationXRAW(void);\nint16_t MPU6050_GetAccelerationYRAW(void);\nint16_t MPU6050_GetAccelerationZRAW(void);\nvoid MPU6050_GetAccelerometerRAW(int16_t* x, int16_t* y, int16_t* z);\nvoid MPU6050_GetAccelerometerScaled(float* x, float* y, float* z);\n\nint16_t MPU6050_GetRotationXRAW(void);\nint16_t MPU6050_GetRotationYRAW(void);\nint16_t MPU6050_GetRotationZRAW(void);\nvoid MPU6050_GetGyroscopeRAW(int16_t* x, int16_t* y, int16_t* z);\nvoid MPU6050_GetGyroscopeScaled(float* x, float* y, float* z);\n\nvoid MPU6050_GetRollPitch(float* Roll, float* Pitch);<\/pre>\n\n\n\n
\n
\/\/\n\/\/ Setting INT pin\n\/\/\n\/\/ INT_PIN_CFG register\nvoid MPU6050_SetInterruptMode(uint8_t Mode);\nvoid MPU6050_SetInterruptDrive(uint8_t Drive);\nvoid MPU6050_SetInterruptLatch(uint8_t Latch);\nvoid MPU6050_SetInterruptLatchClear(uint8_t Clear);\n\/\/ INT_ENABLE register\nvoid MPU6050_SetIntEnableRegister(uint8_t Value);\nvoid MPU6050_SetIntDataReadyEnabled(uint8_t Enable);\n\/\/ INT_STATUS register\nuint8_t MPU6050_GetIntStatusRegister(void);<\/pre>\n\n\n\n
Digital Motion Process<\/h2>\n\n\n\n
\n
\/\/\n\/\/ Motion functions - not included in documentation\/register map\n\/\/\nuint8_t MPU6050_GetMotionStatusRegister(void);\n\nvoid MPU6050_SetDHPFMode(uint8_t Dhpf);\n\/\/ INT_ENABLE register\nvoid MPU6050_SetIntZeroMotionEnabled(uint8_t Enable);\nvoid MPU6050_SetIntMotionEnabled(uint8_t Enable);\nvoid MPU6050_SetIntFreeFallEnabled(uint8_t Enable);\n\nvoid MPU6050_SetMotionDetectionThreshold(uint8_t Threshold);\nvoid MPU6050_SetMotionDetectionDuration(uint8_t Duration);\n\nvoid MPU6050_SetZeroMotionDetectionThreshold(uint8_t Threshold);\nvoid MPU6050_SetZeroMotionDetectionDuration(uint8_t Duration);\n\nvoid MPU6050_SetFreeFallDetectionThreshold(uint8_t Threshold);\nvoid MPU6050_SetFreeFallDetectionDuration(uint8_t Duration);<\/pre>\n\n\n\n
\/\/\n\/\/ Not documented\n\/\/ Register 91 - Motion Status\n\/\/\n#define MPU6050_MOTION_MOT_XNEG_BIT 7\n#define MPU6050_MOTION_MOT_XPOS_BIT 6\n#define MPU6050_MOTION_MOT_YNEG_BIT 5\n#define MPU6050_MOTION_MOT_YPOS_BIT 4\n#define MPU6050_MOTION_MOT_ZNEG_BIT 3\n#define MPU6050_MOTION_MOT_ZPOS_BIT 2<\/pre>\n\n\n\n
![\"\"](\"http:\/\/msalamon.pl\/wp-content\/uploads\/2018\/11\/mpu6050_dmp_motions.jpg\")
<\/a><\/figure>\n<\/div>\n\n\n![\"\"](\"http:\/\/msalamon.pl\/wp-content\/uploads\/2018\/11\/mpu6050_dmp_freefall.jpg\")
<\/a><\/figure>\n<\/div>\n\n\nGyroscope drift<\/h2>\n\n\n\n
![\"\"](\"http:\/\/msalamon.pl\/wp-content\/uploads\/2018\/11\/mpu6050_terminal.jpg\")
<\/a><\/figure>\n<\/div>\n\n\nSummary<\/h2>\n\n\n\n