黄线:AP
绿线:BP
顺时针:1) 绿线bp==1 ap==0 2)绿线bp==0 ap==1
逆时针:1)绿线bp==1 ap==0 2)绿线bp==0 ap==1
if (Read_B() )
{
if( !Read_A() )
{
Dir = 0;
}
else
{
Dir = 1;
}
}
else
{
if( Read_A() )
{
Dir = 0;
}
else
{
Dir = 1;
}
}