yahboom
HomeLearn
Solution
Blog
Online Store
About Us
EN/中文
MicroROS Self-balancing Robot Car📖
01.Introduction
  • 0.Unboxing and Reviewing
  • 1. Must read before use - learning route
  • 2. Introduction to LiDAR
  • 3. Balance car interface description
  • 4. Analysis of common problems
  • 5. Robot charging and battery precautions
02.Assembly tutorial
  • Robot assembly steps
03.Preparation
  • 0.Quick Start (Must Read)
  • 1.Write firmware
  • 2.How to install and use VM
  • 3.ESP32 communication board configuration parameters
  • 4.Connect to microROS agent
04.ROS-WiFi module configuration
  • 0.Serial port configuration WiFi instructions
  • 1.Use ROS-WiFi cam module(must read)
  • 2.Connect to ROS-WiFi cam module agent
  • 3.Camera image correction (optional)
05.Quick start control
  • 1.Keyboard remote control
  • 2.Handle remote control
06.ROS+OpenCV course
  • 1.OpenCV Getting started
  • 2.Geometric transformation
  • 3.Image processing and drawing text line segments
  • 4.Image beautification
07.Mediapipe course
  • 1. Hand detection
  • 2. Posture detection
  • 3. Overall inspection
  • 4. Face detection
  • 5. Face recognition
  • 6. Facial effects
  • 7. 3D object recognition
  • 8. Brush
  • 9. Finger control
  • 10. Gesture recognition
08.Robot basic course
  • 1.Robot information release
  • 2.Robot keyboard control
  • 3.Robot handle control
  • 4.Robot state estimation
  • 5.Line speed calibration
  • 6.Angular velocity calibration
  • 7.Robot URDF model
09.Lidar course
  • 1.Lidar avoid
  • 2.Lidar following
  • 3.Lidar guard
  • 5.Gmapping mapping
  • 6.Cartographer mapping
  • 7.Navigation2 navigation avoid
  • 8.Navigation2 fast relocation navigation
  • 9.ROS Robot APP mapping
  • 10.ROS Robot APP navigation
10.Robot visual interaction
  • 1.Color tracking
  • 2.Object recognition and tracking
  • 3.Face recognition tracking
  • 4.Autonomous driving line patrol
  • 5.QR code motion control
  • 6.Gesture control car movement
  • 7.Palm control car movement
  • 8.Gesture control car action group
  • 9.Palm recognition and tracking
  • 10.Human body posture recognition and tracking
11.Multi-machine course
  • 1.Multi-machine handle control
  • 2.Multi-machine keyboard control
  • 3.Multi-machine navigation
  • 4.Multi-machine rapid relocation navigation
12.STM32 balancing case
01.Environment construction and development
  • 13.Window Watchdog (WWDG)
  • 01.MDK-ARM installation
  • 02.STM32CubeIDE installation
  • 03.Common driver installation
  • 04.Download the program
  • 05.MDK-ARM project usage
  • 06.Program simulation
02.STM32 getting started course
  • 01.Project creation
  • 02.LED Control(GPIO)
  • 03.Buzzer control(GPIO)
  • 04.Button control(EXTI)
  • 05.Serial communication(USART)
  • 06.Voltage detection(ADC)
  • 07.Basic timer(TIM)
  • 08.Universal timer(TIM)
  • 09.Advanced Timer(TIM)
  • 10.I2C Communication(I2C)-OLED
  • 11.SPI communication(SPI)-2.4G handle
  • 12.Independent Watchdog (IWDG)
  • 14.DMA-USART
  • 15.DMA-I2C
03.STM32 expansion course
  • 01.Battery voltage detection (ADC)
  • 02.Ultrasonic module-measuring distance (TIM)
  • 03.Motor drive+encoder (TIM)
  • 04.OLED Data-Display(I2C)
  • 05.MPU6050-Data Read (I2C)
