yahboom
HomeLearn
Solution
Blog
Online Store
About Us
EN/中文
Self-balancing Robot Car📖
00.Get started quickly
  • 01.Balance car manual
  • 02.Balancing car assembly
  • 03.Get started quickly
  • 04.Balance car interface description
  • 05.Common Problem Analysis
  • 06.Balance Car V2 Library Function Development Manual
01.Environment development
  • 01.MDK-ARM installation
  • 02.STM32CubeIDE installation
  • 03.Common driver installation
  • 04.Download the program
  • 05.MDK-ARM project usage
  • 06.Program simulation
  • 07. VSCode Installation
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)
  • 13.Window Watchdog (WWDG)
  • 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)
  • 06.Bluetooth module-Data reading (USART)
  • 07.2.4G handle-Data reading (SPI)
  • 08.Tracking module-Read status (GPIO)
  • 09.CCD module-Reading data (ADC)
  • 10.Electromagnetic module-Reading data (ADC)
  • 11.K210 module-Serial communication (USART)
  • 12.Tmini-Plus lidar-Reading data (USART)
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.Robot car advanced course
  • 01.4-channel tracking
  • 02.4-channel tracking avoid
  • 03.2.4G handle control
  • 04.CCD tracking
  • 05.CCD tracking avoid
  • 06.Electromagnetic tracking
  • 07.K210-QR code recognition
  • 08.K210-Color line tracking
  • 09.K210-Color follow
  • 10.K210-Self learning
  • 11.K210-Number recognition
  • 12.Lidar avoid
  • 13.Lidar guard
  • 14.Lidar follow
  • 15.Lidar patrol
  • 16.Lidar wall tracking-straight line
  • 17.Lidar wall tracking-multiple walls
  • 18. DIY Automatic driving car
07.Robot car LQR control
  • Robot car LQR control
08.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
09.Mathematical model
  • Mathematical model
10.Expand course
  • Autonomous Driving
Download
  • APP(Android)
  • Codes
  • Hardware-Info
  • SCH
  • Software Tools
  • STM32_Chip_DataSheet
  • 3D_Model_File
  • Video_PPT
Download ZIP

Welcome to Self-balancing Robot Car repository

02.Ultrasonic module-measuring distance (TIM)

Ultrasonic module-measuring distance (TIM)

Ultrasonic module-measuring distance (TIM)Hardware connectionControl principlePin definitionSoftware codeControl functionExperimental phenomenon

The tutorial mainly demonstrates the implementation of the ultrasonic module distance measurement function.

GPIO general push-pull output function triggers the ultrasonic module distance measurement; timer input capture obtains the ultrasonic high level time, thereby calculating the obstacle distance.
The tutorial only introduces the standard library project code

Hardware connection

image-20240825211022559

Just install it to the corresponding interface:

Ultrasonic moduleSTM32F103RCT6
VCC5V
TRIGPA0
ECHOPA1
GNDGND

Control principle

image-20240903172307044

Trigger ranging signal

The TRIG pin sends a high level signal for more than 10us.

xxxxxxxxxx
The ultrasonic module will automatically send 8 40KHz square waves and automatically detect whether there is a signal return

Receive echo signal

If there is a signal return, the ECHO pin will output a high level. The duration of the high level is the time from the ultrasonic wave transmission to the return.

Distance conversion

Distance=Thigh∗Vspeed2
xxxxxxxxxx
T: Echo signal high level time
V: Sound speed (approximately equal to 340m/s)

Pin definition

Main control chipPinMain function (after reset)Default multiplexing functionRedefine function
STM32F103RCT6PA0PA0WKUP/USART2_CTS/ADC123_IN0/TIM2_CH1_ETR/TIM5_CH1/TIM8_ETR 
STM32F103RCT6PA1PA1USART2_RTS/ADC123_IN1/TIM5_CH2/TIM2_CH2 

Software code

Since the default function of all pins is the ordinary IO pin function, we need to use the multiplexing function.

xxxxxxxxxx
Product supporting materials source code path: Attachment → Source code summary → 2.Extended_Course → 2.Ultrasonic

Control function

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

ultrasonic_init

​x
static void ultrasonic_init(void)
{
    GPIO_InitTypeDef GPIO_InitStructure;
    RCC_APB2PeriphClockCmd(ULTRASONIC_RCC, ENABLE);   // Enable the GPIOA clock

    GPIO_InitStructure.GPIO_Pin  = ECHO_PIN;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD;  //PA1 Input
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;      //50M
    GPIO_Init(ECHO_PORT, &GPIO_InitStructure);

    GPIO_InitStructure.GPIO_Pin  = TRIG_PIN;
    GPIO_InitStructure.GPIO_Mode = GPIO_Mode_Out_PP;      //PA3 output
    GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz;      //50M
    GPIO_Init(TRIG_PORT, &GPIO_InitStructure);
}

TIM2_Cap_Init

