《国际标准灭火机器人比赛程序》由会员分享,可在线阅读,更多相关《国际标准灭火机器人比赛程序(16页珍藏版)》请在金锄头文库上搜索。
1、/全部完成灭火程序 ,此速度可以跑斜坡,但灭不了火#include MF12_LIB.h /*头文件定义,请勿删除*/#define have 1#define no 0#define surf 1300#define surb 1300 #define fire1 400#define fire2 400#define fire3 400#define fire4 400#define surfu 40#define surbu 40int i=0;int a=0;float fv=0.0;float time=0.0;float time1=0.0;float time2=0.0;int
2、eye=0;int DI(int i) if(AI(i)50) run(60,100); else if(AI_EYE(0,6)-AI_EYE(0,4)50) run(100,60); else run(100,100); else if(eye0=4) run(40,100); else if(eye0=6) run(100,40); else if(eye0=3) run(50,100); else if(eye0=7) run(100,50); else if(eye0=2) run(20,100); else if(eye0=8) run(100,20); else if(eye0=1) run(0,100); else if(eye0=9) run(100,0); else if(eye0=0) run(-10,100); else run(100,-10);void gofireb() /反向找火 int eye1; eye1=EyeChMaxEx(EYE_1); if(eye1=5) if(AI_EYE(1,4)-AI_EYE(1,6)50) run