04.Robot car PID control course
  • 01.PID basic concept
  • 02.PID example analysis
  • 03.P, PI, PD controller theory
  • 04.Position PID
  • 05.Incremental PID
  • 06.Cascade PID
  • 07.Balance principle of car
  • 08.Car upright control (PD)
  • 09.Car speed ​​control (PI)
  • 10.Car steering control (PD)
  • 11.Got angle and angular velocity (DMP algorithm)
  • 12.Got angle and angular velocity (Kalman filter algorithm)
  • 13.Got angle and angular velocity(Complementary filter algorithm)
05.Robot car basic course
  • 01.Car parameter adjustment
  • 02.Ultrasonic obstacle avoidance
  • 03.Ultrasonic follow
  • 04.Bluetooth remote control
  • 05.Load balance
  • 06.Radar obstacle avoidance
  • 07.Radar guard
  • 08.Radar follow
  • 09.Radar patrol
  • 10.Radar wall following go in a straight line
  • 11.Radar tracking wall multiple walls
06.Robot car LQR control
  • Balance car LQR high-level control
07.Circuit design
  • 01.Overall circuit design
  • 02.STM32 minimum system
  • 03.Serial port circuit design
  • 04.Power circuit design
  • 05.MPU6050 Circuit Design
  • 06.Motor drive circuit design
08.Mathematical model
  • Balance car mathematical model
13.Linux basic course
  • 1.Introduction to Linux system
  • 2.Ubuntu file system
  • 3.Ubuntu common commands
  • 4.Ubuntu common editors
  • 5.Ubuntu software operation commands
  • 6.Virtual machine installation
  • 7.SSH remote control
  • 8.VNC remote control
  • 9.Transfer files remotely
  • 10.Driver library and communication
  • 11.Static IP and hotspot mode
  • 12.Bind device ID
  • 13.Capacity expansion and resource allocation
  • 14.Update system software sources
  • 15.Set root user password
  • 16.sudo free password
  • 17.Connect to WiFi network
  • 18.View system version
  • 19.Customized service management
  • 20.Back up system image
14.Docker course
  • 1. Overview and installation
  • 2. Common commands
  • 3. Docker images deeply understand and publish images
  • 4. Docker hardware interaction and data processing
  • 5. Enter the bot's docker container
15.ROS2 basic course
  • 1.Introduction to ROS2
  • 2.ROS2 install Humble
  • 3.ROS2 development environment
  • 4.ROS2 workspace
  • 5.ROS2 function package
  • 6.ROS2 node
  • 7.ROS2 topic communication
  • 8.ROS2 service communication
  • 9.ROS2 action communication
  • 10.ROS2 custom interface message
  • 11.ROS2 parameter service case
  • 12.ROS2 meta-function package
  • 13.ROS2 distributed communication
  • 14.ROS2 DDS
  • 15.ROS2 time related API
  • 16.ROS2 common command tools
  • 17.ROS2 rviz2 use
  • 18.ROS2 rqt toolbox
  • 19.ROS2 Launch startup file configuration
  • 20.ROS2 recording and playback tool
  • 21.ROS2 URDF model
  • 22.ROS2 Gazebo simulation platform
  • 23.ROS2 TF2 coordinate transformation
Download
  • RemoteCtrl_APP(Android)
  • Mapping_APP(iOS_Android)
  • Code
  • Hardware Information
  • software tools
  • 3D model file
  • Instruction manual
  • VM image file
  • ROS2_Basic_VM
Download ZIP

Welcome to MicroROS Self-balancing Robot Car repository

05.MPU6050-Data Read (I2C)

MPU6050: Data Read (I2C)

MPU6050: Data Read (I2C)Hardware connectionControl principlePin definitionSoftware codeControl functionExperimental phenomenon

The tutorial demonstration software simulates I2C communication to read the DMP data of MPU6050, then solves the data and prints it out on the serial port.

The tutorial only introduces the standard library project code

Hardware connection

image-20240822181904403

Just install it to the corresponding interface:

