部分程序源碼
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位搶占優先級，2位響應優先級
- 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;
- }
- }
- }
代碼與pdf 51hei附件下載：
單路激光加上位機讀取代碼.7z
(241.93 KB, 下載次數: 155)
2021-7-31 22:25 上傳
點擊文件名下載附件
tof10120.pdf
(1.6 MB, 下載次數: 74)
2019-3-22 15:46 上傳
點擊文件名下載附件
|
