src/object/path_walker.cpp

   1 //  $Id$
   2 //
   3 //  SuperTux
   4 //  Copyright (C) 2006 Matthias Braun <matze@braunis.de>
   5 //
   6 //  This program is free software; you can redistribute it and/or
   7 //  modify it under the terms of the GNU General Public License
   8 //  as published by the Free Software Foundation; either version 2
   9 //  of the License, or (at your option) any later version.
  10 //
  11 //  This program is distributed in the hope that it will be useful,
  12 //  but WITHOUT ANY WARRANTY; without even the implied warranty of
  13 //  MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
  14 //  GNU General Public License for more details.
  15 //
  16 //  You should have received a copy of the GNU General Public License
  17 //  along with this program; if not, write to the Free Software
  18 //  Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
  19
  20 #include <config.h>
  21
  22 #include "path_walker.hpp"
  23
  24 #include <math.h>
  25 #include <assert.h>
  26
  27 PathWalker::PathWalker(const Path* path, bool running)
  28   : path(path), running(running), current_node_nr(0), next_node_nr(0), stop_at_node_nr(running?-1:0), node_time(0),
  29     walking_speed(1.0)
  30 {
  31   node_mult = 1 / path->nodes[0].time;
  32   next_node_nr = path->nodes.size() > 1 ? 1 : 0;
  33 }
  34
  35 PathWalker::~PathWalker()
  36 {
  37 }
  38
  39 Vector
  40 PathWalker::advance(float elapsed_time)
  41 {
  42   if (!running) return path->nodes[current_node_nr].position;
  43
  44   assert(elapsed_time >= 0);
  45
  46   elapsed_time *= fabsf(walking_speed);
  47
  48   const Path::Node* current_node = & (path->nodes[current_node_nr]);
  49   while(node_time + elapsed_time * node_mult >= 1) {
  50     elapsed_time -= (1 - node_time) / node_mult;
  51
  52     if(walking_speed > 0) {
  53       advance_node();
  54     } else if(walking_speed < 0) {
  55       goback_node();
  56     }
  57
  58     current_node = & (path->nodes[current_node_nr]);
  59     node_time = 0;
  60     if(walking_speed > 0) {
  61       node_mult = 1 / current_node->time;
  62     } else {
  63       node_mult = 1 / path->nodes[next_node_nr].time;
  64     }
  65   }
  66
  67   const Path::Node* next_node = & (path->nodes[next_node_nr]);
  68   node_time += elapsed_time * node_mult;
  69
  70   Vector new_pos = current_node->position +
  71     (next_node->position - current_node->position) * node_time;
  72
  73   return new_pos;
  74 }
  75
  76 void
  77 PathWalker::goto_node(int node_no)
  78 {
  79   if (node_no == stop_at_node_nr) return;
  80   running = true;
  81   stop_at_node_nr = node_no;
  82 }
  83
  84 void
  85 PathWalker::start_moving()
  86 {
  87   running = true;
  88   stop_at_node_nr = -1;
  89 }
  90
  91 void
  92 PathWalker::stop_moving()
  93 {
  94   stop_at_node_nr = next_node_nr;
  95 }
  96
  97
  98 void
  99 PathWalker::advance_node()
 100 {
 101   current_node_nr = next_node_nr;
 102   if (static_cast<int>(current_node_nr) == stop_at_node_nr) running = false;
 103
 104   if(next_node_nr + 1 < path->nodes.size()) {
 105     next_node_nr++;
 106     return;
 107   }
 108
 109   switch(path->mode) {
 110     case Path::ONE_SHOT:
 111       next_node_nr = path->nodes.size() - 1;
 112       walking_speed = 0;
 113       return;
 114
 115     case Path::PING_PONG:
 116       walking_speed = -walking_speed;
 117       next_node_nr = path->nodes.size() > 1 ? path->nodes.size() - 2 : 0;
 118       return;
 119
 120     case Path::CIRCULAR:
 121       next_node_nr = 0;
 122       return;
 123   }
 124
 125   // we shouldn't get here
 126   assert(false);
 127   next_node_nr = path->nodes.size() - 1;
 128   walking_speed = 0;
 129 }
 130
 131 void
 132 PathWalker::goback_node()
 133 {
 134   current_node_nr = next_node_nr;
 135
 136   if(next_node_nr > 0) {
 137     next_node_nr--;
 138     return;
 139   }
 140
 141   switch(path->mode) {
 142     case Path::PING_PONG:
 143       walking_speed = -walking_speed;
 144       next_node_nr = path->nodes.size() > 1 ? 1 : 0;
 145       return;
 146     default:
 147       break;
 148   }
 149
 150   assert(false);
 151   next_node_nr = 0;
 152   walking_speed = 0;
 153 }