PeripheralsDevelopment BoardDescription
MPU6050: VCC5VOLED power supply
MPU6050: GNDGNDOLED common ground
MPU6050: SCLPB10Software I2C: Serial clock line (SDA) (pull-up resistor is connected to the module)
MPU6050: SDAPB11Software I2C: Serial data line (SCL) (pull-up resistor is connected to the module)
MPU6050: XDANot connectedI2C master serial data signal line, used for external sensors (pull-up resistors have been connected to the module)
MPU6050: XCLNot connectedI2C master serial clock signal line, used for external sensors (pull-up resistors have been connected to the module)
MPU6050: AD0Not connectedSlave address setting pin: 1. When grounded or floating, the address is 0x68; 2. When connected to VCC, the address is 0x69
MPU6050: INTPA12Interrupt output pin

Control principle

The software simulates I2C to obtain DMP data and calculates the pitch, roll, and heading angles.

  • MPU6050

ProductMPU6050
Communication methodIIC
Transmission rate400kHz (Max)
Output informationRotation matrix, quaternion, Euler angle
ADC bit number16-bit data output
Gyroscope range±250°, ±500°, ±1000°, ±2000° / s
Acceleration range±2, ±4, ±8, ±16 G
External interfaceExternal magnetometer module
InterruptINT interrupt trigger pin

image-20240806150245483

Basic functions

The attitude sensor integrates a three-axis gyroscope, a three-axis accelerometer, and a temperature sensor.

Three-axis gyroscope: can measure the angular velocity around the X, Y, and Z axes, and is used to detect the rotation and turning movement of an object.

xxxxxxxxxx
Integrating the angular velocity can get the angle

Three-axis accelerometer: can measure the acceleration in the X, Y, and Z axis directions, including the acceleration of gravity and the linear acceleration of the object.

Temperature sensor: MPU6050 also integrates a temperature sensor that can measure the temperature of the environment.

Pin definition

Main control chipPinMain function (after reset)Default multiplexing functionRedefine function
STM32F103RCT6PB10PB10I2C2_SCL/USART3_TXTIM2_CH3
STM32F103RCT6PB11PB11I2C2_SDA/USART3_RXTIM2_CH4
STM32F103RCT6PA12PA12USART1_RTS/USBDP/CAN_TX/TIM1_ETR 

Software code

Since the tutorial is software simulation of I2C, the default pin function can be used.

xxxxxxxxxx
Source code path for product supporting materials: Attachment → Source code summary → 2. Extended_Course → 5. MPU6050

Control function

The tutorial only briefly introduces the code, and you can open the project source code to read it in detail.

IIC_MPU6050_Init

xxxxxxxxxx
void IIC_MPU6050_Init(void)
{           
    GPIO_InitTypeDef GPIO_InitStructure;
    RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOB, ENABLE); //Enable PB port clock
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_10|GPIO_Pin_11; //Port configuration
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP; //Push-pull output
    GPIO_InitStructure.GPIO_Speed ••= GPIO_Speed_50MHz; //50M
    GPIO_Init(GPIOB, &GPIO_InitStructure); //Initialize GPIOB according to the set parameters
}

MPU6050_initialize

xxxxxxxxxx
void MPU6050_initialize(void) {
    MPU6050_setClockSource(MPU6050_CLOCK_PLL_YGYRO); //Set the clock
    MPU6050_setFullScaleGyroRange(MPU6050_GYRO_FS_2000); //Gyro range setting
    MPU6050_setFullScaleAccelRange(MPU6050_ACCEL_FS_2); //Maximum acceleration range +-2G
    MPU6050_setSleepEnabled(0); //Enter working state
    MPU6050_setI2CMasterModeEnabled(0); //Do not let MPU6050 control AUXI2C
    MPU6050_setI2CBypassEnabled(0); //Master controller I2C and MPU6050 AUXI2C pass-through disabled
}

DMP_Init

