// goto_simple.cc // nono - programme du robot 2004. {{{ // // Copyright (C) 2004 Nicolas Schodet // // Robot APB Team/Efrei 2004. // Web: http://assos.efrei.fr/robot/ // Email: robot AT efrei DOT fr // // This program is free software; you can redistribute it and/or modify // it under the terms of the GNU General Public License as published by // the Free Software Foundation; either version 2 of the License, or // (at your option) any later version. // // This program is distributed in the hope that it will be useful, // but WITHOUT ANY WARRANTY; without even the implied warranty of // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the // GNU General Public License for more details. // // You should have received a copy of the GNU General Public License // along with this program; if not, write to the Free Software // Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. // // }}} #include "goto_simple.h" /// Constructeur. /// (dx, dy) : position d'arrivée (mm). GotoSimple::GotoSimple (double dx, double dy) : dx_ (dx), dy_ (dy) { } /// Fournit la distance au point final (mm) et renvois false si le Goto est /// fini. /// eps: distance (mm) en dessous de laquelle on considère que la /// destination est atteinte. bool GotoSimple::getDistance (const Tracker &t, double &dist, double eps) { dist = t.getDistance (dx_, dy_); return dist > eps; } /// Fournit le point le plus loin à moins de dist (mm). void GotoSimple::getPoint (const Tracker &t, double &dx, double &dy, double dist) { dx = dx_; dy = dy_; }