机器人灭火程序~
***************************/
/**wanghm@grandar.com ** wanghm35@163.com *********/
/** ************************************/
/** ***********************************************/
#include "ASMF09LIB.h" /*头文件定义,请勿删除*/
int mic_1=0;
int gi_1=0;
int gi_2=0;
int gi_3=0;
int gi_4=0;
int gi_5=0;
int gi_6=0;
int gi_7=0;
int gi_8=0;
int gi_9=0;
int gi_10=0;
int gi_15=0;/*哪个房间有火的标记:四号有4,三号有3,二号有2,一号有1*/
int gi_15_4=1023,gi_15_3=1023,gi_15_2=1023,gi_15_1=1023;/*每个房门的火焰值*/
int ma_1=0;int ma_2=0;int ma_3=0;int ma_4=0;int ma_5=0;int ma_6=0;int ma_7=0;int ma_8=0;int ma_9=0;
int ma_10=0;
int micc=0;
int Cutfire=0;
float gf_1=0.0;
int i=0;
int aa14,aa13,aa12;
void DO(int CHANNEL,int STATE)
{ CHANNEL=CHANNEL;
SetDO(1,STATE);
}
void LeftWay_B( )/*沿左墙B*/
{
ma_4 = AI(3);
ma_5 = AI(4);
if((ma_4 > gi_9) && (ma_5 < ma_10))
{
SetMotor(0x1111,(int)(-100*gf_1),(int)(-100*gf_1),0,0);
}
else
{
if((ma_4 > gi_9) && (ma_5 > ma_10))
{
if(ma_5 > 450)
{
SetMotor(0x1111,(int)(-28*gf_1),(int)(28*gf_1),0,0);
}
else
{
SetMotor(0x1111,(int)(-80*gf_1),(int)(10*gf_1),0,0);
}
}
else
{
SetMotor(0x1111,(int)(-28*gf_1),(int)(-100*gf_1),0,0);
}
}
//wait( 0.001000 );
}
void LeftWay_low( ) /*沿左墙:慢速*/
{
ma_1 = AI(0);
ma_2 = AI(1);
if((ma_1 > gi_9) && (ma_2 < ma_10))
{
SetMotor(0x1111,(int)(75*gf_1),(int)(75*gf_1),0,0);
}
else
{
if((ma_1 > gi_9) && (ma_2 > ma_10))
{
if(ma_2 > 350)
{
SetMotor(0x1111,(int)(-28*gf_1),(int)(28*gf_1),0,0);
}
else
{
SetMotor(0x1111,(int)(-30*gf_1),(int)(80*gf_1),0,0);
}
}
else
{
SetMotor(0x1111,(int)(100*gf_1),(int)(33*gf_1),0,0);
}
}
//wait( 0.001000 );
}
void LeftWay( ) /*沿左墙*/
{
ma_1 = AI(0);
ma_2 = AI(1);
if((ma_1 > gi_9) && (ma_2 < ma_10))
{
SetMotor(0x1111,(int)(100*gf_1),(int)(100*gf_1),0,0);
}
else
{
if((ma_1 > gi_9) && (ma_2 > ma_10))
{
if(ma_2 > 350)
{
SetMotor(0x1111,(int)(-28*gf_1),(int)(28*gf_1),0,0);
}
else
{
SetMotor(0x1111,(int)(-20*gf_1),(int)(80*gf_1),0,0);
}
}
else
{
SetMotor(0x1111,(int)(100*gf_1),(int)(23*gf_1),0,0);
}
}
//wait( 0.001000 );
}
void LeftWay_24( ) /*沿左墙:沿2号外墙准备去4号*/
{
ma_1 = AI(0);
ma_2 = AI(1);
if((ma_1 > gi_9) && (ma_2 < ma_10))
{
//if(( ma_1 >450) && (ma_1 < 500)){SetMotor(0x1111,(int)(100*gf_1),(int)(90*gf_1),0,0);}
//else if(ma_1 > 500){SetMotor(0x1111,(int)(100*gf_1),(int)(100*gf_1),0,0);}
//else{SetMotor(0x1111,(int)(100*gf_1),(int)(60*gf_1),0,0);}
if((ma_1-AI(5))>20){SetMotor(0x1111,(int)(60*gf_1),(int)(100*gf_1),0,0);}
else if((ma_1-AI(5))<-20){SetMotor(0x1111,(int)(100*gf_1),(int)(60*gf_1),0,0);}
else{SetMotor(0x1111,(int)(100*gf_1),(int)(100*gf_1),0,0);}
}
else
{
if((ma_1 > gi_9) && (ma_2 > ma_10))
{
if(ma_2 > 350)
{
SetMotor(0x1111,(int)(-28*gf_1),(int)(28*gf_1),0,0);
}
else
{
SetMotor(0x1111,(int)(-25*gf_1),(int)(80*gf_1),0,0);
}
}
else
{
SetMotor(0x1111,(int)(100*gf_1),(int)(33*gf_1),0,0);
}
}
//wait( 0.001000 );
}
void LeftWay_4m( ) /*沿左墙_四号进门前*/
{
ma_1 = AI(0);
ma_2 = AI(1);
if((ma_1 > gi_9) && (ma_2 < ma_10))
{
SetMotor(0x1111,(int)(100*gf_1),(int)(100*gf_1),0,0);
}
else
{
if((ma_1 > gi_9) && (ma_2 > ma_10))
{
if(ma_2 > 350)
{
SetMotor(0x1111,(int)(-28*gf_1),(int)(28*gf_1),0,0);
}
else
{
SetMotor(0x1111,(int)(-20*gf_1),(int)(80*gf_1),0,0);
}
}
else
{
SetMotor(0x1111,(int)(100*gf_1),(int)(33*gf_1),0,0);
}
}
//wait( 0.001000 );
}
void RightWay( )/*沿右墙*/
{
ma_2 = AI(1);
ma_3 = AI(2);
if((ma_3 > gi_9) && (ma_2 < ma_10))
{
SetMotor(0x1111,(int)(100*gf_1),(int)(100*gf_1),0,0);
}
else
{
if((ma_2 > ma_10) && (ma_3 > gi_9))
{
if(ma_2 > 330)
{
SetMotor(0x1111,(int)(28*gf_1),(int)(-28*gf_1),0,0);
http://image.baidu.com/i?ct=201326592&cl=2&lm=-1&tn=baiduimage&pv=&word=%C3%F0%BB%F0%BB%FA%C6%F7%C8%CB&z=0
看看有没有你想要的?
#18316201556#
2011年武汉市黄陂区社保最低基数 - ******
#薄泪#2011年仍延用2010年7月1日推出的标准,养老最低1666元,医疗及工伤、失业、生育最低基数为1621.44元. 具体计算如下: 养老保险 企业缴费比例为20%, 1666*20%=333.2
#18316201556#
国产奶粉哪个牌子最好?因为进口奶质量越来差!所以我还是宁愿相信国产奶粉 - ******
#薄泪# 我家宝宝在吃旭贝尔,感觉挺不错的.以前宝宝不喜欢吃奶粉,换了旭贝尔就好多.配方接近母乳,口味清淡,对宝宝肠胃刺激小,宝宝断奶或者转...