这是智能小车的最后一篇博客,主要讲解一下小车的程序设计。

电机的驱动:

        我写了俩种转弯,一种是一个轮朝后一个轮朝前的转弯,另一种是抱死一个轮另一个向前,使用PWM来调速,PWM的占空比不能太小,有效电压低于2.4伏无法驱动298N。

#ifndef __MOTOR_H
#define __MOTOR_H
#include "sys.h"
#include <stm32f10x.h>


#define HIGH_SPEED 1
#define LOW_SPEED 0
#define Moter1_CH3_Value  TIM2->CCR3 
#define Moter1_CH4_Value  TIM2->CCR4
#define Moter2_CH3_Value  TIM1->CCR1
#define Moter2_CH4_Value  TIM1->CCR4


void MOTOR1_PWM_Init(u16 arr,u16 psc);
void MOTOR2_PWM_Init(u16 arr,u16 psc);
void Motor_Forward(u8 speed);
void Motor_Left1(u16 value);
void Motor_Right1(u16 value);
void Motor_Left2(u16 value);
void Motor_Right2(u16 value);
void Motor_Back(void);
void Motor_Stop(void);


#endif



#include "motor.h"
#include "delay.h"


//电机1(左侧)初始化
//PA3(CH4)  PA2(CH3)

void MOTOR1_PWM_Init(u16 arr,u16 psc)
{
	RCC->APB1ENR|=1<<0; 	//TIM2时钟使能    
	RCC->APB2ENR|=1<<2;    	//使能PORTA时钟	
	GPIOA->CRL&=0XFFFF00FF;	//PB10、11输出
	GPIOA->CRL|=0X0000BB00;	//复用功能输出 	

	   
	RCC->APB2ENR|=1<<0;     //开启辅助时钟	   
	AFIO->MAPR&=0XFFFFFCFF; //清除MAPR的[9:8]
	//AFIO->MAPR|=1<<9;      //部分重映像

	TIM2->ARR=arr;			//设定计数器自动重装值 
	TIM2->PSC=psc;			//预分频器不分频
	TIM2->CR1=0x0080;   	//ARPE使能 
	TIM2->CCMR2|=7<<12;  	//CH2 PWM2模式	
	TIM2->CCMR2|=1<<11; 	//CH2预装载使能	   
//	TIM2->CCER|=1<<12;   	//OC4 输出使能	   
	
	TIM2->CCMR2|=7<<4;  	//CH3 PWM2模式	
	TIM2->CCMR2|=1<<3; 		//CH3预装载使能	   
	//TIM2->CCER|=1<<8;   	//OC3 输出使能	   	
	TIM2->CR1|=0x01;    	//使能定时器3 	
}


//电机2(左侧)初始化
//PB7(CH3)   PB10(CH4)

void MOTOR2_PWM_Init(u16 arr,u16 psc)
{
	RCC->APB2ENR|=1<<11; 	//TIM1时钟使能    
	RCC->APB2ENR|=1<<2;    	//使能PORTB时钟	

	GPIOA->CRH&=0XFFFF0FF0;	//PB0、PB1输出
	GPIOA->CRH|=0X0000B00B;	//复用功能输出 	
	   
	RCC->APB2ENR|=1<<0;     //开启辅助时钟	   
	AFIO->MAPR&=0XFFFFFF3F; //清除MAPR的[7:6]
	//AFIO->MAPR|=1<<11;      //部分重映像
	TIM1->BDTR|=1<<15;
	TIM1->ARR=arr;			//设定计数器自动重装值 
	TIM1->PSC=psc;			//预分频器不分频
	TIM1->CR1=0x0080;   	//ARPE使能 
	TIM1->CCMR2|=7<<12;  	//CH4 PWM2模式	
	TIM1->CCMR2|=1<<11; 		//CH4预装载使能	     
	
	TIM1->CCMR1|=7<<4;  	//CH3 PWM2模式	
	TIM1->CCMR1|=1<<3; 		//CH3预装载使能	    
	TIM1->CR1|=0x01;    	//使能定时器1
}


