传感器模块编程实践(三)舵机+超声波模块融合DIY智能垃圾桶模型

已于 2024-10-05 21:25:04 修改
阅读量914 收藏 13
点赞数 25
文章标签： 单片机 stm32 嵌入式硬件 mcu
于 2024-10-05 21:22:05 首次发布
版权声明：本文为博主原创文章，遵循 CC 4.0 BY-SA 版权协议，转载请附上原文出处链接和本声明。
本文链接：https://blog.csdn.net/zy2232652/article/details/142716280
版权

文章目录

一.概要

随着科技的飞速发展和环保意识的日益增强，智能垃圾桶成为了城市生活的新宠，智能垃圾桶人们无需接触垃圾桶的任何部位即可投放垃圾,防止交叉感染,环保卫生,外形雅观。

在这里插入图片描述

本文就做了一个简单的智能感应垃圾桶套件模型，采用STM32F103C8T6单片机+舵机+超声波模块，实现有物体靠近，垃圾桶自动开启，没有物体靠近，一定时间后自动合上。

在这里插入图片描述

二.实验模型原理

1.硬件连接原理框图

在这里插入图片描述

模型主要分为三部分:主芯片单元，测距感应单元，执行动作单元。

在这里插入图片描述

图中主控芯片为STM32F103C8T6单片机，测距传感器为超声波模块，执行传感器为SG90舵机。

信号线连接:HC-SR04超声波模块信号脚ECHO脚接到单片机的PA0脚，TRIG脚接到单片机的PA1脚。SG90(180度)舵机的信号脚橙色线接到单片机的PA6脚。

2.控制原理

超声波模块根据声音的反射原理，对前方的障碍物进行测距。如果没有障碍物，或者障碍物距离>=5CM，单片机驱动舵机转到0度，如果检测到障碍物距离小于5CM，单片机驱动舵机旋转到180度，打开垃圾桶盖子。

超声波测距原理：

在这里插入图片描述

以上时序图表明单片机只需要提供一个10uS以上脉冲触发信号给模块的TRIG引脚，超声波模块内部将发出8个40kHz周期电平并检测回波。模块一旦检测到有回波信号则输出回响信号到模块ECHO引脚。回响信号的脉冲宽度与所测的距离成正比。单片机通过采集收到的输出回响信号的宽度时间就可以计算得到距离。

距离公式：距离=回响高电平时间*声速（340M/S）/2

舵机控制原理：
SG90舵机，首先，控制引脚是三根线，分别是GND(棕色)、VCC(红色)、PWM(黄色)，控制方式也是一样的PWM时序，具体的方法如下：

（1）采用PWM控制的方式来进行舵机的旋转
（2）舵机的控制需要MCU产生一个20ms周期的脉冲信号，以0.5ms到2.5ms的高电平来控制舵机的角度。
（3）高电平时间跟舵机旋转的角度对应关系:
0.5ms-------------0度；对应函数中占空比为2.5%
1.0ms------------45度；对应函数中占空比为5.0%
1.5ms------------90度；对应函数中占空比为7.5%
2.0ms-----------135度；对应函数中占空比为10.0%
2.5ms-----------180度；对应函数中占空比为12.5%

三.实验模型控制流程

1.单片机先通过PA0脚驱动超声波模块ECHO信号进行测距，超声波模块根据声音的反射原理，对前方的障碍物进行测距。如果没有障碍物，或者障碍物距离>=10CM，单片机不驱动舵机进行动作。

2.单片机一直通过PA0脚驱动超声波模块ECHO信号进行测距，如果障碍物距离<10CM，单片机通过PA6引脚输出20ms周期的PWM波。PWM波高电平脉冲时间为2.5ms,这样舵机就会旋转180度，从而带动垃圾桶的盖打开，如果障碍物距离一直小于10CM，垃圾桶保持打开状态不变。

3.单片机一直通过PA0脚驱动超声波模块ECHO信号进行测距，如果障碍物距离>=10CM，单片机通过PA6引脚输出20ms周期。PWM波高电平脉冲时间为0.5ms,这样舵机就回到0度，从而带动垃圾桶的盖闭合。

四.智能感应垃圾桶模型程序

板子与超声波模块用杜邦线连接：
板子G-----模块GND
板子3.3---模块VCC
板子A0----模块Trig
板子A1----模块Echo

板子与SG90舵机(180度舵机)用杜邦线连接：
板子5V----红色线
板子A6----橙色线
板子G-----棕色线

