[STM32F103C8T6]基于stm32的循迹，跟随，避障智能小车

news2024/11/28 16:51:55

目录

1.小车驱动主要是通过L9110S模块来驱动电机

motor.c

2.我们可以加入串口控制电机驱动(重写串口接收回调函数，和重定向printf)

Uart.c

main.c 

3.点动功能

uart.c

main.c

为什么使用的是HAL_Delay()要设置滴答定时器的中断优先级呢？

4.小车PWM调速， 

6.跟随功能

7.避障功能

超声波测距流程

 CSB.c

SG90.c

main.c

1.小车驱动主要是通过L9110S模块来驱动电机

 本次STM32与L9110s的接线是：

B-1A -- PB0
B-1B -- PB1
A-1A -- PB2
A-1B -- PB10

通过对GPIO口的配置，可以写出电机的驱动程序(全速模式)

motor.c

#include "motor.h"
#include "gpio.h"

void GoForward(void)
{
	//右轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_0,GPIO_PIN_SET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_1,GPIO_PIN_RESET);
	//左轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_2,GPIO_PIN_SET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_10,GPIO_PIN_RESET);
}

void GoBack(void)
{
	//右轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_0,GPIO_PIN_RESET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_1,GPIO_PIN_SET);
	//左轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_2,GPIO_PIN_RESET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_10,GPIO_PIN_SET);
}

void GoLeft(void)
{
	//右轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_0,GPIO_PIN_SET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_1,GPIO_PIN_RESET);
	//左轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_2,GPIO_PIN_RESET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_10,GPIO_PIN_RESET);
}

void GoRight(void)
{
	//右轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_0,GPIO_PIN_RESET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_1,GPIO_PIN_RESET);
	//左轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_2,GPIO_PIN_SET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_10,GPIO_PIN_RESET);
}

void Stop(void)
{
	//右轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_0,GPIO_PIN_RESET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_1,GPIO_PIN_RESET);
	//左轮
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_2,GPIO_PIN_RESET);
	HAL_GPIO_WritePin(GPIOB,GPIO_PIN_10,GPIO_PIN_RESET);
}

2.我们可以加入串口控制电机驱动(重写串口接收回调函数，和重定向printf)

加入串口控制，我们需要在cubeMX中开启串口中断用于接收串口发来的数据

Uart.c

void HAL_UART_MspDeInit(UART_HandleTypeDef* uartHandle)
{

  if(uartHandle->Instance==USART1)
  {
  /* USER CODE BEGIN USART1_MspDeInit 0 */

  /* USER CODE END USART1_MspDeInit 0 */
    /* Peripheral clock disable */
    __HAL_RCC_USART1_CLK_DISABLE();

    /**USART1 GPIO Configuration
    PA9     ------> USART1_TX
    PA10     ------> USART1_RX
    */
    HAL_GPIO_DeInit(GPIOA, GPIO_PIN_9|GPIO_PIN_10);

    /* USART1 interrupt Deinit */
    HAL_NVIC_DisableIRQ(USART1_IRQn);
  /* USER CODE BEGIN USART1_MspDeInit 1 */

  /* USER CODE END USART1_MspDeInit 1 */
  }
}

/* USER CODE BEGIN 1 */
//串口接收缓存（1字节）
uint8_t buf=0;
//定义最大接收字节数 200，可根据需求调整
#define UART1_REC_LEN 200
#define SIZE 12
// 接收缓冲, 串口接收到的数据放在这个数组里，最大UART1_REC_LEN个字节
uint8_t UART1_RX_Buffer[UART1_REC_LEN];
// 接收状态
// bit15， 接收完成标志
// bit14， 接收到0x0d
// bit13~0， 接收到的有效字节数目
uint16_t UART1_RX_STA=0;

