激光雷达A1M8与STM32通信

简介: 激光雷达A1M8与STM32通信

我与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来讲解激光雷达。


相关文章
|
5月前
|
监控
stm32f407探索者开发板(十八)——串口通信实验讲解(USART_RX_STA流程图详解)
stm32f407探索者开发板(十八)——串口通信实验讲解(USART_RX_STA流程图详解)
437 0
|
5月前
stm32f407探索者开发板(十六)——串行通信原理讲解-UART
stm32f407探索者开发板(十六)——串行通信原理讲解-UART
322 0
|
7月前
STM32--SPI通信与W25Q64(2)
STM32--SPI通信与W25Q64(2)
108 0
|
7月前
|
存储 传感器 芯片
STM32--SPI通信与W25Q64(1)
STM32--SPI通信与W25Q64(1)
222 0
|
7月前
|
存储 传感器
【STM32基础 CubeMX】uart串口通信
【STM32基础 CubeMX】uart串口通信
435 0
|
芯片
STM32速成笔记(五)—串口通信
本文介绍了串口通信的概念,用途以及一些相关概念。介绍了如何进行printf重定向,如何根据接收到的特定信息,执行特定操作。此外,本文以通过上位机发送特殊指令控制LED亮灭的小项目,给出了详细的配置方法和程序设计。
226 0
STM32速成笔记(五)—串口通信
14 STM32之IIC通信(软件模拟篇)
14 STM32之IIC通信(软件模拟篇)
|
缓存 数据格式
STM32串口通信配置(USART1+USART2+USART3+UART4)
STM32串口通信配置(USART1+USART2+USART3+UART4)
314 0
|
芯片 异构计算
|
芯片 开发者
16 玩转STM32之SPI通信
16 玩转STM32之SPI通信