/************************************************************
***************************停止*****************************
*****返回值:无
************************************************************/
void Motor_Stop(void)
{
	TIM1->CCER|=1<<0;   	//OC3 输出使能
	TIM1->CCER|=1<<12;   	//OC4 输出使能
	TIM2->CCER|=1<<8;   	//OC3 输出使能
	TIM2->CCER|=1<<12;   	//OC4 输出使能	
	Moter1_CH3_Value=0;
	Moter2_CH3_Value=0;
	Moter1_CH4_Value=0;
	Moter2_CH4_Value=0;
	delay_ms(500);
	TIM1->CCER&=~(1<<0);   	//OC3 输出禁止
	TIM1->CCER&=~(1<<12);   	//OC4 输出禁止
	TIM2->CCER&=~(1<<8);   	//OC3 输出禁止
	TIM2->CCER&=~(1<<12);   	//OC4 输出禁止
}

/************************************************************
**************************向前走*****************************
*****入口参数:speed(0:慢速 1:快速)
*****返回值:无
OUT2+ OUT1-      OUT4+ OUT3-
************************************************************/
void Motor_Forward(u8 speed)  
{
	TIM2->CCER&=~(1<<12);   	//OC4 输出禁止
	TIM1->CCER&=~(1<<12);   	//OC4 输出禁止
	TIM1->CCER|=1<<0;   	//TIM3 OC1 输出使能
	TIM2->CCER|=1<<8;   	//TIM2 OC1 输出使能	
	
	switch (speed)
	{
		case 0:
		{						
			Moter1_CH3_Value=390;
			Moter2_CH3_Value=350;			
			break;			
		}
		case 1:
		{
			Moter1_CH3_Value=450;
			Moter2_CH3_Value=440;
			break;
		}
	}
}
/************************************************************
***************************左转1*****************************
*****入口参数:无
*****返回值:无
************************************************************/
void Motor_Left1(u16 value)
{
	TIM2->CCER|=1<<8;   	//OC3 输出使能
	TIM2->CCER&=~(1<<12);   	//OC3 输出禁止
	TIM1->CCER|=1<<12;   	//OC4 输出使能
	TIM1->CCER&=~(1<<0);   	//OC3 输出禁止	
	
	
	Moter1_CH3_Value=150;
	Moter2_CH4_Value=300;
	delay_ms(value);
	TIM1->CCER&=~(1<<12);   	//OC4 输出禁止
	TIM2->CCER&=~(1<<8);   	//OC3 输出使能
}
/************************************************************
***************************右转1*****************************
*****返回值:无
************************************************************/
void Motor_Right1(u16 value)
{
	TIM1->CCER|=1<<0;   	//TIM3 OC1 输出使能
	TIM2->CCER&=~(1<<8);   	//OC3 输出禁止
	TIM2->CCER|=1<<12;   	//OC4 输出使能
	TIM1->CCER&=~(1<<12);   	//OC4 输出禁止
	
	Moter2_CH3_Value=300;
	Moter1_CH4_Value=150;
	delay_ms(value);
	TIM2->CCER&=~(1<<12);   	//OC4 输出禁止
	TIM1->CCER&=~(1<<0);   	//OC3 输出使能
}
/************************************************************
***************************左转1*****************************
*****入口参数:无
*****返回值:无
************************************************************/
void Motor_Left2(u16 value)
{
	Moter2_CH3_Value=990;
	Moter1_CH3_Value=410;
	delay_ms(value);
}
/************************************************************
***************************右转1*****************************
*****返回值:无
************************************************************/
void Motor_Right2(u16 value)
{
	Moter1_CH3_Value=990;
	Moter2_CH3_Value=350;
	delay_ms(value);
}
/************************************************************
***************************后退*****************************
*****入口参数:无
*****返回值:无
************************************************************/
void Motor_Back(void)
{
	TIM1->CCER|=1<<12;   	//OC4 输出使能
	TIM2->CCER|=1<<12;   	//OC4 输出使能
	TIM2->CCER&=~(1<<8);   	//OC3 输出禁止
	TIM1->CCER&=~(1<<0);   	//OC3 输出禁止
	
	Moter1_CH4_Value=50;
	Moter2_CH4_Value=50;
}

