亮宁机器人套件_亮宁机器人编程-实例

#include &ltLNDZ.h&gt

int ll,l,m,r,rr,n;

void findline()

{

ll=AR(4)&lt617;

l=AR(2)&lt654;

m=AR(1)&lt598;

r=AR(3)&lt549;

rr=AR(5)&lt644;

n=ll+l+m+r+rr;

if (ll==0) motor (-30,30);

else if (l==0) motor (0,30);

else if (m==0) motor (30,30);

else if (r==0) motor (30,0);

else if (rr==0) motor (30,-30);

}

void init()

{

B_start();//启动按钮

motor (30,30);

delay(150);

while(1)

{

findline();

if (n&lt2)

{motor (40,40);

beep(150);

break;

}

}

while(2)

{

findline();

if (m+r+rr==0||m+rr==0||r+rr==0)

{

motor(40,0);

beep(200);

break;

}

}

while(3)

{

findline();

if (l+r==0||ll+rr==0||m+rr==0||ll+m==0)

{

motor(40,0);

beep(200);

break;

}

}

while(4)

{

findline();

if (m+rr==0||l+r==0||rr+r==0)

{

motor(40,0);

beep(200);

break;

}

}

while(5)

{findline();

if (n&lt2)

{motor(0,0);

break;

}

}

}

void repeat()

{

}