Page 141 - 최강 아두이노 스마트 자동차 로봇 키트
P. 141
//
int choosedDir;
int getMax()
{
int retMax=center;
if(center<left)
{
retMax=left;
}
if(retMax<right)
{
retMax=right;
}
return retMax;
}
//
int getProperDir()
{
int chooseDir=DIR_DISC_CENTER;
// get max distance.
int compareDist=getMax();
if(compareDist==left)
chooseDir=DIR_DISC_LEFT;
if(compareDist==right)
chooseDir=DIR_DISC_RIGHT;
//
if(compareDist==center)
chooseDir=DIR_DISC_CENTER;
// return value.
return chooseDir;
}
}; // end of struct DistanceDir
140