红外对管的驱动:

#ifndef __EXTI_H
#define __EXTI_H

void EXTI_Init(void);
#endif
#include "exti.h"
#include "delay.h"
#include "sys.h"
#include "motor.h"


u8 Tracing_Right=0;
u8 Tracing_Left=0;
void EXTI4_IRQHandler(void)
{	
	delay_ms(10);
	Tracing_Right=1;
	Motor_Right2(100);
	EXTI->PR=1<<4;	
}

void EXTI0_IRQHandler(void)
{
	
	delay_ms(10);
	Tracing_Left=1;
	Motor_Left2(100);
	EXTI->PR=1<<0;	
}


void EXTI_Init(void){
	RCC->APB2ENR|=1<<3;
	RCC->APB2ENR|=1<<2;
	GPIOB->CRL&=0xFFF00FFF;
	GPIOB->CRL|=0x00088000;
	GPIOA->CRL&=0xFFFFFFF0;
	GPIOA->CRL|=0x00000008;
	Ex_NVIC_Config(GPIO_B, 4, RTIR);	//PB4 上升沿触发 (右)
	Ex_NVIC_Config(GPIO_A, 0, RTIR);	//PA0 上升沿触发(左)
	MY_NVIC_Init(2, 1, EXTI0_IRQn, 2); //抢占2, 子优先级0, 组2
	MY_NVIC_Init(2, 0, EXTI4_IRQn, 2); //抢占2, 子优先级1, 组2
}

HC-SR04的驱动:

        输入捕获,采样三次取平均值

#ifndef __HCSR_04_
#define __HCSR_04_
#include "sys.h"

void HCSR_04_TIM3_Init(u16 arr,u16 psc);
u16 HCER_04_Get_Length(void);



#endif
#include "hcsr04.h"
#include "sys.h"
#include "delay.h"
#include "usart.h"


//[7] 0表示没有成功捕获 1表示成功捕获一次
//[6] 0表示还没捕获到低电平 1表示捕获到高电平
//[5:0]  捕获高电平后溢出的次数
u8 TIM3CH1_CAPTURE_STA=0;  //输入捕获状态
u16 TIM3CH1_CAPTURE_VAL;   //输入捕获值

void HCSR_04_TIM3_Init(u16 arr,u16 psc)
{
	RCC->APB1ENR|=1<<1;   	//TIM3 时钟使能 
	RCC->APB2ENR|=1<<2;   	//使能PORTA时钟	
	GPIOA->CRL&=0x00FFFFFF;
	GPIOA->CRL|=0x38000000;
	AFIO->MAPR&=0XFFFFF3FF; //清除MAPR的[11:10]
	AFIO->MAPR|=1<<11;      //部分重映像
	
	GPIOA->ODR|=1<<7;
	
 	TIM3->ARR=arr;  		//设定计数器自动重装值   
	TIM3->PSC=psc;  		//预分频器 

	TIM3->CCMR1|=1<<0;		//CC1S=01 	选择输入端 IC1映射到TI1上
 	TIM3->CCMR1|=0<<4; 		//IC1F=0000 配置输入滤波器 不滤波
 	TIM3->CCMR1|=0<<2; 	//IC1PS=00 	配置输入分频,不分频 

	TIM3->CCER|=0<<1; 		//CC1NP=0	上升沿捕获
	TIM3->CCER|=1<<0; 		//CC1E=1 	允许捕获计数器的值到捕获寄存器中

	//TIM3->BDTR|=1<<15;
	TIM3->EGR=1<<0;			//软件控制产生更新事件,使写入PSC的值立即生效,否则将会要等到定时器溢出才会生效!
	TIM3->DIER|=1<<1;   	//允许捕获1中断				
	TIM3->DIER|=1<<0;   	//允许更新中断	
	TIM3->CR1|=0x01;    	//使能定时器1
	
	MY_NVIC_Init(2,1,TIM3_IRQn,2);//抢占3,子优先级1,组2		捕获比较中断
}