char buffer[SIZE];
// 接收完成回调函数，收到一个数据后，在这里处理
void HAL_UART_RxCpltCallback(UART_HandleTypeDef *huart)
{
// 判断中断是由哪个串口触发的
if(huart->Instance == USART1)
{
// 判断接收是否完成（UART1_RX_STA bit15 位是否为1）
if((UART1_RX_STA & 0x8000) == 0)
{
// 如果已经收到了 0x0d （回车），
if(UART1_RX_STA & 0x4000)
{
// 则接着判断是否收到 0x0a （换行）
if(buf == 0x0a)
{
// 如果 0x0a 和 0x0d 都收到，则将 bit15 位置为1
	UART1_RX_STA |= 0x8000;
//	printf("1");
	
	// 车控指令
	if(!strcmp((const char*)UART1_RX_Buffer, "M1"))
	{	
		printf("Forwad......");
		GoForward();
	}
	else if(!strcmp((const char*)UART1_RX_Buffer, "M2"))
	{
		printf("Back......");
		GoBack();
	}
	else if(!strcmp((const char*)UART1_RX_Buffer, "M3"))
	{
		printf("Left......");
		GoLeft();
	}
	else if(!strcmp((const char*)UART1_RX_Buffer, "M4"))
	{
		printf("Right......");
		GoRight();
	}
	else if(!strcmp((const char*)UART1_RX_Buffer, "Stop"))
	{
		printf("Stop......");
		Stop();
	}
		memset(UART1_RX_Buffer, 0, UART1_REC_LEN);
		UART1_RX_STA = 0;
	}
	else
// 否则认为接收错误，重新开始
		UART1_RX_STA = 0;
}
	else // 如果没有收到了 0x0d （回车）
{
	//则先判断收到的这个字符是否是 0x0d （回车）
	if(buf == 0x0d)
{	
// 是的话则将 bit14 位置为1
		UART1_RX_STA |= 0x4000;
	}
else
{
// 否则将接收到的数据保存在缓存数组里
		UART1_RX_Buffer[UART1_RX_STA & 0X3FFF] = buf;
		UART1_RX_STA++;
// 如果接收数据大于UART1_REC_LEN（200字节），则重新开始接收
	if(UART1_RX_STA > UART1_REC_LEN - 1)
		UART1_RX_STA = 0;
		}
	}
}
// 重新开启中断
HAL_UART_Receive_IT(&huart1, &buf, 1);
	}
}

int fputc(int ch, FILE *f)
{
	unsigned char temp[1]={ch};
	HAL_UART_Transmit(&huart1,temp,1,0xffff);
	return ch;
}

main.c 

extern uint8_t buf;

int main(void)
{
  /* USER CODE BEGIN 1 */

  /* USER CODE END 1 */

  /* MCU Configuration--------------------------------------------------------*/

  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init();

  /* USER CODE BEGIN Init */

  /* USER CODE END Init */

  /* Configure the system clock */
  SystemClock_Config();

  /* USER CODE BEGIN SysInit */

  /* USER CODE END SysInit */

  /* Initialize all configured peripherals */
  MX_GPIO_Init();
  MX_USART1_UART_Init();
  /* USER CODE BEGIN 2 */
	HAL_UART_Receive_IT(&huart1, &buf, 1);//开启串口接收
  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
    /* USER CODE END WHILE */

    /* USER CODE BEGIN 3 */
  }
  /* USER CODE END 3 */
}

 切记主函数内需要调用开启串口接收函数！！！！！！

将HC08模块接入STM32，连接蓝牙就可以通过蓝牙APP控制

3.点动功能

如果用蓝牙app实现遥控车模式，我们会发现，点了前进按钮，小车会一直前进，按下左转会一直左转，而遥控车应该是点动功能，按一下向前就向前走一下，一直按一直走

我的思路是，主程序一直跑Stop(); 接收到来自蓝牙（串口）的数据后执行动作（几毫秒），从而实现点动

uart.c

void HAL_UART_MspDeInit(UART_HandleTypeDef* uartHandle)
{

  if(uartHandle->Instance==USART1)
  {
  /* USER CODE BEGIN USART1_MspDeInit 0 */

  /* USER CODE END USART1_MspDeInit 0 */
    /* Peripheral clock disable */
    __HAL_RCC_USART1_CLK_DISABLE();

    /**USART1 GPIO Configuration
    PA9     ------> USART1_TX
    PA10     ------> USART1_RX
    */
    HAL_GPIO_DeInit(GPIOA, GPIO_PIN_9|GPIO_PIN_10);

    /* USART1 interrupt Deinit */
    HAL_NVIC_DisableIRQ(USART1_IRQn);
  /* USER CODE BEGIN USART1_MspDeInit 1 */

  /* USER CODE END USART1_MspDeInit 1 */
  }
}

/* USER CODE BEGIN 1 */
//串口接收缓存（1字节）
uint8_t buf=0;
//定义最大接收字节数 200，可根据需求调整
#define UART1_REC_LEN 200
#define SIZE 12
// 接收缓冲, 串口接收到的数据放在这个数组里，最大UART1_REC_LEN个字节
uint8_t UART1_RX_Buffer[UART1_REC_LEN];
// 接收状态
// bit15， 接收完成标志
// bit14， 接收到0x0d
// bit13~0， 接收到的有效字节数目
uint16_t UART1_RX_STA=0;