USB线需要接小系统板，给板子供5V。

在这里插入图片描述

打开STM32CubeMX软件,新建工程
在这里插入图片描述
Part Number处输入STM32F103C8，再双击就创建新的工程
在这里插入图片描述
配置下载口引脚
在这里插入图片描述
配置外部晶振引脚
在这里插入图片描述
配置系统主频
在这里插入图片描述
配置PA0为输出，PA1为输入，PA1管脚选择下拉
在这里插入图片描述

配置定时器2，10us产生中断一次，用来统计后续采集超声波返回的脉冲宽度时间
在这里插入图片描述
在这里插入图片描述

配置PWM输出，定时器3通道1，周期20ms
在这里插入图片描述

配置工程文件名，保存路径，KEIL5工程输出方式
在这里插入图片描述
生成工程
在这里插入图片描述
用Keil5打开工程
在这里插入图片描述

添加代码

在这里插入图片描述
在这里插入图片描述

在这里插入图片描述

主要程序：

uint32_t Distance_Calculate(uint32_t count)//传入时间单位10us
{
    uint32_t Distance = 0;
    Distance = (uint32_t)(((float)count *17)/100);//距离单位cm,声速340M/S，时间*速度/2=距离
    return Distance;
}
//等待us级别
void Delay_us(unsigned long i)
{
	unsigned long j;
	for(;i>0;i--)
	{
			for(j=8;j>0;j--);
	}
}
uint32_t Distance;//距离
uint32_t HalTime1,HalTime2;//时间临时变量
extern volatile uint32_t TimeCounter;//时间计数，单位10us

/* USER CODE END PFP */

/* Private user code ---------------------------------------------------------*/
/* USER CODE BEGIN 0 */
uint16_t Pluse_Time=500,Old_Pluse_Time,DistanceTimeCounter,DistanceCounter;//1毫秒脉冲，单位是us
/* USER CODE END 0 */