void TIM3_IRQHandler(void)
{
	u16 tsr;
	tsr=TIM3->SR;
 	if((TIM3CH1_CAPTURE_STA&0X80)==0)//还未成功捕获	
	{
		if(tsr&0X01)//溢出
		{	     
			if(TIM3CH1_CAPTURE_STA&0X40)//已经捕获到高电平了
			{
				if((TIM3CH1_CAPTURE_STA&0X3F)==0X3F)//高电平太长了
				{
					TIM3CH1_CAPTURE_STA|=0X80;		//标记成功捕获了一次
					TIM3CH1_CAPTURE_VAL=0XFFFF;
				}else TIM3CH1_CAPTURE_STA++;
			}	 
		}
		if(tsr&0x02)//捕获1发生捕获事件
		{	
			if(TIM3CH1_CAPTURE_STA&0X40)		//捕获到一个下降沿 		
			{	  			
				TIM3CH1_CAPTURE_STA|=0X80;		//标记成功捕获到一次高电平脉宽
			    TIM3CH1_CAPTURE_VAL=TIM3->CCR1;	//获取当前的捕获值.
	 			TIM3->CCER&=~(1<<1);			//CC1P=0 设置为上升沿捕获
			}else  								//还未开始,第一次捕获上升沿
			{
				TIM3CH1_CAPTURE_STA=0;			//清空
				TIM3CH1_CAPTURE_VAL=0;
				TIM3CH1_CAPTURE_STA|=0X40;		//标记捕获到了上升沿
				TIM3->CR1&=~(1<<0)		;    	//使能定时器2
	 			TIM3->CNT=0;					//计数器清空
	 			TIM3->CCER|=1<<1; 				//CC1P=1 设置为下降沿捕获
				TIM3->CR1|=0x01;    			//使能定时器2
			}		    
		}			     	    					   
 	}
	TIM3->SR=0;//清除中断标志位   
}
u16 HCER_04_Get_Length()
{
	u16 temp=0;
	u16 length;
	u16 sum=0;
	u8 i=1;
	u16 result;
	while(i<4)
	{
		GPIOA->ODR|=1<<7;         //PA4输出一个高电平
		delay_us(20);
		GPIOA->ODR&=~(1<<7);      //PA4电平拉低
		if(TIM3CH1_CAPTURE_STA&0X80)//成功捕获到了一次高电平
		{
			temp=TIM3CH1_CAPTURE_STA&0X3F; 
			temp*=0XFFFF;		 		//溢出时间总和
			temp+=TIM3CH1_CAPTURE_VAL;		//得到总的高电平时间
			length=temp*0.017;
			/*均值滤波*/
			sum+=length;	
			if(i==3)
				result=sum/3;	
			i++;		
			TIM3CH1_CAPTURE_STA=0;			//开启下一次捕获			
		}
	}
	return result;
}



舵机的驱动:

        使用循环+延时翻转电平的方式控制,舵机的代码里加入了HC-SR04的调用,用来测距,遇到障碍后小车停车,左右循找距离远的方向

#ifndef __SERVO_H
#define __SERVO_H

#include "sys.h"

#define SERVO  PBout(5)


void Servo_Init(void);
u8 Servo_Find(void);
void Servo_Run(void);


#endif
#include "servo.h"
#include "delay.h"
#include "hcsr04.h"
#include "usart.h"
#include "motor.h"


void Servo_Init(void)
{
	RCC->APB2ENR|=1<<3;    	//使能PORTB时钟	
	GPIOB->CRL&=0XFF0FFFFF;	//PB5输出
	GPIOB->CRL|=0X00300000;	//复用功能输出 
	SERVO=0;
}