char buffer[SIZE];
// 接收完成回调函数，收到一个数据后，在这里处理
void HAL_UART_RxCpltCallback(UART_HandleTypeDef *huart)
{
// 判断中断是由哪个串口触发的
if(huart->Instance == USART1)
{
// 判断接收是否完成（UART1_RX_STA bit15 位是否为1）
if((UART1_RX_STA & 0x8000) == 0)
{
// 如果已经收到了 0x0d （回车），
if(UART1_RX_STA & 0x4000)
{
// 则接着判断是否收到 0x0a （换行）
if(buf == 0x0a)
{
// 如果 0x0a 和 0x0d 都收到，则将 bit15 位置为1
	UART1_RX_STA |= 0x8000;
//	printf("1");
	
	// 车控指令
	if(!strcmp((const char*)UART1_RX_Buffer, "M1"))
	{	
		printf("Forwad......");
		GoForward();
        HAL_Delay(10);
	}
	else if(!strcmp((const char*)UART1_RX_Buffer, "M2"))
	{
		printf("Back......");
		GoBack();
        HAL_Delay(10);
	}
	else if(!strcmp((const char*)UART1_RX_Buffer, "M3"))
	{
		printf("Left......");
		GoLeft();
        HAL_Delay(10);
	}
	else if(!strcmp((const char*)UART1_RX_Buffer, "M4"))
	{
		printf("Right......");
		GoRight();
        HAL_Delay(10);
	}
	else if(!strcmp((const char*)UART1_RX_Buffer, "Stop"))
	{
		printf("Stop......");
		Stop();
        HAL_Delay(10);
	}
		memset(UART1_RX_Buffer, 0, UART1_REC_LEN);
		UART1_RX_STA = 0;
	}
	else
// 否则认为接收错误，重新开始
		UART1_RX_STA = 0;
}
	else // 如果没有收到了 0x0d （回车）
{
	//则先判断收到的这个字符是否是 0x0d （回车）
	if(buf == 0x0d)
{	
// 是的话则将 bit14 位置为1
		UART1_RX_STA |= 0x4000;
	}
else
{
// 否则将接收到的数据保存在缓存数组里
		UART1_RX_Buffer[UART1_RX_STA & 0X3FFF] = buf;
		UART1_RX_STA++;
// 如果接收数据大于UART1_REC_LEN（200字节），则重新开始接收
	if(UART1_RX_STA > UART1_REC_LEN - 1)
		UART1_RX_STA = 0;
		}
	}
}
// 重新开启中断
HAL_UART_Receive_IT(&huart1, &buf, 1);
	}
}

int fputc(int ch, FILE *f)
{
	unsigned char temp[1]={ch};
	HAL_UART_Transmit(&huart1,temp,1,0xffff);
	return ch;
}

main.c

extern uint8_t buf;

int main(void)
{
  /* USER CODE BEGIN 1 */

  /* USER CODE END 1 */

  /* MCU Configuration--------------------------------------------------------*/

  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init();

  /* USER CODE BEGIN Init */

  /* USER CODE END Init */

  /* Configure the system clock */
  SystemClock_Config();

  /* USER CODE BEGIN SysInit */

  /* USER CODE END SysInit */

  /* Initialize all configured peripherals */
  MX_GPIO_Init();
  MX_USART1_UART_Init();
  /* USER CODE BEGIN 2 */
	HAL_UART_Receive_IT(&huart1, &buf, 1);//开启串口接收
    HAL_NVIC_SetPriority(SysTick_IRQn,0,0);//提高滴答定时器优先级
  /* USER CODE END 2 */

  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
    /* USER CODE END WHILE */
       Stop();
    /* USER CODE BEGIN 3 */
  }
  /* USER CODE END 3 */
}

提高滴答定时器优先级，这样的话在串口中断中使用HAL_Delay()不会出现卡死的bug

为什么使用的是HAL_Delay()要设置滴答定时器的中断优先级呢？

从英文解释中（别说看不懂哈），Systick被配置为系统时基，并且被配置为了1ms，做技术，要有刨根问底的精神，奥利给，继续跟进去看看

 

 

 关于滴答定时器可以看这篇文章，us级延时怎么实现

(77条消息) HAL库与Cubemx系列|Systick-系统滴答定时器详解_hal库 systick 中断_小飞哥玩嵌入式的博客-CSDN博客https://blog.csdn.net/qq_16519885/article/details/117756815?ops_request_misc=&request_id=&biz_id=102&utm_term=HAL_Delay%E6%98%AF%E6%BB%B4%E7%AD%94%E5%AE%9A%E6%97%B6%E5%99%A8%E5%90%97&utm_medium=distribute.pc_search_result.none-task-blog-2~all~sobaiduweb~default-2-117756815.142%5Ev83%5Epc_search_v2,239%5Ev2%5Einsert_chatgpt&spm=1018.2226.3001.4187