/**
  * @brief  The application entry point.
  * @retval int
  */
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_TIM3_Init();
  MX_TIM2_Init();
  /* USER CODE BEGIN 2 */
	if (HAL_TIM_Base_Start_IT(&htim2) != HAL_OK)//启动定时器2，10us进入中断一次
 {
	 while(1);
 }
   if (HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1) != HAL_OK)//PA6脚PWM输出
  {
    /* PWM generation Error */
    while(1);
  }
	HAL_Delay(200);//等待200ms
	//以180度角度伺服为例，那么对应的控制关系是这样的（t为高电平时间）：
	//t=0.5ms（占空比2.5%）---------0°；
	//t=1.0ms（占空比5%）-----------45°；
	//t=1.5ms（占空比7.5%）---------90°；
	//t=2.0ms（占空比10%）---------135°；
	//t=2.5ms（占空比12.5%）-------180°；
	Pluse_Time=500;//0.5ms高电平脉冲，用于控制舵机转到0度
	HAL_TIM_PWM_Stop(&htim3, TIM_CHANNEL_1);//PWM停止输出
	HAL_Delay(100);//等待100ms
	MX_TIM3_Init();//重新初始化配置PWM波
	if (HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1) != HAL_OK)//PA6脚PWM输出
	{
	/* PWM generation Error */
	while(1);
	}
	HAL_Delay(200);//等待200ms
	HAL_TIM_PWM_Stop(&htim3, TIM_CHANNEL_1);//PWM停止输出	
  /* USER CODE END 2 */

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

    /* USER CODE BEGIN 3 */
		HAL_GPIO_WritePin(GPIOA, GPIO_PIN_0,GPIO_PIN_RESET);//预先拉低Trig引脚
		HAL_Delay(5);
		HAL_GPIO_WritePin(GPIOA, GPIO_PIN_0,GPIO_PIN_SET);//拉高Trig引脚
		Delay_us(40);
		HAL_GPIO_WritePin(GPIOA, GPIO_PIN_0,GPIO_PIN_RESET);//拉低Trig引脚
		Delay_us(20);
		while(HAL_GPIO_ReadPin(GPIOA, GPIO_PIN_1) == 0);//如果是低电平，一直等
		HalTime1= TimeCounter;
		while(HAL_GPIO_ReadPin(GPIOA, GPIO_PIN_1) == 1);//如果是高电平，一直等
		if(TimeCounter>HalTime1)
		{
			HalTime2 = TimeCounter-HalTime1;
			if(HalTime2<0x300)
			{
					 Distance = Distance_Calculate(HalTime2);//计算距离
			}else
			{
				   Distance=100;
			}
		}
		HAL_Delay(100);
		DistanceTimeCounter++;
		if(DistanceTimeCounter>2)//连续监测2次
		{
			DistanceTimeCounter=0;
			
		}else
		{
			if(Distance<=10 && Distance>0)
			{
				DistanceCounter++;
			}
			
			continue;//没到3次，不动作，防止超声波抖动
		}
		
		
		
		if(DistanceCounter>=2)//距离小于10CM，说明有手挡住
		{
			DistanceCounter=0;
  		Pluse_Time=2500;
			HAL_TIM_PWM_Stop(&htim3, TIM_CHANNEL_1);//PWM停止输出
			MX_TIM3_Init();//重新初始化配置PWM波
			if (HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1) != HAL_OK)//PA6脚PWM输出
			{
			while(1);
			}
			HAL_Delay(50);
			HAL_TIM_PWM_Stop(&htim3, TIM_CHANNEL_1);//PWM停止输出
					
		}else
		{
			DistanceCounter=0;
			  Pluse_Time=500;//0.5ms高电平脉冲，用于控制舵机转到0度
				if(Old_Pluse_Time!=Pluse_Time)
				{
					for(int i=0;i<2;i++)
					{
						HAL_TIM_PWM_Stop(&htim3, TIM_CHANNEL_1);//PWM停止输出
						MX_TIM3_Init();//重新初始化配置PWM波
						if (HAL_TIM_PWM_Start(&htim3, TIM_CHANNEL_1) != HAL_OK)//PA6脚PWM输出
						{
						/* PWM generation Error */
						while(1);
						}
						HAL_Delay(300);//等待300ms
						HAL_TIM_PWM_Stop(&htim3, TIM_CHANNEL_1);//PWM停止输出
					}		
				}			

		}
		
		Old_Pluse_Time=Pluse_Time;


  }
  /* USER CODE END 3 */
}
/* TIM3 init function */
void MX_TIM3_Init(void)
{
  TIM_MasterConfigTypeDef sMasterConfig = {0};
  TIM_OC_InitTypeDef sConfigOC = {0};

  htim3.Instance = TIM3;
  htim3.Init.Prescaler = 71;
  htim3.Init.CounterMode = TIM_COUNTERMODE_UP;
  htim3.Init.Period = 19999;
  htim3.Init.ClockDivision = TIM_CLOCKDIVISION_DIV1;
  htim3.Init.AutoReloadPreload = TIM_AUTORELOAD_PRELOAD_DISABLE;
  if (HAL_TIM_PWM_Init(&htim3) != HAL_OK)
  {
    Error_Handler();
  }
  sMasterConfig.MasterOutputTrigger = TIM_TRGO_RESET;
  sMasterConfig.MasterSlaveMode = TIM_MASTERSLAVEMODE_DISABLE;
  if (HAL_TIMEx_MasterConfigSynchronization(&htim3, &sMasterConfig) != HAL_OK)
  {
    Error_Handler();
  }
  sConfigOC.OCMode = TIM_OCMODE_PWM1;
  sConfigOC.Pulse = Pluse_Time;//通过引入变量，方便调整占空比，高电平时间，单位us
  sConfigOC.OCPolarity = TIM_OCPOLARITY_HIGH;
  sConfigOC.OCFastMode = TIM_OCFAST_DISABLE;
  if (HAL_TIM_PWM_ConfigChannel(&htim3, &sConfigOC, TIM_CHANNEL_1) != HAL_OK)
  {
    Error_Handler();
  }
  HAL_TIM_MspPostInit(&htim3);

}

五.实验效果视频

STM32F103单片机+舵机+超声波模块智能垃圾桶模型效果

六.小结

融合了舵机，超声波模块的控制，对STM32的单片机的定时器PWM功能，定时器功能有更深的了解。