//ROL 1 向左走,ROL 0 向右走,ROL 2 后退
u8 Servo_Find(void)
{
	int i,j;
	u16 RightLength=999,LeftLength=999,temp;
	u8 ROL;
	for(i=0;i<30;i++)
	  {
		  SERVO=1;
		  delay_us(1600);
		  SERVO=0;
		  delay_us(18400);
	  }
	  //测距
	  delay_ms(100);	  
	for(j=0;j<5;j++)
	 {
		 temp=HCER_04_Get_Length();
		if(temp<=RightLength)
			RightLength=temp;		
	 }
	for(i=0;i<30;i++)
	  {
		  SERVO=1;
		  delay_us(2050);
		  SERVO=0;
		  delay_us(17950);
	  }
	for(i=0;i<30;i++)
	  {
		  SERVO=1;
		  delay_us(2400);
		  SERVO=0;
		  delay_us(17600);
	  }
	  //测距
	  delay_ms(100);
	  for(j=0;j<5;j++)
	  {
		  temp=HCER_04_Get_Length();
		if(temp<=LeftLength)
			LeftLength=temp;		
	  }
	for(i=0;i<30;i++)
	  {
		  SERVO=1;
		  delay_us(2050);
		  SERVO=0;
		  delay_us(17950);
	  }
	  if(RightLength>=30&&RightLength>=LeftLength)
		  return 0;
	  else if(LeftLength>=30&&LeftLength>=RightLength)
		  return 1;
	  else
		  return 2;
	  
}
u8 flag=1;
void Servo_Run(void)
{
	u8 i,ROL;
	u16 FrontLength;
	//舵机回中
	if(flag==1)
	{
		for(i=0;i<30;i++)
	  {
		  SERVO=1;
		  delay_us(2050);
		  SERVO=0;
		  delay_us(17950);
	  }
	  flag=0;
  }
	 FrontLength=HCER_04_Get_Length();
	  if(FrontLength<=30)
	  {
		  flag=1;
		  Motor_Stop();
		  ROL=Servo_Find();
		  if(ROL==0)
		  {
			  //Motor_Stop();
			  Motor_Right1(700);
		  }
		  else if(ROL==1)
		  {
			  //Motor_Stop();
			 Motor_Left1(700);
		  }
		  else if(ROL==2)
		  {
			  Motor_Stop();
		  }		  
	  }
}

按键驱动:

#ifndef __KEY_H
#define __KEY_H	 
#include "sys.h"


#define KEY0_PRES	1		//KEY0按下
#define KEY1_PRES	2		//KEY1按下
#define KEY2_PRES	3		//KEY2按下
#define KEY_ERROR   5       //按键出错

#define KEY0  PBin(6)   	//PB6
#define KEY1  PBin(7)	 	//PB7
#define KEY2  PBin(8)	 	//PB8
	 
void KEY_Init(void);		//IO初始化
u8 KEY_Scan(u8 mode);		//按键扫描函数
//u8 KEY_UP();    //按键松开

#endif
#include "key.h"
#include "delay.h"
   
//按键初始化函数 
void KEY_Init(void)
{
	RCC->APB2ENR|=1<<3;     //使能PORTB时钟
	JTAG_Set(SWD_ENABLE);	//关闭JTAG,开启SWD
	GPIOB->CRL&=0x00FFFFFF;	//PB6、7设置成输入	  
	GPIOB->CRL|=0X88000000;   
	GPIOB->CRH&=0XFFFFFFF0;	//PB8设置成输入	  
	GPIOB->CRH|=0X00000008; 			 
} 
//按键处理函数
//返回按下的按键值
//mode:0,不支持连续按;1,支持连续按;
//返回值:
//0,没有任何按键按下
//KEY_ERROR,有多个按键按下
//KEY0_PRES,KEY0按下
//KEY1_PRES,KEY1按下
//WKUP_PRES,WK_UP按下 
//注意此函数有响应优先级,KEY0>KEY1>KEY2!!
u8 KEY_Scan(u8 mode)
{	 
	static u8 key_up=1;//按键按松开标志
	if(mode)key_up=1;  //支持连按		  
	if(key_up&&(KEY0==1||KEY1==1||KEY2==1))
	{
		delay_ms(10);//去抖动 
		key_up=0;
		if(KEY0==1&&KEY1==0&&KEY2==0)return KEY0_PRES;
		else if(KEY0==0&&KEY1==1&&KEY2==0)return KEY1_PRES;
		else if(KEY0==0&&KEY1==0&&KEY2==1)return KEY2_PRES; 
		else  return KEY_ERROR;
	}else if(KEY0==0&&KEY1==0&&KEY2==0)key_up=1; 	     
	return 0;// 无按键按下
}

