基于STM32的光电小车
单片机源程序如下:
- /******************************************
- 文件名 :M3-Car.c
- 文件描 :STM32开发板小车控制程序设计
- ******************************************/
- #include"stm32f10x.h"
- #include "GpioPin.h"
- #include "Pwm_Output.h"
- extern u16 PWM_Val;
- int main(void)
- { u16 CCR =1000;
- SystemInit(); /*配置系统时钟为72M*/
- EXTI_PE5_Config(); //中断按键配置
- EXTI_PE6_Config(); //中断按键配置
- TIM3_GPIO_Config();// 通过TIM3初始化PWM
- Control_GPIOAB_Config(); /*初始小车控制管脚*/
- Control_GPIOE_Config(); /*配置传感器输入信号管脚*/
- while(1)
- {
-
- //检测到黑线信号为1,检测到白线为0
- if(Out2==1 && Out3==1)
- {
- RunToForward();
- }
- else
- {
- if((Out1==1 && Out3==0))
- {
-
- TurnLeft();
-
- }
- if(Out1==1)
- {
- while(Out1==0&&Out2==0&&Out3==0&&Out4==0) //直角左转
- {
- TurnLeft();
- }
- }
- if(( Out4==1&& Out2==0))
- {
- TurnRight();
- }
- if(Out4==1)
- {
- while(Out1==0&&Out2==0&&Out3==0&&Out4==0) //直角右转
- {
- TurnRight();
- }
- }
- }
-
- }
- }
复制代码
所有资料51hei提供下载:
M3小车控制程序设计.rar
(292.46 KB, 下载次数: 23)
|