我与SLAM激光雷达的CEO有联系方式,他人很好哦!!!
你可以通过给我的Github项目点赞来获取一些帮助
Github项目地址
思岚激光雷达M8A1使用STM32F407来做初步的数据观测。
注:由于激光雷达发送数据量十分之大,因此使用串口来做测距与测角度得到的与当前值的偏差较大,因此本文只是初步介绍。
若需要解算出精确数据则需要使用DMA,我将在之后的文章使用DMA来解算数据,敬请期待!
文章包含:
1>使用串口发送数据来启动激光雷达旋转.
2>再串口打印出具体的十六进制距离和角度数据
通过本文初步了解激光雷达如何使用STM32来做到测距测角度。
1>配置串口
2>配置PWM
3>串口发送数据给激光雷达
4>配置占空比来使激光雷达旋转
途中已经表示出激光雷达的串口协议。我们只需按照要求配置串口即可。
激光雷达在只为了测算距离和角度时不需要配置双串口,但由于本文目的是为了让大家能在串口处看到激光雷达返回的数据,因此需要第二个串口来打印出返回数据。
UART串行通信是按照一个字节一个字节传输的,每个字节之间至少有一个停止位,对于Standard模式下的数据流,每5个字节构成一组 描述一个激光点,每一组数据之间会有微弱的时间间隔。
注:本文使用串口1与串口6,也可使用其他串口.以及我是用的是CH340串口工具,接线在接下来提出。
1> 串口1的配置
#include "sys.h"
#include "usart.h"
#include "led.h"
#include "delay.h"
#if SYSTEM_SUPPORT_UCOS //时钟配置
#include "includes.h" //ucos 使用
#endif
#if 1
#pragma import(__use_no_semihosting)
//标准库需要的支持函数
struct __FILE
{
int handle;
};
FILE __stdout;
//定义_sys_exit()以避免使用半主机模式
int _sys_exit(int x)
{
x = x;
}
//重定义fputc函数
//使串口1能使用printf函数
int fputc(int ch, FILE *f)
{
while((USART1->SR&0X40)==0);//循环发送,直到发送完毕
USART1->DR = (u8) ch;
return ch;
}
#endif
#if EN_USART1_RX //如果使能了接收
//串口1中断服务程序
//注意,读取USARTx->SR能避免莫名其妙的错误
u8 USART_RX_BUF[USART_REC_LEN]; //接收缓冲,最大USART_REC_LEN个字节.
//接收状态
//bit15, 接收完成标志
//bit14, 接收到0x0d
//bit13~0, 接收到的有效字节数目
u16 USART_RX_STA=0; //接收状态标记
u8 RX_buffer[5]={0};
//初始化IO 串口1
//bound:波特率
void uart_init(u32 bound) //串口1
{
//GPIO端口设置
GPIO_InitTypeDef GPIO_InitStructure;
USART_InitTypeDef USART_InitStructure;
NVIC_InitTypeDef NVIC_InitStructure;
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA,ENABLE); //使能GPIOA时钟
RCC_APB2PeriphClockCmd(RCC_APB2Periph_USART1,ENABLE);//使能USART1时钟
//串口1对应引脚复用映射
GPIO_PinAFConfig(GPIOA,GPIO_PinSource9,GPIO_AF_USART1); //GPIOA9复用为USART1
GPIO_PinAFConfig(GPIOA,GPIO_PinSource10,GPIO_AF_USART1); //GPIOA10复用为USART1
//USART1端口配置
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_9 | GPIO_Pin_10; //GPIOA9与GPIOA10
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;//复用功能
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; //速度50MHz
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP; //推挽复用输出
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP; //上拉
GPIO_Init(GPIOA,&GPIO_InitStructure); //初始化PA9,PA10
//USART1 初始化设置
USART_InitStructure.USART_BaudRate = bound;//波特率设置
USART_InitStructure.USART_WordLength = USART_WordLength_8b;//字长为8位数据格式
USART_InitStructure.USART_StopBits = USART_StopBits_1;//一个停止位
USART_InitStructure.USART_Parity = USART_Parity_No;//无奇偶校验位
USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;//无硬件数据流控制
USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx; //收发模式
USART_Init(USART1, &USART_InitStructure); //初始化串口1
USART_Cmd(USART1, ENABLE); //使能串口1
USART_ClearFlag(USART1, USART_FLAG_TC);
USART_ITConfig(USART1, USART_IT_RXNE, ENABLE);//开启相关中断
//Usart1 NVIC 配置
NVIC_InitStructure.NVIC_IRQChannel = USART1_IRQn;//串口1中断通道
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=3;//抢占优先级3
NVIC_InitStructure.NVIC_IRQChannelSubPriority =3; //子优先级3
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道使能
NVIC_Init(&NVIC_InitStructure); //根据指定的参数初始化VIC寄存器、
}
void USART1_IRQHandler(void) //串口1中断服务函数
{
printf("distance=%d\n",distance);
printf("angle=%d\n",angle);
}
2>串口6配置
void init(u32 bound) //串口6
{
//GPIO端口设置
GPIO_InitTypeDef GPIO_InitStructure;
USART_InitTypeDef USART_InitStructure;
NVIC_InitTypeDef NVIC_InitStructure;
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOC,ENABLE); //使能GPIOA时钟
RCC_APB2PeriphClockCmd(RCC_APB2Periph_USART6,ENABLE);//使能USART1时钟
//串口1对应引脚复用映射
GPIO_PinAFConfig(GPIOC,GPIO_PinSource6,GPIO_AF_USART6); //GPIOC6复用为USART6
GPIO_PinAFConfig(GPIOC,GPIO_PinSource7,GPIO_AF_USART6); //GPIOC7复用为USART6
//USART1端口配置
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_6 | GPIO_Pin_7; //GPIOC6与GPIOC7
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF;//复用功能
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_50MHz; //速度50MHz
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP; //推挽复用输出
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP; //上拉
GPIO_Init(GPIOC,&GPIO_InitStructure); //初始化PA9,PA10
//USART1 初始化设置
USART_InitStructure.USART_BaudRate = bound;//波特率设置
USART_InitStructure.USART_WordLength = USART_WordLength_8b;//字长为8位数据格式
USART_InitStructure.USART_StopBits = USART_StopBits_1;//一个停止位
USART_InitStructure.USART_Parity = USART_Parity_No;//无奇偶校验位
USART_InitStructure.USART_HardwareFlowControl = USART_HardwareFlowControl_None;//无硬件数据流控制
USART_InitStructure.USART_Mode = USART_Mode_Rx | USART_Mode_Tx; //收发模式
USART_Init(USART6, &USART_InitStructure); //初始化串口1
USART_Cmd(USART6, ENABLE); //使能串口1
USART_ClearFlag(USART6, USART_FLAG_TC);
USART_ClearFlag(USART6, USART_FLAG_RXNE);
USART_ITConfig(USART6, USART_IT_RXNE, ENABLE);//开启相关中断
//Usart1 NVIC 配置
NVIC_InitStructure.NVIC_IRQChannel = USART6_IRQn;//串口1中断通道
NVIC_InitStructure.NVIC_IRQChannelPreemptionPriority=3;//抢占优先级3
NVIC_InitStructure.NVIC_IRQChannelSubPriority =2; //子优先级3
NVIC_InitStructure.NVIC_IRQChannelCmd = ENABLE; //IRQ通道使能
NVIC_Init(&NVIC_InitStructure); //根据指定的参数初始化VIC寄存器、
}
u8 jp=0; //声明一个变量用于存储数据
void USART6_IRQHandler(void) //串口6中断服务程序
{
if(USART_GetITStatus(USART6, USART_IT_RXNE) != RESET)
{
RX_buffer[jp]=USART_ReceiveData(USART6);
jp++;
if(jp%5==0) //确保收到了完整的一组5个数据后才开始解算数据
{
distance=(RX_buffer[2]<<8|RX_buffer[1])/0X04;
angle=(RX_buffer[4]<<8|RX_buffer[3]>>1)/0X80;
//printf("distance=%d\n",distance); 距离角度等数据通过串口1打印
//printf("angle=%d\n",angle);
jp=0;
delay_ms(50); //由于32算力不够,且数据量过大,选择延迟一定时间来漏掉一些数据,
//是否需要可看自己
}
}
}
至此,串口配置完成,接下来开始PWM的配置。
我使用的是TIM1的定时器,时钟频率为168MHz.
3>PWM配置
代码如下:
void RIGHT_PWM_Init(u32 arr,u32 psc) //激光雷达旋转
{
//此部分需手动修改IO口设置
GPIO_InitTypeDef GPIO_InitStructure;
TIM_TimeBaseInitTypeDef TIM_TimeBaseStructure;
TIM_OCInitTypeDef TIM_OCInitStructure;
RCC_APB2PeriphClockCmd(RCC_APB2Periph_TIM1,ENABLE); //TIM14时钟使能
RCC_AHB1PeriphClockCmd(RCC_AHB1Periph_GPIOA, ENABLE); //使能PORTF时钟
GPIO_PinAFConfig(GPIOA,GPIO_PinSource6,GPIO_AF_TIM1); //GPIOF9复用为定时器1
GPIO_InitStructure.GPIO_Pin = GPIO_Pin_8; //GPIOF8
GPIO_InitStructure.GPIO_Mode = GPIO_Mode_AF; //复用功能
GPIO_InitStructure.GPIO_Speed = GPIO_Speed_100MHz; //速度100MHz
GPIO_InitStructure.GPIO_OType = GPIO_OType_PP; //推挽复用输出
GPIO_InitStructure.GPIO_PuPd = GPIO_PuPd_UP; //上拉
GPIO_Init(GPIOA,&GPIO_InitStructure); //初始化PF8
TIM_TimeBaseStructure.TIM_Prescaler=psc; //定时器分频
TIM_TimeBaseStructure.TIM_CounterMode=TIM_CounterMode_Up; //向上计数模式
TIM_TimeBaseStructure.TIM_Period=arr; //自动重装载值
TIM_TimeBaseStructure.TIM_ClockDivision=TIM_CKD_DIV1;
TIM_TimeBaseInit(TIM1,&TIM_TimeBaseStructure);//初始化定时器13
//初始化TIM13 Channel1 PWM模式
TIM_OCInitStructure.TIM_OCMode = TIM_OCMode_PWM1; //选择定时器模式:TIM脉冲宽度调制模式2
TIM_OCInitStructure.TIM_OutputState = TIM_OutputState_Enable; //比较输出使能
TIM_OCInitStructure.TIM_OCPolarity = TIM_OCPolarity_Low; //输出极性:TIM输出比较极性低
TIM_OC1Init(TIM1, &TIM_OCInitStructure); //根据T指定的参数初始化外设TIM1 4OC1
TIM_OC1PreloadConfig(TIM1, TIM_OCPreload_Enable); //使能TIM14在CCR1上的预装载寄存器
TIM_ARRPreloadConfig(TIM1,ENABLE);//ARPE使能
TIM_Cmd(TIM1, ENABLE); //使能TIM14
}
4>串口6发送启动激光雷达的数据
{
USART_ClearFlag(USART6,USART_FLAG_TC);
if(1)
{ USART_SendData(USART6,0xA5); //从串口1发送开始指令 USART_FLAG_TC: 发送移位寄存器发送完成标志位,全部发送完毕会置 1
while(USART_GetFlagStatus(USART6,USART_FLAG_TC)!=SET);//等待发送结束
USART_SendData(USART6,0x20); //从串口1发送结束指令
while(USART_GetFlagStatus(USART6,USART_FLAG_TC)!=SET);//等待发送结束
}
}
5>主函数配置(波特率选择以及PWM频率配置)
#include "sys.h"
#include "delay.h"
#include "usart.h" //串口1 6配置
#include "led.h" //pwm和激光雷达初始化
u16 distance; //距离
u8 angle; //角度
int main(void)
{
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2);//设置系统中断优先级分组2
delay_init(168); //延时初始化
LidarInit(); //初始化激光雷达
uart_init(115200); //串口1
init(115200); //串口6
RIGHT_PWM_Init(2500-1,168-1); //PA8 1000000/5000=2000;
//每一秒能计数250/1000000=1/4000,也就是1s能进入4000次更新,250us进入一次更新
while(1)
{
}
}
至此,代码部分结束。现在来接线。
图中可以观察到激光雷达的电压供给为5V,因此我们需要接在STM32F407的5V接口上且需要两个,但这样做并满足不了电流的要求,因此需要为STM32接上一根供电线。
接线:
TX与PC7连接
RX与PC6连接
VCC_5V,5V_MOTO与5V连接
GND,GND_MOTO与GND连接
MOTOCTL与PA8连接
上图为CH340,通过杜邦线连接GND,RXD,TXD,3.3V到STM32上完成与STM32的连接,并将另一头与电脑连接。
至此,所有接线也完成,此时发现激光雷达开始旋转。
之后便是使用SSCOM,这一部分不多讲解,之后便会发现串口工具疯狂打印数据。
至此,全部结束。
如果不满足于使用串口来做距离和角度测算的,可以使用DMA,若有机会我会使用DMA来讲解激光雷达。
敬请期待!