蜂鸣器的驱动:

        俩种发声模式,分别用于选择模式以及模式选择错误时(多个按键被按下)

#ifndef __BEEP_H
#define __BEEP_H
#include "sys.h"

#define BEEP PBout(9)

void BEEP_Init(void);
void BEEP_Mode1(void);  //两声短鸣
void BEEP_Mode2(void);	//两声长鸣

#endif
#include "beep.h"
#include "delay.h"

void BEEP_Init(void)
{
	RCC->APB2ENR|=1<<3;			//使能A口时钟
	GPIOB->CRH&=0xFFFFFF0F;
	GPIOB->CRH|=0x0000003F;		//PA9输出
	BEEP=0;		
}


//用于模式选择后的提示
void BEEP_Mode1(void)
{
	BEEP=1;
	delay_ms(300);
	BEEP=0;
	delay_ms(70);
	BEEP=1;
	delay_ms(300);
	BEEP=0;
}


//模式选择错误时
void BEEP_Mode2(void)
{
	BEEP=1;
	delay_ms(1000);
	BEEP=0;
	delay_ms(100);
	BEEP=1;
	delay_ms(1000);
	BEEP=0;
}

USART3(蓝牙)驱动:

#ifndef __USART3_H
#define __USART3_H
#include "sys.h"
#include "stdio.h"

#define USART_REC_LEN  			200  	//定义最大接收字节数 200
#define EN_USART3_RX 			1		//使能(1)/禁止(0)串口1接收
	  	
extern u8  USART3_RX_BUF[USART_REC_LEN]; //接收缓冲,最大USART_REC_LEN个字节.末字节为换行符 
extern u16 USART3_RX_STA;         		//接收状态标记	
//如果想串口中断接收,请不要注释以下宏定义
void uart3_init(u32 pclk2,u32 bound);

#endif
#include "usart3.h"	 
#include "Data_struct.h"
#include "sys.h"
#include "usart.h"
#include "delay.h"
#include "motor.h"


u8 BTFlag;
#if EN_USART3_RX   //如果使能了接收
//串口1中断服务程序
//注意,读取USARTx->SR能避免莫名其妙的错误   	
u8 USART3_RX_BUF[USART_REC_LEN];     //接收缓冲,最大USART_REC_LEN个字节.
//接收状态
//bit15,	接收完成标志
//bit14,	接收到0x0d
//bit13~0,	接收到的有效字节数目
u16 USART3_RX_STA=0;       //接收状态标记	  
  
void USART3_IRQHandler(void)
{
	char res;	
	//delay_ms(50);
	if(USART3->SR&(1<<5))	//接收到数据
	{	
		//delay_ms(10);		
		res=USART3->DR;
		printf("\r\n%d",res);		
		if(res ==255)
		{	
			Motor_Forward(0);
			printf("\r\nGo Stright");
		}
		else if(res==254)	
		{
			Motor_Back();
			printf("\r\nGo Back");
		}
		else if(res== 248)
		{
			Motor_Left1(300);
			printf("\r\nTurn Left");			
		}
		else if(res==232)
		{
			Motor_Right1(300);
			printf("\r\nTurn Right");
		}
		else if(res==200)
		{
			Motor_Stop();
			printf("\r\nStop");
		}
	}
} 
#endif		