//使用TIM2来做us级延时函数
void TIM2_Delay_us(uint16_t n_us)
{
/* 使能定时器2计数 */
	__HAL_TIM_ENABLE(&htim2);
	__HAL_TIM_SetCounter(&htim2, 0);
	while(__HAL_TIM_GetCounter(&htim2) < ((1 * n_us)-1) );
	/* 关闭定时器2计数 */
	__HAL_TIM_DISABLE(&htim2);
}

 

4.小车PWM调速， 

通过实验我们又发现了bug，如果是全速驱动的话，小车转弯，比如左转就会左边轮子不动右边动，理论上是这样的，但是实际上会出现小车转弯一卡一卡的bug，于是我想到了用PWM调速，转弯的时候左右轮分开调速，左转就左轮速度低于右轮，右转就右轮速度低于左轮

STM32与51单片机不同，STM32具有硬件PWM调速

根据查数据手册可知，我使用的是TIM2的CH1和CH2，CH1,CH2分别对应左右轮

更改后连线为

B-1A -- PA0
B-1B -- PB1
A-1A -- PA1
A-1B -- PB10

  

具体PWM可以参考之前写的PWM实现呼吸灯文章

(77条消息) [STM32F103C8T6]PWM呼吸灯_stm32f103c8t6呼吸灯_TX564的博客-CSDN博客https://blog.csdn.net/weixin_63303786/article/details/129047166?spm=1001.2014.3001.5502

 根据前面L9110s模块的运用可知，A-1A,A-1B,B-1A,B-2B是分别为一高一低电平才能驱动

当PWM调速时，PWM使用的TIM2对应端口PA0,PA1会出现占空比，占空比内为高电平，那么其他两个IO口就必须为低电平，才能驱动L9110s,所以PWM调速，必须将对应电机驱动的所有的IO口都拉低

 

 PWM主要用的两个函数 一个是PWM启动函数，一个是PWM比较函数

HAL_TIM_PWM_Start ( & htim2 , TIM_CHANNEL_1 );
HAL_TIM_PWM_Start ( & htim2 , TIM_CHANNEL_2 )；
__HAL_TIM_SetCompare ( & htim2 , TIM_CHANNEL_1 , 8 );//8是PWM_Val的值，小于8都是高电平，大于8是低电平，这个数的值要小于设定的 CCRx 
void　main()
{
    HAL_TIM_PWM_Start(&htim2,TIM_CHANNEL_1);
    HAL_TIM_PWM_Start(&htim2,TIM_CHANNEL_2);
    while(1)
    {
        __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_1,8);
        __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_2,15);
        HAL_Delay(1000);
        __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_1,15);
        __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_2,8);
        HAL_Delay(1000);
    }
}

解决过弯一卡一卡的bug就可以将

         __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_1,8);
        __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_2,15);

替换motor.c中的GPIO_PIN_WritePin函数

5.小车循迹功能

小车循迹主要用到的模块是循迹模块

  

小车循迹主要是通过循迹模块，黑色会续收红外线，当红外线被吸收，就没法返回，于是模块输出高电平，灯灭，如果是白色区域，红外线会返回，灯亮，输出低电平

本次接线是将两个循迹模块的DO接入PB5,PB6

于是循迹的逻辑就是，左右两边各安一个循迹模块，当两个模块都返回红外线输出低电平灯亮的时候，小车向前进，如果左边模块没有返回红外线高电平灯灭，右边模块返回红外线低电平灯亮，那么就说明遇到左转弯道，左转，相反就右转----->哪边高电平往哪边转

#define LeftWheel_Value HAL_GPIO_ReadPin(GPIOB, GPIO_PIN_3)
#define RightWheel_Value HAL_GPIO_ReadPin(GPIOB, GPIO_PIN_4)

void xunji(void)
{
 if(LeftWheel_Value == GPIO_PIN_RESET && RightWheel_Value == GPIO_PIN_RESET)
 {
    __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_1,19);
    __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_2,19);
 }
if(LeftWheel_Value == GPIO_PIN_SET && RightWheel_Value == GPIO_PIN_RESET)
 {
    __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_1,15);
    __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_2,8);
 }
if(LeftWheel_Value == GPIO_PIN_RESET && RightWheel_Value == GPIO_PIN_SET)
 {
    __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_1,8);
    __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_2,15);
 }
if(LeftWheel_Value == GPIO_PIN_SET && RightWheel_Value == GPIO_PIN_SET)
 {
    __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_1,0);
    __HAL_TIM_SetCompare(&htim2, TIM_CHANNEL_2,0);
 }
}

// main函数里
while (1)
{
    xunji();
}