光子物联单片机
关注
20.[STM32]利用超声波模块和舵机实现智能垃圾桶功能
依点_DW的博客
06-27 1817
本文详细介绍了如何把超声波模块、舵机、oled三个模块整合在一起实现智能垃圾桶的功能，文章通俗易懂。
STM32驱动SG90舵机与HC_SR04超声波模块
weixin_37704787的博客
07-05 5127
本项实验的硬件组成有STM32F103C8T6开发板、USB转TTL串口模块（CH340）、超声波模块（HC-SR04）、舵机模块（SG90 180度），设计到的软件模块有GPIO和AFIO、USART通信、通用定时器TIM2、中断、系统定时器SysTick。...............
Arduino+舵机+超声波传感器实现自动感应洗手液（代码）
weixin_47831343的博客
10-22 4981
1.利用超声波传感器实现感应功能，并可以通过Arduino的串口监视器读取距离参数； 2.利用舵机模块实现按压，以喷出消毒洗手液； 3.利用贴片式LED实现感应灯光，变绿色时感应到手，进行消毒 实现代码： #include <Servo.h> // 声明调用Servo.h库 Servo myservo; //创建一个舵机类，命名为myservo #define SERVO_PIN 10 //宏
智能垃圾桶（超声波测距，SG90舵机，Wemos D1）
qq_52621551的博客
08-12 2436
实物图： 实物图： WemosD1 特性 1. 基于ESP-8266EX 2. Arduino兼容，使用rduino IDE来编程 3. 11 x I/O 引脚 4. 1 x ADC 引脚（输入范围0-3.3V） 5. 板载5V 1A开关电源（高输入电压24V） 工作中： 和stm32模块开发类似，集成度高 STM32方案也更经济便宜 超声波模块 ...
STM32F103RCT6 实验代码之舵机+超声波避障小车（二）舵机+超声波
热门推荐
ljw__的博客
04-19 1万+
舵机+超声波简介一.SG90舵机二.超声波数据处理 补充一下上一篇博客遗漏掉的一个问题，一般电机的PWM都是有一些频率限制的，而我的直流电机是10Khz来进行驱动的。 一.SG90舵机 这个是我买的舵机+超声波模块，这个舵机是SG90模拟舵机，网上有很多的资料 模拟电机与数字电机的区别 SG90的驱动是靠不同占空比的50hz的PWM波来控制 0度——>2.5% 45度——>5% 90...
使用舵机和超声波模块实现小车自动避障
weixin_46251230的博客
08-15 7570
1.要实现舵机摇头就是依次从0°摇到90°，然后再摇到180°，反复循环，因为舵机是用PWM控制的，在垃圾桶项目中已经使用过舵机，可以直接拿代码过来用，最好进行代码的封装，在工程中引入该舵机的源文件。在测距避障过程中，如果使用的是普通转弯函数，就是一个轮子转另一个轮子不转，这样找到出口的速度会慢点，有时候会在一个地方反复摇头测试，将左转或右转的函数修改一下，让小车在原地旋转，提高找到出口的速度。用热熔胶把舵机固定在小车车头，然后把超声波模块接好线后，绑定在舵机上，可自己想办法固定，舵机转动角度对即可。...
stm32cubeMX智能小车舵机模块
wuyiyu_的博客
04-30 2118
实验小车：STM32F103C8T6。舵机模块：SG90。所需软件：keil5 ， cubeMX。实验目的：学习如何使用舵机模块。​ SG90 舵机通常也称为伺服马达。舵机是一种能够控制角度的电机，通过给定的控制信号，可以使舵机转到特定的角度位置，并且能够保持该位置稳定。舵机通常用于控制机械臂、模型车、航模以及其他需要精确控制角度位置的应用中。引脚介绍：​ SG90舵机上有三根线，分别是GND（棕色线）、VCC（红色线）和SIG（黄色线）也就是信号线。下篇文章为大家介绍智能小车循迹。
STM32开发——感应垃圾桶（舵机、超声波测距、振动检测）
m0_67794575的博客
06-08 1914
PWM波的频率不能太高，大约50HZ，即周期=1/频率=1/50=0.02s，20ms左右。确定 定时时间=1/频率其中：Tclk：定时器的输入时钟频率（单位MHZ）Tout：定时器溢出时间（单位为us）eg；4999eg：7199如果周期为20ms，则 PSC=7199，ARR=199角度控制0.5ms-------------0度；2.5% 对应函数中CCRx为51.0ms------------45度；5.0% 对应函数中CCRx为10。
stm32学习记录——舵机与超声波测距的感应垃圾桶（附工程码）
sujiaxin12的博客
04-19 1404
首先是超声波测距的代码，原理就是定时器产生PWM波控制舵机旋转到指定角度。 void HC_SR04Gpio1Init(void) { GPIO_InitTypeDef GPIO_InitStructure; RCC_APB2PeriphClockCmd( RCC_APB2Periph_GPIOA|RCC_APB2Periph_GPIOB, ENABLE); GPIO_InitStructure.GPIO_Pin=GPIO_Pin_0; //ECHO GPIO_InitStructure....
基于arduino的智能城市课设模块5——智能垃圾桶
qq_64625180的博客
07-13 606
智能城市项目共分为五个部分，即交通信号灯系统、火灾报警系统、环境监测系统、路灯控制系统和智能垃圾桶。在下打算用六篇文章来发布，分别对应这五个系统和最后的总结。在文章后面附上模块代码都可以单独编译上传，便于大家使用。本文章介绍第五个模块——智能垃圾桶。智能垃圾桶使用了一个舵机、两个超声波传感器、一个红色提示灯。第一个超声波传感器放在垃圾桶外部用来检测人与垃圾桶的距离，当人靠近垃圾桶时，舵机转动打开垃圾桶。
基于STM32单片机+LD2330语音识别模块智能垃圾桶设计资料（包含原理图PCB及源程序）.rar
12-17
该资料包提供了一个基于STM32单片机和LD2330语音识别模块的智能垃圾桶设计方案。STM32是一款广泛应用的微控制器，由意法半导体（STMicroelectronics）生产，以其高性能、低功耗和丰富的外设接口而受到工程师们的青睐...
RFID模块+WIFI模块+振动传感器+有源蜂鸣器+舵机+Arduino UNO R3所构成的门禁系统模块所用APP
04-28
RFID模块+WIFI模块+振动传感器+有源蜂鸣器+舵机+Arduino UNO R3所构成的门禁系统模块所用APP
超声波传感器判断距离操作舵机（智能垃圾桶原理）
09-02
超声波传感器判断距离操作舵机（智能垃圾桶原理）
27 基于51单片机的方向盘模拟系统
2401_87347788的博客
10-05 487
基于STC89C52单片机，采用两个MPX4115压力传感器作为两路压力到位开关电路， 采用滑动变阻器连接数模转换器模拟重力加速度传感器电路； 一个按键控制LED灯的点亮与熄灭；两路压力值与加速度值通过LCD1602显示屏显示； 如果加速度的值3秒内没没有变化，或者两个压力传感器的差值大于50 (这里设置差值小于50表示双手同时抓住方向盘的到位开关了，如果大于50，则不是同时抓住， 因为仿真里没法同时按两个东西，所以采取差值替代。) 则蜂鸣器报价，且继电器断开，继电器控制的电机停止转动。 反之，不报警，继电
stm32定时器中断和外部中断
最新发布
bai_lan_ya的博客
10-05 841
在stm32中，用来统一分配中断优先级和管理中断的EXTI可以监测指定GPIO口的电平信号，当其指定的GPIO口产生电平变化时，EXTI将立即向NVIC发出中断申请，经过NVIC裁决后即可中断CPU主程序，使CPU执行EXTI对应的中断程序支持的触发方式：上升沿/下降沿/双边沿/软件触发支持的GPIO口：所有GPIO口，但相同的Pin不能同时触发中断（即不能PA1和PB1组合）通道数：16个GPIO_Pin，外加PVD输出、RTC闹钟、USB唤醒、以太网唤醒触发响应方式：中断响应/事件响应。
STM32
2301_80339607的博客
09-27 972
四个主动单元：DCode(数据总线)、DMA1、DMA2、系统总线四个被动单元：SRAM、Flash、FSMC（存储控制器）、AHB到APB的桥。
单片机裸机之实现任务调度+软timer（含源码）
qq_35141454的博客
09-28 538
单片机裸机实现任务调用和定时器
【STM32单片机_(HAL库)】4-2-1【定时器TIM】定时器输出PWM实现呼吸灯实验
labvvv的博客
10-01 443
定时器输出PWM波实现呼吸灯实验
评论
添加红包

请填写红包祝福语或标题

个

红包个数最小为10个

元

红包金额最低5元

当前余额3.43元 前往充值 >
需支付：10.00元
成就一亿技术人!
领取后你会自动成为博主和红包主的粉丝 规则
hope_wisdom
发出的红包
实付元
使用余额支付
点击重新获取
扫码支付
钱包余额 0

抵扣说明：

1.余额是钱包充值的虚拟货币，按照1:1的比例进行支付金额的抵扣。
2.余额无法直接购买下载，可以购买VIP、付费专栏及课程。

余额充值