//初始化IO 串口3
//pclk2:PCLK2时钟频率(Mhz)
//bound:波特率 
void uart3_init(u32 pclk2,u32 bound)
{  	 
	float temp;
	u16 mantissa;
	u16 fraction;	   
	temp=(float)(pclk2*1000000)/(bound*16);//得到USARTDIV
	mantissa=temp;				 //得到整数部分
	fraction=(temp-mantissa)*16; //得到小数部分	 
    mantissa<<=4;
	mantissa+=fraction; 
	RCC->APB2ENR|=1<<3;   //使能PORTB口时钟  
	RCC->APB1ENR|=1<<18;  //使能串口3时钟 
	GPIOB->CRH&=0XFFFF00FF;//IO状态设置
	GPIOB->CRH|=0X00008B00;//IO状态设置 
		  
	RCC->APB2RSTR|=1<<18;   //复位串口3
	RCC->APB2RSTR&=~(1<<18);//停止复位	 
	
	//波特率设置
 	USART3->BRR=mantissa; // 波特率设置	 
	USART3->CR1|=0X200C;  //1位停止,无校验位.
//#if EN_USART1_RX		  //如果使能了接收
	//使能接收中断
	//USART3->CR1|=1<<8;    //PE中断使能
	USART3->CR1|=1<<5;    //接收缓冲区非空中断使能	
	USART3_RX_STA=0;	
	MY_NVIC_Init(3,3,USART3_IRQn,2);//组2,最低优先级 
//#endif
}

主程序:

#include "main.h"
#include "motor.h"
#include "exti.h"
#include "beep.h"
#include "key.h"
#include "led.h"
#include "usart.h"
#include "hcsr04.h"
#include "servo.h"
#include "usart3.h"



*/
extern u8 Tracing_Right;
extern u8 Tracing_Left;
extern u8 Flag;
void System_Init(void)
{
	Stm32_Clock_Init(9);					  //初始化系统时钟		
	delay_init(72);		
	uart_init(72,9600);	//初始化延时	
	HCSR_04_TIM3_Init(0xFFFF,36-1);
	MOTOR1_PWM_Init(1000-1,360-1);
	MOTOR2_PWM_Init(1000-1,360-1);
	uart3_init(72,9600);
	Servo_Init();
	EXTI_Init();
	BEEP_Init();
	KEY_Init();
	LED_Init();
	BEEP=0;
	//关中断
		EXTI->IMR&=~(1<<0);     
		EXTI->IMR&=~(1<<4); 
}
int main(void)
{	
	u8 key=0,SROL,flag1=0,flag2=0,flag3=0;
	System_Init();
	Motor_Stop();
	while(1)
	{		
		key=KEY_Scan(0);
		if(key==KEY_ERROR)
		{
			Motor_Stop();
			BEEP_Mode2();
			delay_ms(100);
		}
		//寻迹
		else if(key==KEY0_PRES)
		{
				BEEP_Mode1();
				EXTI->IMR|=1<<0;
				EXTI->IMR|=1<<4;
				//关蓝牙中断
				USART3->CR1&=~(1<<5);  
				delay_ms(2000);
				flag1++;
			while(1)
			{
				if(Tracing_Right==1)
				{
					Tracing_Left=0;					
				}
				else if(Tracing_Left==1)
				{
					Tracing_Right=0;					
				}
				else
				{
					Motor_Forward(LOW_SPEED);
				}
				REDLED=!REDLED;
			}
	    }
		
		//避障碍
		else if(key==KEY1_PRES)
		{			
				BEEP_Mode1();
				//关寻迹中断
				EXTI->IMR&=~(1<<0);     
				EXTI->IMR&=~(1<<4); 
				//关蓝牙中断
				USART3->CR1&=~(1<<5);  
				Motor_Forward(LOW_SPEED);
			while(1)
			{
				Servo_Run();
				Motor_Forward(LOW_SPEED);
			}
		}
		
		//蓝牙
		else if(key==KEY2_PRES)
		{
				BEEP_Mode1();
				//关寻迹中断
				EXTI->IMR&=~(1<<0);     
				EXTI->IMR&=~(1<<4); 
				USART3->CR1|=1<<5;    //接收缓冲区非空中断使能
		}
    }
}