6.跟随功能

跟随功能的实现主要是跟随模块

 

 哪边低电平，往哪边转（因为跟随模块是有物体挡着才会返回红外线，返回为低电平）

#define LeftWheel_Value HAL_GPIO_ReadPin(GPIOB, GPIO_PIN_5)
#define RightWheel_Value HAL_GPIO_ReadPin(GPIOB, GPIO_PIN_6)

void gensui(void)
{
     if(LeftWheel_Value == GPIO_PIN_RESET && RightWheel_Value == GPIO_PIN_RESET)
    goForward();
   if(LeftWheel_Value == GPIO_PIN_SET && RightWheel_Value == GPIO_PIN_RESET)
    goRight();
   if(LeftWheel_Value == GPIO_PIN_RESET && RightWheel_Value == GPIO_PIN_SET)
    goLeft();
   if(LeftWheel_Value == GPIO_PIN_SET && RightWheel_Value == GPIO_PIN_SET)
    stop();

}


// main函数里
while (1)
{
  gensui();
}

7.避障功能

避障功能主要是依靠SG90舵机和超声波实现的，当超声波测距小于一个值，比如35cm，SG90舵机开始转动角度，实现超声波摇头，摇头：显示中间位，然后左转，然后右转

超声波测距流程

1.Trig至少10us的高电平

2.发送波，定时器启动，开始计时

启动定时器的函数：HAL_TIM_Base_Start(&htim2);//启动定时器2

开始计算时间函数：__HAL_TIM_SetCounter(&htim2,0);//计算时间

2.1怎么判断是否发送波了呢？：当波发送出去echo会由低电平变为高电平 while(HAL_GPIO_ReadPin(GPIOB,GPIO_PIN_7) == GPIO_PIN_RESET);//卡低电平

3.接收到波，定时器关闭停止计时

停止定时器的函数：HAL_TIM_Base_Stop(&htim2);//停止定时器

3.1怎么判断接收到波了呢？：当接收到波echo会由高电平变为低电平

while(HAL_GPIO_ReadPin(GPIOB,GPIO_PIN_7) == GPIO_PIN_SET);//卡高电平

4.读取定时器计时时间

获取时间的函数：cnt = __HAL_TIM_GetCounter(&htim2);

5.distance = （340m/s * 时间)/2（注意换算单位 100cm/1000000us） 

 CSB.c


//使用TIM2来做us级延时函数
void TIM2_Delay_us(uint16_t n_us)
{
/* 使能定时器2计数 */
	__HAL_TIM_ENABLE(&htim2);
	__HAL_TIM_SetCounter(&htim2, 0);
	while(__HAL_TIM_GetCounter(&htim2) < ((1 * n_us)-1) );
	/* 关闭定时器2计数 */
	__HAL_TIM_DISABLE(&htim2);
}
double get_distance(void)
{
	int cnt=0;
//1. Trig ，给Trig端口至少10us的高电平
	HAL_GPIO_WritePin(GPIOB, GPIO_PIN_7, GPIO_PIN_SET);//拉高
	TIM2_Delay_us(20);
	HAL_GPIO_WritePin(GPIOB, GPIO_PIN_7, GPIO_PIN_RESET);//拉低
//2. echo由低电平跳转到高电平，表示开始发送波
//波发出去的那一下，开始启动定时器
	while(HAL_GPIO_ReadPin(GPIOB, GPIO_PIN_8) == GPIO_PIN_RESET);//等待输入电平拉高
	HAL_TIM_Base_Start(&htim2);//启动定时器2
	__HAL_TIM_SetCounter(&htim2,0);//计算时间
//3. 由高电平跳转回低电平，表示波回来了
	while(HAL_GPIO_ReadPin(GPIOB, GPIO_PIN_8) == GPIO_PIN_SET);//等待输入电平变低
//波回来的那一下，我们开始停止定时器
	HAL_TIM_Base_Stop(&htim2);//停止定时器
//4. 计算出中间经过多少时间
	cnt = __HAL_TIM_GetCounter(&htim2);//获取时间
//5. 距离 = 速度 （340m/s）* 时间/2（计数1次表示1us）
	return (cnt*340/2*0.000001*100); //单位：cm
}

SG90.c

void initSG90(void)
{
	HAL_TIM_PWM_Start(&htim4,TIM_CHANNEL_4); //启动定时器4,启动PWM
	__HAL_TIM_SetCompare(&htim4, TIM_CHANNEL_4, 9); //将舵机置为90度
}
void sgMiddle(void)
{
	__HAL_TIM_SetCompare(&htim4, TIM_CHANNEL_4, 9); //将舵机置为75度
}
void sgRight(void)
{
	__HAL_TIM_SetCompare(&htim4, TIM_CHANNEL_4, 5); //将舵机置为0度
}
void sgLeft(void)
{
	__HAL_TIM_SetCompare(&htim4, TIM_CHANNEL_4, 14); //将舵机置为135度
}

