电机不用管,就是l298n,可以通过串口显示
单片机主程序:
- #include "led.h"
- #include "delay.h"
- #include "sys.h"
- #include "key.h"
- #include "usart.h"
- #include "exti.h"
- #include "timer.h"
- #include "UltrasonicWave.h"
- #include "motor.h"
- extern float UltrasonicWave_Distance;
- int main(void)
- {
- // SystemInit();
- delay_init(72); //延时初始化
- NVIC_Configuration();
- uart_init(9600); //串口初始化
- LED_Init(); //LED端口初始化
- KEY_Init(); //按键端口初始化
- Timerx_Init(5000,7199); //10Khz的计数频率,计数到5000为500ms
- UltrasonicWave_Configuration(); //对超声波模块初始化
- MOTO_GPIO_Config();
-
- while(1)
- {
- UltrasonicWave_StartMeasure(); //开始测距,发送一个>10us的脉冲,然后测量返回的高电平时间
- LED0=!LED0;
- if(UltrasonicWave_Distance>3)
- moveup();
- else
- {ENA(0); ENB(0);}
- // delay_ms(3000);
-
-
-
- }
- }
复制代码 全部资料下载地址:
超声波+电机测距.rar
(318.06 KB, 下载次数: 62)
|