【正文】 _x=0。} if(workstate==1 amp。pulse_y=0 。amp。 pulse_yn) { PWM_left(17,217)。} if(pulse_x=m amp。amp。 PWM_right(13,213)。amp。 pulse_y=0。 delay_ms(20)。 delay_ms(20)。 abs(chdata[3]chdata[4])=20 ) break。 if( min==chdata[4] amp。amp。 delay_ms(20)。amp。 delay_ms(20)。amp。 delay_ms(20)。 delay_ms(20)。 if(min==chdata[6]) turn_right(30)。 abs(chdata[3]chdata[4])30 )turn_right(5)。 if(min==chdata[4] amp。amp。 if(min==chdata[2]) turn_left(12)。 adjust()。 min=255。 // 開(kāi)啟蜂鳴 器報(bào)警 xp=255。 flag=0。 } 5 sucessfire=1。 // 滅火風(fēng)扇關(guān)閉 delay_s(3)。 // 滅火風(fēng)扇開(kāi)啟 delay_s(8)。 while(chdata[3]=0x7f || chdata[4]=0x7f) { if(n=1)revison()。 } } stop()。 chdata[4] =0x05) {turn_right(1)。 } if(chdata[3]0x05 amp。 chdata[4] 0x05 ) {turn_left(1) 。 if(chdata[3]=0x05 amp。amp。amp。amp。i20。 flag=3。 } if(chdata[3]=0x05 || chdata[4]= 0x05) break。 break。 break。 break。 break。 break。 break。 break。 break。 break。 break。 break。 while(1) { adjust()。 default: break。 case 11: forward_s(1,1)。 case 10: forward(2,2)。 case 9: forward(5,5)。 case 8: forward(10,10)。 case 7: forward(20,20)。 case 6: forward(30,30)。 case 5: forward(35,35)。 case 4: forward(45,45)。 case 3: forward(50,50)。 case 2: forward(55,55)。 switch(mm) { case 1: forward(60,60)。 Set_IOB_Data(0,1)。 flag==0) break。 if(workstate==1 amp。 while(1) { turn_left(120)。 //階段 2 接近火源，邊走邊調(diào)整 Stage3()。 //階段 0 按一定的路徑走 Stage1()。 //TMB 用來(lái)控制 2個(gè)電機(jī)， 1KHZ控制避崖， __asm(INT IRQ,FIQ)。 *P_TimerB_Data=(**32768)。 *P_IOB_Data = 0xF000。 *P_IOB_Dir = 0x0FFF。 // *P_IOA_Attrib=0xE7FF。 } } //***************系統(tǒng)初始化 *********************// void system_init(void) { __asm(INT OFF)。 fire()。 delay_s(3)。 //階段 3 void revison()。 //階段 1 void Stage2(void)。 //避崖 void Stage0(void)。 void bizhan(void ) 。 //滅火 void hf(void)。 //粗調(diào) void seekfire(void)。 //s級(jí)延時(shí)程序 void adjust(void)。 //系 統(tǒng)初始化 void delay_ms(unsigned int t )。 void get_AD(void)。 void turn_right(unsigned int m)。 void backward(unsigned int m,unsigned int n)。 void forward_s(unsigned int m,unsigned int n)。 void PWM_right(unsigned int high_time,unsigned int cyclical_time)。 //進(jìn)入檢測(cè)范圍 unsigned int sucessfire=0。 //排序 unsigned int chdata[7]。 unsigned int pulse_x,pulse_y。 1 附錄 1 include define P_IOA_Data (volatile unsigned int *)0x7000 define P_IOA_Dir (volatile unsigned int *)0x7002 define P_IOA_Attrib (volatile unsigned int *)0x7003 define P_IOB_Data (volatile unsigned int *)0x7005 define P_IOB_Dir (volatile unsigned int *)0x7007 define P_IOB_Attrib (volatile unsigned int *)0x7008 define P_TimerB_Data (volatile unsigned int *)0x700C define P_TimerB_Ctrl (volatile unsigned int *)0x700D define P_INT_Ctrl (volatile unsigned int *)0x7010 define P_INT_Clear (volatile unsigned int *)0x7011 define P_ADC (volatile unsigned int *)0x7014 define P_ADC_Ctrl (volatile unsigned int *)0x7015 define P_ADC_MUX_Ctrl (volatile unsigned int *)0x702B define P_ADC_MUX_Data (volatile unsigned int *)0x702C define C_FIQ_PWM 0x8000 // P_INT_Ctrl define C_FIQ_TMA 0x2020 // P_INT_Ctrl define C_FIQ_TMB 0x0800 // P_INT_Ctrl define C_IRQ4_1KHz 0x0010 // P_INT_Ctrl define C_IRQ4_2KHz 0x0020 // P_INT_Ctrl define C_IRQ4_4KHz 0x0040 // P_INT_Ctrl define C_IRQ5_2Hz 0x0004 // P_INT_Ctrl define C_IRQ5_4Hz 0x0008 // P_INT_Ctrl define C_TMB_32KHz 0x0002 // P_TimerB_Ctrl define C_TMB_PWM_OFF 0x0000 // P_TimerB_Ctrl define P_Watchdog_Clear (volatile unsigned int *)0x7012 unsigned int mm,min,y,Delaynumber,xp=255,flag,dd。 unsigned int left,right。 unsigned int paixu[7]。 //火焰?zhèn)鞲衅鳈z測(cè)通道 unsigned int workstate=0。 //滅火成功標(biāo)記 void PWM_left(unsigned int high_time,unsigned int cyclical_time)。 void forward(unsigned int m,unsigned int n) 。 void forward_s2(unsigned int m,unsigned int n)。 void turn_left (unsigned int m)。 void stop(void)。 //AD轉(zhuǎn)換 2 void system_init(void)。 //ms級(jí)延時(shí)程序 void delay_s(unsigned int t )。 //調(diào)整 void adjust_s(void)。 //尋找火源 void fire(void)。 int abs(int m)。 //避障 void biya(void )。//階段 0 void Stage1(void)。 //階段 2 void Stage3(void)。//修正函數(shù) //++++++++++++主函數(shù) ++++++++++++++++++// int main(void) { system_init()。 while(1) { seekfire()。 delay_s(8)。 *P_IOA_Dir=0xE700。 *P_IOA_Data=0x1800。 *P_IOB_Attrib = 0x0FFF。 *P_TimerB_Ctrl=(C_TMB_32KHz|C_TMB_PWM_OFF)。 *P_INT_Ctrl |=(C_FIQ_TMB + C_IRQ4_1KHz + C_IRQ5_2Hz + C_IRQ5_4Hz)。 //2HZ用來(lái)控制 AD采集 4HZ用來(lái)避障 } 3 //***************尋找火源 *********************// void seekfire(void) { Stage0()。 //階段 1 有發(fā)現(xiàn)火源，做初步調(diào)整 Stage2()。 //階段 3 到達(dá)火源前面，做最后的調(diào)整 } void Stage0(void) //階段 0 { flag=0。 //轉(zhuǎn) 360度 掃描有沒(méi)有火源 forward(250,250)。amp。 } } void Stage1(void) //階段 1 { flag=1。 // 開(kāi)啟蜂鳴器報(bào)警 adjust_s()。 break。 break。 break。 break。 break。 break。 break。 break。 break。 break。 break。 } } void Stage2(void) //階段 2 { flag=2。 4 switch(mm) {