main.c

#define MIDDLE 0
#define RIGHT 2
#define LEFT  1

int main(void)
{
  /* USER CODE BEGIN 1 */
	char dir;
	double disMiddle;
	double disLeft;
	double disRight;
  /* USER CODE END 1 */

  /* MCU Configuration--------------------------------------------------------*/

  /* Reset of all peripherals, Initializes the Flash interface and the Systick. */
  HAL_Init();

  /* USER CODE BEGIN Init */

  /* USER CODE END Init */

  /* Configure the system clock */
  SystemClock_Config();

  /* USER CODE BEGIN SysInit */

  /* USER CODE END SysInit */

  /* Initialize all configured peripherals */
  MX_GPIO_Init();
  MX_TIM4_Init();
  MX_TIM2_Init();
  /* USER CODE BEGIN 2 */
	initSG90();//一开始先让超声波在中间位
	HAL_Delay(1000);
  /* USER CODE END 2 */
    void csb(void)
     {
          /*为了不歪头卡死，每次必须测完回到中间位*/
		if(dir != MIDDLE){
		sgMiddle();
		dir = MIDDLE;
		HAL_Delay(300);
		}
        /*为了不歪头卡死，每次必须测完回到中间位*/
			disMiddle = get_distance();
			if(disMiddle > 35){
			//前进
			GoForward();
		}else if(disMiddle < 10){
			GoBack();
		}else
		{
			//停止
			Stop();
			//测左边距离
			sgLeft();
			HAL_Delay(300);
			
            disLeft = get_distance();
			sgMiddle();
			HAL_Delay(300);
			
            sgRight();
			dir = RIGHT;
			HAL_Delay(300);
			disRight = get_distance();
		if(disLeft < disRight){
			GoRight();
			HAL_Delay(150);
			Stop();
		}
			if(disRight < disLeft){
			GoLeft();
			HAL_Delay(150);
			Stop();
		}
	 }
   }
  /* Infinite loop */
  /* USER CODE BEGIN WHILE */
  while (1)
  {
    /* USER CODE END WHILE */
       csb();
       HAL_Delay(50);//必须要延时，不然执行代码速度太快就会一直前进或者后退，不会摇头
    /* USER CODE BEGIN 3 */
  }
  /* USER CODE END 3 */
}

将所有模块的函数封装好后，可以通过按键或者其他方式切换循迹，跟随，避障模式

#define Key_On 0
#define Key_Off 1

unsigned char Scanf_Key(GPIO_TypeDef *GPIOx, uint16_t GPIO_Pin)
{
    unsigned int status;
    status = HAL_GPIO_ReadPin(GPIO_TypeDef *GPIOx, uint16_t GPIO_Pin);
    if(status == GPIO_PIN_RESET)
    return 0;
    else if(status == GPIO_PIN_SET)
    return 1;
}

void main()
{
  while(1)
  {
    if(Scanf_Key(GPIOA,GPIO_PIN_0) == Key_On)
    {
        csb();
    }

    if(Scanf_Key(GPIOA,GPIO_PIN_1) == Key_On)
    {
        gensui();
    }
    
    if(Scanf_Key(GPIOA,GPIO_PIN_3) == Key_On)
    {
        xunji();
    }
 }
}

本文来自互联网用户投稿，该文观点仅代表作者本人，不代表本站立场。本站仅提供信息存储空间服务，不拥有所有权，不承担相关法律责任。如若转载，请注明出处：http://www.coloradmin.cn/o/428515.html

如若内容造成侵权/违法违规/事实不符，请联系多彩编程网进行投诉反馈，一经查实，立即删除！

相关文章

如何在 Mac上运行 Windows程序？

如何在 Mac上运行 Windows程序？

在Mac 上运行 Windows的工具 在 Mac 上运行 Windows-无需重启即可在您的 Intel 或 Apple M 系列 Mac 上运行 Windows的工具来了，非常强悍和使用，有需要的朋友可以参考一下。 主要功能 运行快速、操作简单、功能强大的应用程序，无需重启即可在您的 Intel 或 Apple M 系列 M…
阅读更多...
基于 VITA57.1 的 2 路 125MSPS AD 采集、2 路 250MSPS DA 回放 FMC 子卡模块

基于 VITA57.1 的 2 路 125MSPS AD 采集、2 路 250MSPS DA 回放 FMC 子卡模块

