2.4 红外测距传感器
GP2Y0A02YKOF是夏普的一款距离测量传感器模块。它由PSD(position sensitive detector)和IRED(infrared emitting diode)以及信号处理电路三部分组成。由于采用了三角测量方法,被测物体的材质、环境温度以及测量时间都不会影响传感器的测量精度。传感器输出电压值对应探测的距离。通过测量电压值就可以得出所探测物体的距离,所以这款传感器可以用于距离测量、避障等场合。
2.4.1 模块来源
采购链接:
GP2Y0A02YK0F 红外激光测距传感器 避障测距20-150cm
资料下载链接:
https://pan.baidu.com/s/11dDQHyYJfi0nNyC28vkpoA
资料提取码:qvpm
2.4.2 规格参数
工作电压:3.3-5V
工作电流:33MA
模块尺寸:37 x 21.6mm
输出方式: 模拟量输出
读取方式:ADC
管脚数量:3 Pin
工作电流:33MA
模块尺寸:37 x 21.6mm
输出方式: 模拟量输出
读取方式:ADC
管脚数量:3 Pin
2.4.3 移植过程
我们的目标是在梁山派GD32F470上能够判断前方障碍物的功能。首先要获取资料,查看数据手册应如何实现,再移植至我们的工程。
2.4.3.1 查看资料
红外测距传感器的输出是非线性的。每个型号的输出曲线都不同。所以,在实际使用前,最好能对所使用的传感器进行一下校正。对每个型号的传感器创建一张曲线图,以便在实际使用中获得真实有效的测量数据。下图是测距距离为20-150CM型号的输出曲线图。
从上图中,可以看到,当被探测物体的距离小于大约 15cm 的时候,输出电压急剧下降,也就是说从电压读数
来看,物体的距离应该是越来越远了。但是实际上并不是这样的,想象一下,你的机器人本来正在慢慢的
靠近障碍物,突然发现障碍物消失了,一般来说,你的控制程序会让你的机器人以全速移动,结果就是,"
砰"的一声。当然了,解决这个方法也不是没有,这里有个小技巧。只需要改变一下传感器的安装位置,使
它到机器人的外围的距离大于最小探测距离就可以了。
红外测距传感器的输出数据线是通过电压的变化来确定距离,我们可以使用ADC功能获取传感器的电压变化,将其转换为实际距离即可。电压距离转换公式见官方代码库链接:https://github.com/zoubworldArduino/ZSharpIR
找到我们20-150CM型号的传感器,在下方有换算公式。
2.4.3.2 引脚选择
想要使用ADC,需要确定使用的引脚是否有ADC外设功能。可以通过数据手册【GD32F450xx_Datasheet_Rev2.2.pdf】进行查看。文件下载见文件2.4.3.2-1 数据手册(GD32F450与GD32F470在功能与寄存器地址上没有区分)(梁山派开发板资料可在官网获取www.lckfb.com)
在数据手册的第28页结尾,是关于GD32F450Zx系列芯片引脚的功能定义示意图。
当前只有AO引脚需要使用到ADC接口,所以DO引脚可以使用开发板上其他的GPIO。这里选择使用PC2的附加ADC功能。使用ADC0的第12道输入通道。
红外测距 | 立创·梁山派 |
---|---|
VCC | 5V |
GND | GND |
DATA | PC2 |
2.4.3.3 移植至工程
移植步骤中的导入.c和.h文件与上一节相同,只是将.c和.h文件更改为bsp_IRdistance.c与bsp_IRdistance.h。见2.2.3.3 移植至工程。这里不再过多讲述。移植完成后面修改相关代码。
在文件bsp_IRdistance.c中,编写如下代码。
/********************************************************************************* 文 件 名: bsp_IRdistance.c* 版 本 号: 初版* 修改作者: LC* 修改日期: 2023年04月06日* 功能介绍: ******************************************************************************* 注意事项:
*********************************************************************************/
#include "bsp_IRdistance.h"
#include "systick.h"
#include "stdio.h"
#include "math.h"//DMA缓冲区
uint16_t gt_adc_val[ SAMPLES ][ CHANNEL_NUM ]; /******************************************************************* 函 数 名 称:ADC_DMA_Init* 函 数 说 明:初始化ADC+DMA功能* 函 数 形 参:无* 函 数 返 回:无* 作 者:LC* 备 注:无
******************************************************************/
void ADC_DMA_Init(void)
{/* DMA初始化功能结构体定义 */dma_single_data_parameter_struct dma_single_data_parameter;/* 使能引脚时钟 */rcu_periph_clock_enable(RCU_IRDISTANCE_GPIO); /* 使能ADC时钟 */rcu_periph_clock_enable(RCU_IRDISTANCE_ADC); /* 使能DMA时钟 */rcu_periph_clock_enable(RCU_IRDISTANCE_DMA);/* 配置ADC时钟 */ adc_clock_config(ADC_ADCCK_PCLK2_DIV4); /* 配置PC2为浮空模拟输入模式 */gpio_mode_set(PORT_IRDISTANCE, GPIO_MODE_ANALOG, GPIO_PUPD_NONE, GPIO_IRDISTANCE); // PC2 : ADC012_IN12 /* 配置ADC为独立模式 */adc_sync_mode_config(ADC_SYNC_MODE_INDEPENDENT);/* 使能连续转换模式 */adc_special_function_config(PORT_ADC, ADC_CONTINUOUS_MODE, ENABLE);/* 使能扫描模式 */adc_special_function_config(PORT_ADC, ADC_SCAN_MODE, ENABLE);/* 数据右对齐 */ adc_data_alignment_config(PORT_ADC, ADC_DATAALIGN_RIGHT);/* ADC0设置为规则组 一共使用 CHANNEL_NUM 个通道 */ adc_channel_length_config(PORT_ADC, ADC_REGULAR_CHANNEL, CHANNEL_NUM);/* ADC规则通道配置:ADC0的通道11的扫描顺序为0;采样时间:15个周期 */ /* DMA开启之后 gt_adc_val[x][0] = PC1的数据 */adc_regular_channel_config(PORT_ADC, 0, CHANNEL_ADC, ADC_SAMPLETIME_15);//PC2/* ADC0设置为12位分辨率 */ adc_resolution_config(PORT_ADC, ADC_RESOLUTION_12B); /* ADC外部触发禁用, 即只能使用软件触发 */ adc_external_trigger_config(PORT_ADC, ADC_REGULAR_CHANNEL, EXTERNAL_TRIGGER_DISABLE);/* 使能规则组通道每转换完成一个就发送一次DMA请求 */ adc_dma_request_after_last_enable(PORT_ADC); /* 使能DMA请求 */ adc_dma_mode_enable(PORT_ADC);/* 使能DMA */ adc_enable(PORT_ADC);/* 等待ADC稳定 */ delay_1ms(1);/* 开启ADC自校准 */adc_calibration_enable(PORT_ADC); /* 清除 DMA通道0 之前配置 */dma_deinit(PORT_DMA, CHANNEL_DMA);/* DMA初始化配置 */dma_single_data_parameter.periph_addr = (uint32_t)(&ADC_RDATA(PORT_ADC)); //设置DMA传输的外设地址为ADC0基地址dma_single_data_parameter.periph_inc = DMA_PERIPH_INCREASE_DISABLE; //关闭外设地址自增dma_single_data_parameter.memory0_addr = (uint32_t)(gt_adc_val); //设置DMA传输的内存地址为 gt_adc_val数组dma_single_data_parameter.memory_inc = DMA_MEMORY_INCREASE_ENABLE; //开启内存地址自增(因为不止一个通道)dma_single_data_parameter.periph_memory_width = DMA_PERIPH_WIDTH_16BIT; //传输的数据位 为 16位dma_single_data_parameter.direction = DMA_PERIPH_TO_MEMORY; //DMA传输方向为 外设往内存dma_single_data_parameter.number = SAMPLES * CHANNEL_NUM; //传输的数据长度为:每个通道采集30次 * 1个通道dma_single_data_parameter.priority = DMA_PRIORITY_HIGH; //设置高优先级dma_single_data_mode_init(PORT_DMA, CHANNEL_DMA, &dma_single_data_parameter);//将配置保存至DMA1的通道0/* DMA通道外设选择 *//* 数据手册的195页根据PERIEN[2:0]值确定第三个参数,例是100 则为DMA_SUBPERI4 例是010 则为DMA_SUBPERI2 *//* 我们是ADC0功能,PERIEN[2:0]值为000,故为DMA_SUBPERI0 */dma_channel_subperipheral_select(PORT_DMA, CHANNEL_DMA, DMA_SUBPERI0);/* 使能DMA1通道0循环模式 */dma_circulation_enable(PORT_DMA, CHANNEL_DMA);/* 启动DMA1的通道0功能 */dma_channel_enable(PORT_DMA, CHANNEL_DMA); /* 开启软件触发ADC转换 */adc_software_trigger_enable(PORT_ADC, ADC_REGULAR_CHANNEL);
}/******************************************************************* 函 数 名 称:Get_Adc_Dma_Value* 函 数 说 明:对DMA保存的数据进行平均值计算后输出电压值* 函 数 形 参:CHx 第几个扫描的数据* 函 数 返 回:对应扫描的电压值* 作 者:LC* 备 注:返回值最低0 最高4095
******************************************************************/
float Get_Adc_Dma_Value(char CHx)
{ unsigned char i = 0;unsigned int AdcValue = 0;double ret = 0;/* 因为采集 SAMPLES 次,故循环 SAMPLES 次 */for(i=0; i< SAMPLES; i++){/* 累加 */AdcValue += gt_adc_val[i][CHx];}/* 求平均值 */ret = (double)AdcValue / SAMPLES;//手动减去电压误差 0.64ret = (((double)ret / 4095) * 3.3);return ret;
}/******************************************************************* 函 数 名 称:Get_illume_Percentage_value* 函 数 说 明:计算红外测距的测量距离 * 函 数 形 参:无* 函 数 返 回:返回测量距离* 作 者:LC* 备 注:无
******************************************************************/
double Get_IRdistance_Distance(void)
{double adc_new = 0;double Distance = 0;adc_new = Get_Adc_Dma_Value(0);// 根据官方代码库链接:https://github.com/zoubworldArduino/ZSharpIR
// 得到距离换算公式:
// 【GP2Y0A02YK0F:Using MS Excel, we can calculate function (For distance > 15cm) :
// Distance = 60.374 X POW(Volt , -1.16)】Distance = 60.374 * pow(adc_new,-1.16);return Distance;
}
在文件bsp_encoder.h中,编写如下代码。
#ifndef _BSP_IRDISTANCE_H_
#define _BSP_IRDISTANCE_H_#include "gd32f4xx.h"#define RCU_IRDISTANCE_GPIO RCU_GPIOC
#define RCU_IRDISTANCE_ADC RCU_ADC0
#define RCU_IRDISTANCE_DMA RCU_DMA1#define PORT_DMA DMA1
#define CHANNEL_DMA DMA_CH0#define PORT_ADC ADC0
#define CHANNEL_ADC ADC_CHANNEL_12#define PORT_IRDISTANCE GPIOC
#define GPIO_IRDISTANCE GPIO_PIN_2//采样次数
#define SAMPLES 100
//采样通道数
#define CHANNEL_NUM 1extern uint16_t gt_adc_val[ SAMPLES ][ CHANNEL_NUM ]; //DMA缓冲区void ADC_DMA_Init(void);
float Get_Adc_Dma_Value(char CHx);
double Get_IRdistance_Distance(void);#endif
2.4.4 移植验证
在自己工程中的main主函数中,编写如下。
/********************************************************************************* 文 件 名: main.c* 版 本 号: 初版* 修改作者: LC* 修改日期: 2023年04月06日* 功能介绍: ******************************************************************************* 注意事项:
*********************************************************************************/#include "gd32f4xx.h"
#include "systick.h"
#include "bsp_usart.h"
#include "stdio.h"
#include "bsp_irdistance.h"int main(void)
{nvic_priority_group_set(NVIC_PRIGROUP_PRE2_SUB2); // 优先级分组systick_config(); //滴答定时器初始化 1msusart_gpio_config(115200U);ADC_DMA_Init();printf("ADC+DMA demo start\r\n");while(1){printf("Distance = %.2f\r\n", Get_IRdistance_Distance() );delay_1ms(1000);}
}
移植现象:输出ADC值和换算后的实际距离。
移植成功示例,见文件2.4.4-1 。
文件2.4.4-1