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
   136   137   138   139   140   141   142   143   144   145   146