板卡概述 FMC150_V30 是一款基于 VITA57.1 规范的 2 路 125MSPS 采样率 16 位分辨率 AD 采集、2 路 250MSPS 采样率 16 位分辨率 DA 回放 FMC 子卡模块。该模块遵循 VITA57.1 规范&#xff0c;可直接与符合 VITA57.1 规范的 FPGA 载卡配合使用&#xff0c;板卡 ADC 器件采用 AD…
阅读更多...
接口自动化两大神器：正则提取器和jsonpath提取器

接口自动化两大神器：正则提取器和jsonpath提取器

一、前言 在开展接口测试的过程中&#xff0c;我们会发现很多接口需要依赖前面的接口&#xff0c;需要我们动态从前面的接口返回中提取数据&#xff0c;也就是我们通常说的关联。 关联通俗来讲就是把上一次请求的返回内容中的部分截取出来保存为参数&#xff0c;用来传递给下…
阅读更多...
迅为龙芯2K0500全国产开发板

迅为龙芯2K0500全国产开发板

目录 龙芯2K0500处理器 动态电源管理 低功耗技术 产品开发更快捷 全国产设计方案 2K0500核心板 邮票孔连接 丰富接口 高扩展性 系统全开源 品质保障 行业应用 龙芯2K0500处理器 迅为iTOP-LS2K0500开发采用龙芯LS2K0500处理器&#xff0c;基于龙芯自主指令系统&#x…
阅读更多...
托福听力专项 // Unit1 Listening for Main Ideas //共5篇conversations

托福听力专项 // Unit1 Listening for Main Ideas //共5篇conversations

目录 I a history class II a student & a librarian III a student & a professor IV a student & a bookstore clerk I a history class its definition II a student & a librarian (1) The librarian was happy to help and explained to the studen…
阅读更多...
软件工程part02-软件需求与需求规约

软件工程part02-软件需求与需求规约

文章目录课程简介考试大纲软件需求与需求规约2.0 可行性分析2.1 需求概述需求分类2.2 需求工程步骤2.3 需求获取2.4 需求规约2.4.1 逻辑模型和物理模型2.4.2 需求分析过程示意2.4.3 结构化分析模型2.4.4 E-R图是数据建模的基础2.4.5 数据流图2.4.5.3 数据流命名规则2.4.5.6 DFD…
阅读更多...
【学习cmake-cookbook/chapter-03/recipe-09/c-example-3.5】

【学习cmake-cookbook/chapter-03/recipe-09/c-example-3.5】

代码&#xff1a;cmake-cookbook/chapter-03/recipe-09/c-example-3.5 at master qijitao/cmake-cookbook GitHub 一、 找不到libzmq。 解决办法&#xff1a; 1、首先尝试安装libzmq-dev&#xff0c;但是安装失败&#xff1a; 2、网上查了一下&#xff0c;Ubuntu 17及更高版本…
阅读更多...
《Unity Shader 入门精要》第9章 更复杂的光照

《Unity Shader 入门精要》第9章 更复杂的光照

第9章 更复杂的光照 9.1 Unity 的渲染路径 在 Unity 中&#xff0c;渲染路径&#xff08;Rendering Path&#xff09;决定了光照是如何应用到 Unity Shader 中的。 Unity 支持以下几种渲染路径&#xff1a; 前向渲染路径&#xff08;Forward Rendering Path&#xff09;延迟…
阅读更多...
D. Orac and Medians(贪心 + 构造)

D. Orac and Medians(贪心 + 构造)

Problem - D - Codeforces 史莱姆有—系列正整数个2个…., .n个 在一个操作中&#xff0c;Orac可以选择任意子段( ...r]并替换所有值一;个布..&#xff0c;到中位数的值{T;T分.&#xff0c;一打 在这个问题中&#xff0c;对于整数多集s&#xff0c;中位数s等于[产]-其中最小的数…
阅读更多...
aosp11/12/13 framework源码开发IDE工具之idegen/aidegen/AIDEGen详细使用

aosp11/12/13 framework源码开发IDE工具之idegen/aidegen/AIDEGen详细使用

hi,粉丝朋友&#xff1a; 近期又粉丝朋友聊到了如果做aosp系统应用开发&#xff0c;有什么工具或者方式来导入代码可以正常跳转和代码提示等&#xff1f; 更多内容&#xff1a; https://blog.csdn.net/learnframework/article/details/130016893 Android Studio导入系统源码 …
阅读更多...
【pycharm】往svn仓库commit过滤文件

【pycharm】往svn仓库commit过滤文件

