智能灭火机器人设计方案程序.doc

#include""#define P_IOA_Data (volatileunsignedint*)0x7000b5E2RGbCAP#define P_IOA_Dir (volatileunsignedint*)0x7002p1EanqFDPw#define P_IOA_Attrib (volatileunsignedint*)0x7003DXDiTa9E3d#define P_IOB_Data (volatileunsignedint*)0x7005RTCrpUDGiT#define P_IOB_Dir (volatileunsignedint*)0x70075PCzVD7HxA#define P_IOB_Attrib (volatileunsignedint*)0x7008jLBHrnAILg#define P_TimerB_Data (volatileunsignedint*)0x700CxHAQX74J0X#define P_TimerB_Ctrl (volatileunsignedint*)0x700DLDAYtRyKfE#define P_INT_Ctrl (volatileunsignedint*)0x7010Zzz6ZB2Ltk#define P_INT_Clear (volatileunsignedint*)0x7011dvzfvkwMI1#define P_ADC (volatileunsignedint*)0x7014#define P_ADC_Ctrl (volatileunsignedint*)0x7015rqyn14ZNXI#define P_ADC_MUX_Ctrl (volatileunsignedint*)0x702BEmxvxOtOco#define P_ADC_MUX_Data (volatileunsignedint*)0x702CSixE2yXPq5#define C_FIQ_PWM 0x8000 //P_INT_Ctrl#define C_FIQ_TMA 0x2000 //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 (volatileunsignedint*)0x70126ewMyirQFLunsignedintmm,y,Delaynumber,xp=255,flag,dd;kavU42VRUsunsignedintleft,right;unsignedintpulse_x,pulse_y;unsignedintpaixu[7];//排序unsignedintchdata[7];//火焰传感器检测通道unsignedintworkstate=0; //进入检测范围unsignedintsucessfire=0; //灭火成功标记voidPWM_left(unsignedinthigh_time,unsignedintcyclical_time);y6v3ALoS89voidPWM_right(unsignedinthigh_time,unsignedintcyclical_time);M2ub6vSTnPvoidforward(unsignedintm,unsignedintn);voidforward_s(unsignedintm,unsignedintn);voidforward_s2(unsignedintm,unsignedintn);voidbackward(unsignedintm,unsignedintn);voidturn_left(unsignedintm);voidturn_right(unsignedintm);voidstop(void);voidget_AD(void);//AD转换voidsystem_init(void);//系统初始化voiddelay_ms(unsignedintt);//ms级延时程序voiddelay_s(unsignedintt);//s级延时程序voi