xxxxxxxxxx
void TIM2_Cap_Init(u16 arr,u16 psc) 
{
    TIM_ICInitTypeDef TIM2_ICInitStructure;
    TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
    NVIC_InitTypeDef NVIC_InitStructure;

    ultrasonic_init();
    RCC_APB1PeriphClockCmd(RCC_APB1Periph_TIM2, ENABLE); //Enable TIM2 clock

    //Initialize timer 2 TIM2
    TIM_TimeBaseStructure.TIM_Period = arr; //Set counter auto-reload value
    TIM_TimeBaseStructure.TIM_Prescaler = psc; //Prescaler
    TIM_TimeBaseStructure.TIM_ClockDivision = TIM_CKD_DIV1; //Set clock division: TDTS = Tck_tim
    TIM_TimeBaseStructure.TIM_CounterMode = TIM_CounterMode_Up; //TIM up counting mode
    TIM_TimeBaseInit(TIM2, &TIM_TimeBaseStructure); //Initialize the time base unit of TIMx according to the parameters specified in TIM_TimeBaseInitStruct

    //Initialize TIM2 input capture parameters
    TIM2_ICInitStructure.TIM_Channel = TIM_Channel_2; //CC1S=02 Select input IC2 to map to TI1
    TIM2_ICInitStructure.TIM_ICPolarity = TIM_ICPolarity_Rising; //Rising edge capture
    TIM2_ICInitStructure.TIM_ICSelection = TIM_ICSelection_DirectTI;
    TIM2_ICInitStructure.TIM_ICPrescaler = TIM_ICPSC_DIV1; //Configure input frequency division, no frequency division
    TIM2_ICInitStructure.TIM_ICFilter = 0x00; //Configure input filter No filtering
    TIM_ICInit(TIM2, &TIM2_ICInitStructure);

    //Interrupt group initialization
    NVIC_InitStructure.NVIC_IRQChannel = TIM2_IRQn; //TIM2 interrupt
    NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority = 1; //Preempt priority level 1
    NVIC_InitStructure.NVIC_IRQChannelSubPriority = 1; //From priority level 1
    NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ channel is enabled
    NVIC_Init(&NVIC_InitStructure); //Initialize peripheral NVIC registers according to the parameters specified in NVIC_InitStruct
    TIM_ITConfig(TIM2,TIM_IT_Update|TIM_IT_CC2,ENABLE);//Allow update interrupts, allow CC2IE to capture interrupts
    TIM_Cmd(TIM2,ENABLE); //Enable timer 2
}

TIM2_IRQHandler

xxxxxxxxxx
void TIM2_IRQHandler(void)
{
    u16 tsr;
    tsr=TIM2->SR;
    if((TIM2CH2_CAPTURE_STA&0X80)==0)// Capture has not succeeded
    {
        if(tsr&0X01)// The timer overflows
        {
            if(TIM2CH2_CAPTURE_STA&0X40)// The high level has been captured
            {
                if((TIM2CH2_CAPTURE_STA&0X3F)==0X3F)// The high level is too long
                {
                    TIM2CH2_CAPTURE_STA|=0X80;       // Indicates a successful capture
                    TIM2CH2_CAPTURE_VAL=0XFFFF;
                }else TIM2CH2_CAPTURE_STA++;
            }
        }
        if(tsr&0x04)// Capture 2 A capture event occurred
        {
            if(TIM2CH2_CAPTURE_STA&0X40) // Captures a falling edge
            {
                TIM2CH2_CAPTURE_STA|=0X80;         // Mark that a high level pulse width was successfully captured
                TIM2CH2_CAPTURE_VAL=TIM2->CCR2;  // Gets the current capture value.
                TIM2->CCER&=~(1<<5);                   //CC2P=0 Set to rising edge capture
            }
        else // Not yet started, first capture rising edge
        {
            TIM2CH2_CAPTURE_STA=0;    // Empty
            TIM2CH2_CAPTURE_VAL=0;
            TIM2CH2_CAPTURE_STA|=0X40;       // The flag captures the rising edge
            TIM2->CNT=0;                                     // The counter is cleared
            TIM2->CCER|=1<<5;                        //CC2P=1 Set to falling edge capture
        }
        }
    }
    TIM2->SR=0; // Clears the interrupt flag bit
}

Experimental phenomenon

The Ultrasonic.hex file generated by the project compilation is located in the OBJ folder of Ultrasonic project. The corresponding Ultrasonic.hex file is found and the program is downloaded into the development board by using FlyMcu software.

After successful download: Serial port will print Ultrasonic Class! After hardware initialization Then control LED status switch and print obstacle distance every 500ms.

xxxxxxxxxx
When using the serial port debugging Assistant, pay attention to the serial port Settings. Incorrect Settings may cause inconsistency

image-20240808192926663

Battery voltage detection (ADC)
Motor drive+encoder (TIM)

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/中文