MPU6050 for a Micromouse Robot - Gyroscope, Angular Velocity, Accelerometer, Sensor Fusion with Wheel Encoders, Placement

The MPU6050 is one of the most commonly used motion sensors in Micromouse robots. It combines a 3-axis gyroscope and a 3-axis accelerometer in a compact and low-cost module, making it suitable for measuring rotational motion, acceleration, and robot orientation during maze navigation.

In Micromouse applications, the MPU6050 is mainly used for precise turning control, angular velocity measurement, and motion stabilization.

What is the MPU6050?

The MPU6050 is a 6-DOF (Degrees of Freedom) MEMS sensor developed by InvenSense. 

  It contains:

• 3-axis gyroscope
• 3-axis accelerometer
• Digital Motion Processor (DMP)
• I2C communication interface

The sensor communicates with microcontrollers such as the STM32F411CEU6 through the I2C bus.

---

Why Use MPU6050 in Micromouse?

A Micromouse robot requires highly accurate motion control while moving through a maze at high speed. Wheel encoders alone are often insufficient because:

• Wheel slip may occur
• Surface friction changes
• 
  Sudden acceleration causes errors
• Fast turning introduces instability

The MPU6050 helps solve these problems by providing real-time rotational and acceleration data.

Typical uses include:

• Accurate 90° and 180° turns
• Angular velocity feedback
• Drift correction
• Motion stabilization
• Speed profiling
• Wall-following improvement
• Sensor fusion with encoders

---

Gyroscope-Based Turning Control

  This is the most important application.

  The gyroscope measures angular velocity:

$\mathrm{ \; \theta }=\int \omega dt$

  Where:

• $\theta$ = rotation angle
• $\mathrm{\omega =\; angular\; velocity}$

  By integrating gyro data over time, the Micromouse can determine how much it has rotated.

  Example

  For a 90° turn:

1. Start turning motors
2. Read gyro Z-axis continuously
3. Integrate angular velocity
4. Stop motors at 90°

  This method is significantly more accurate than using motor encoder counts alone.

---

 Angular Velocity Feedback for PD Control

  The MPU6050 is often combined with a PD controller for smooth turning.

  The control equation becomes:

$u(t)=K_p e(t)+K_d \frac{de(t)}{dt}$

Where:

• $e(t)=\; angle\; error$
• $K_p$​ ​ ​ 
• $K_d$

  The gyroscope provides real-time rotational speed data that improves damping and prevents overshoot.

   Benefits

• Faster cornering
• Reduced oscillation
• Stable turning motion
• Improved repeatability

---

Using the Accelerometer

The accelerometer measures linear acceleration along X, Y, and Z axes.

In Micromouse robots, it can be used for:

• Detecting sudden impacts
• Monitoring acceleration profiles
• Detecting wheel slip
• Motion analysis

However, accelerometer data is usually noisier than gyro data during fast movement.

For this reason, many Micromouse systems rely primarily on the gyroscope.

---

Sensor Fusion with Wheel Encoders

The best performance is achieved by combining:

• Wheel encoders
• IR wall sensors
• MPU6050 gyro

This technique is called sensor fusion.

Example

Sensor	Purpose
Encoder	Distance measurement
Gyroscope	Rotation measurement
IR Sensor	Wall distance
Accelerometer	Motion analysis

Combining all sensors improves overall maze navigation accuracy.

---

Connecting MPU6050 to STM32

The MPU6050 commonly uses I2C communication.

Typical Wiring

MPU6050	STM32F411
VCC	3.3V
GND	GND
SDA	I2C SDA
SCL	I2C SCL

Most Micromouse robots use:

• I2C1
• 400kHz Fast Mode
• DMA or interrupt communication

---

Basic Initialization Sequence

The MPU6050 starts in sleep mode by default.

Initialization steps:

1. Initialize I2C peripheral
2. Wake up MPU6050
3. Configure gyro range
4. Configure accelerometer range
5. Configure low-pass filter
6. Start periodic reading

Typical gyro range:

Range	Sensitivity
±250°/s	High precision
±500°/s	Common
±1000°/s	Fast turning
±2000°/s	Extreme motion

For Micromouse, ±500°/s or ±1000°/s are commonly used.

---

Example STM32 Gyro Reading Flow

  Step 1: Read Gyro Registers

  The gyro Z-axis data comes from:

• GYRO_ZOUT_H
• GYRO_ZOUT_L

  Step 2: Convert Raw Data

  The raw value is converted into degrees per second:

$\omega = \frac{\text{Raw Data}}{\text{Sensitivity Scale Factor}}$

  Example:

• Raw = 13100
• Sensitivity = 131 LSB/(°/s)

   Result:

• $100°/s$

---

Gyroscope Drift Problem

One limitation of gyroscopes is drift.

Small measurement errors accumulate over time:

• 0.1° error
• becomes several degrees after long operation

This is especially problematic in long maze runs.

  Solutions

    1. Calibration

     Measure offset while stationary:

$$\text{Offset} = \text{Average gyro reading at rest}$$

     Subtract offset during runtime.

    2. Complementary Filter

     Combine gyro and accelerometer data.

    3. Periodic Correction

    Use maze wall alignment to reset heading.

---

MPU6050 Placement in Micromouse

The sensor should be mounted:

• Near the center of rotation
• Firmly fixed
• Away from motor vibration
• On a rigid PCB

Improper placement introduces noise and instability.

---

Limitations

Gyro Drift

  Requires calibration and correction.

Noise

  Motor vibration can affect measurements.

Limited Accuracy Compared to Industrial IMUs

  High-end IMUs provide better precision but cost significantly more.

---

Conclusion

The MPU6050 is an extremely useful sensor for Micromouse robots. By combining gyroscope and accelerometer data with wheel encoders and wall sensors, a Micromouse can achieve accurate movement, stable turning, and high-speed maze navigation.

For beginners, the most practical use of the MPU6050 is gyro-based turning control. As experience grows, more advanced techniques such as sensor fusion and motion stabilization can greatly improve robot performance in competitive environments.