xxxxxxxxxx
void DMP_Init(void)
{ 
    u8 temp[1]={0};
    i2cRead(0x68,0x75,1,temp);
    printf("mpu_set_sensor complete ......\r\n");
    if(temp[0]!=0x68)NVIC_SystemReset();
    if(!mpu_init())
    {
      if(!mpu_set_sensors(INV_XYZ_GYRO | INV_XYZ_ACCEL))
         printf("mpu_set_sensor complete ......\r\n");
      if(!mpu_configure_fifo(INV_XYZ_GYRO | INV_XYZ_ACCEL))
         printf("mpu_configure_fifo complete ......\r\n");
      if(!mpu_set_sample_rate(DEFAULT_MPU_HZ))
         printf("mpu_set_sample_rate complete ......\r\n");
      if(!dmp_load_motion_driver_firmware())
        printf("dmp_load_motion_driver_firmware complete ......\r\n");
      if(!dmp_set_orientation(inv_orientation_matrix_to_scalar(gyro_orientation)))
         printf("dmp_set_orientation complete ......\r\n");
      if(!dmp_enable_feature(DMP_FEATURE_6X_LP_QUAT | DMP_FEATURE_TAP |
          DMP_FEATURE_ANDROID_ORIENT | DMP_FEATURE_SEND_RAW_ACCEL | DMP_FEATURE_SEND_CAL_GYRO |
          DMP_FEATURE_GYRO_CAL))
         printf("dmp_enable_feature complete ......\r\n");
      if(!dmp_set_fifo_rate(DEFAULT_MPU_HZ))
         printf("dmp_set_fifo_rate complete ......\r\n");
      run_self_test();
        if(!mpu_set_dmp_state(1))
            printf("mpu_set_dmp_state complete ......\r\n");
    }
}

MPU6050_EXTI_Init

xxxxxxxxxx
void MPU6050_EXTI_Init(void)
{  
    GPIO_InitTypeDef GPIO_InitStructure;
    EXTI_InitTypeDef EXTI_InitStructure;
    NVIC_InitTypeDef NVIC_InitStructure;
    RCC_APB2PeriphClockCmd(RCC_APB2Periph_AFIO,ENABLE); //External interrupt, need to enable AFIO clock
    RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); //Enable GPIO port clock
    GPIO_InitStructure.GPIO_Pin = GPIO_Pin_12; //Port configuration
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPU; //Pull-up input
    GPIO_Init(GPIOA, &GPIO_InitStructure); //Initialize GPIO according to the set parameters
    GPIO_EXTILineConfig(GPIO_PortSourceGPIOA,GPIO_PinSource12);
    EXTI_InitStructure.EXTI_Line=EXTI_Line12;
    EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt;
    EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Falling; //Falling edge trigger
    EXTI_InitStructure.EXTI_LineCmd = ENABLE;
    EXTI_Init(&EXTI_InitStructure); //Initialize the peripheral EXTI register according to the parameters specified in EXTI_InitStruct
    NVIC_InitStructure.NVIC_IRQChannel = EXTI15_10_IRQn; //Enable the external interrupt channel where the button is located
    NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 0x02; //Preempt priority 2,
    NVIC_InitStructure.NVIC_IRQChannelSubPriority = 0x01; //Subpriority 3
    NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //Enable external interrupt channel
    NVIC_Init(&NVIC_InitStructure);
}

Experimental phenomenon

The MPU6050.hex file generated by the project compilation is located in the OBJ folder of the MPU6050 project. Find the MPU6050.hex file corresponding to the project and use the FlyMcu software to download the program to the development board.

After the program is successfully downloaded: the serial port will receive the data calculated by MPU6050.

xxxxxxxxxx
When using the serial port debugging assistant, you need to pay attention to the serial port settings. If the settings are wrong, the phenomenon may be inconsistent

image-20240808193540479

OLED Data-Display(I2C)
PID basic concept

COMPANY

  • About us
  • Team Style
  • Blog

LEARNING & EXPLORATION

  • Tutorials
  • Edge AI hardware
  • Educational robots
  • Embedded intelligent hardware

WHERE TO BUY

  • Yahboom Online Store
  • Amazon
  • Alibaba
  • AliExpress
  • Mercado

TECHNOLOGY SUPPORT

  • Email: support@yahboom.com

BE A DISTRIBUTOR

  • Email: sales@yahboom.com
QR Code

Copyright © 2017-2026 Yahboom. All Rights Reserved.

EN/中文