目录 一、配置好SVN仓库 二、新建一个changelist 1、找到下方版本控制 2、右击 3、新增一个不提交的changelist&#xff08;这里其实就是忽略的列表&#xff09;将不提交的都放这里 三、将忽略的文件加入不提交的changelist 1、修改一个版本控制文件和新增一个不提交文件…
阅读更多...
5G入海, 智慧海洋从此“联通”！

5G入海, 智慧海洋从此“联通”！

湛江&#xff0c;位于中国大陆的最南端&#xff0c;是一座向海而生的城市。近年来&#xff0c;中国联通在湛江打造智慧渔船管理平台&#xff0c;通过专用系统监控平台、岸基子系统、船载子系统三大平台实现九大核心功能&#xff0c;守卫1200多公里的大陆海岸线&#xff0c;赋能…
阅读更多...
SpringMVC 请求与响应

SpringMVC 请求与响应

一、请求映射路径 1.1、环境准备 创建一个Web的Maven项目并在pom文件中添加依赖 <?xml version"1.0" encoding"UTF-8"?><project xmlns"http://maven.apache.org/POM/4.0.0" xmlns:xsi"http://www.w3.org/2001/XMLSchema-ins…
阅读更多...
pwnable_orw-seccomp沙箱

pwnable_orw-seccomp沙箱

1&#xff0c;三连 2&#xff0c;IDA静态分析 知识点引入&#xff1a; seccomp 是 secure computing 的缩写&#xff0c;其是 Linux kernel 从2.6.23版本引入的一种简洁的 sandboxing 机制。在 Linux 系统里&#xff0c;大量的系统调用&#xff08;system call&#xff09;直…
阅读更多...
基于springboot+mybatis的图书购物网站

基于springboot+mybatis的图书购物网站

目录一. &#x1f981; 前言1.1 研究目的和意义1.2 所做的主要工作二. &#x1f981; 技术介绍2.1 B/S结构2.2 MySQL 介绍2.3 Java介绍2.4 Spring boot 框架及特点2.5 Mybatis框架特点三. &#x1f981; 系统功能结构1.1 用户管理功能1.2 管理员管理功能四. &#x1f981; 系统…
阅读更多...
ppt文件太大怎么压缩变小，4个方法快速学

ppt文件太大怎么压缩变小，4个方法快速学

ppt文件太大怎么压缩变小&#xff1f;现在都流行线上教学&#xff0c;很多教学的课件都是使用PPT 进行的。但是这些PPT体积往往都非常的大&#xff0c;如果是那种使用时间较长的电脑光是打开这类PPT就非常卡顿了。有的甚至就无法打开这些PPT&#xff0c;或者说打开这些ppt文件但…
阅读更多...
智慧工地火焰烟火识别检测系统 opencv

智慧工地火焰烟火识别检测系统 opencv

智慧工地火焰烟火识别检测系统通过pythonopencv网络模型算法分析技术&#xff0c;智慧工地火焰烟火识别检测算法模型实现对现场画面中火焰烟雾进行7*24小时不间断识别&#xff0c;实时分析自动报警Python是一种由Guido van Rossum开发的通用编程语言&#xff0c;它很快就变得非…
阅读更多...
【ChatGPT】中国支付清算协会倡议支付行业从业人员谨慎使用ChatGPT

【ChatGPT】中国支付清算协会倡议支付行业从业人员谨慎使用ChatGPT

ChatGPT1. 近期热议2. ChatGPT是什么3. ChatGPT要谨慎使用4. 如何规范使用1. 近期热议 近期&#xff0c;ChatGPT等工具引起各方广泛关注&#xff0c;已有部分企业员工使用ChatGPT等工具开展工作。但是&#xff0c;此类智能化工具已暴露出跨境数据泄露等风险。为有效应对风险、…
阅读更多...
物业企业如何加快向现代服务业转型

物业企业如何加快向现代服务业转型

近年来&#xff0c;随着人民生活水平的提高&#xff0c;人们对住宅质量提出更高的要求&#xff0c;在此前提下&#xff0c;全国各地涌现出了一些运用现代的计算机、控制与通信技术建设的智能化住宅小区。但是许多智能化住宅小区都存在建好了智能硬件环境却没有智能化的软件在上…
阅读更多...
基于html+css的图片展示14

基于html+css的图片展示14

准备项目 项目开发工具 Visual Studio Code 1.44.2 版本: 1.44.2 提交: ff915844119ce9485abfe8aa9076ec76b5300ddd 日期: 2020-04-16T16:36:23.138Z Electron: 7.1.11 Chrome: 78.0.3904.130 Node.js: 12.8.1 V8: 7.8.279.23-electron.0 OS: Windows_NT x64 10.0.19044 项目…
阅读更多...
推荐文章
最新文章

Copyright @ 2022~2023