TOF10120激光測距STM32串口驅動源程序與pdf資料下載

ID:341683 · 發(fā)表于 2019-3-22 15:46

部分程序源碼
i

#include "led.h"
#include "delay.h"
#include "sys.h"
#include "usart.h"
#include "usart2.h"
#include "string.h"
#include "lcd.h"
#include "math.h"
u16 distance=0;
u8 calculate_distance(void)
{
int i=1000;
u8 len;
u8 t;
printf("r6#");
while(((USART_RX_STA&0x8000)==0)&& i>0)
{
i--;
}
if(USART_RX_STA&0x8000)
{
len=USART_RX_STA&0x3fff;//得到此次接收到的數據長度
for(t=2;t<len-2;t++)
{
distance+=(USART_RX_BUF[t]-'0')*((u16)pow(10,len-3-t));
}
USART_RX_STA=0;
u2_printf("%d\r\n",distance);
return 1;
}
else return 0;
}
int main(void)
{
u8 time=1;
delay_init(); //延時函數初始化
NVIC_PriorityGroupConfig(NVIC_PriorityGroup_2); //設置NVIC中斷分組2:2位搶占優(yōu)先級，2位響應優(yōu)先級
uart_init(9600); //串口初始化為9600
USART2_Init(9600);
LED_Init(); //初始化與LED連接的硬件接口
LCD_Init();
POINT_COLOR=RED;
while(1)
{
if(calculate_distance()==1)
{
time++;
delay_ms(100);
}
distance=0;
if(time%10==0)
{
LED1=!LED1;
}
}
}