waypoint.cpp

Go to the documentation of this file.

#include "waypoint.h"
 
#include <cmath>
#include <cstring>
#include <cctype>
 
using namespace Tempest;
 
static std::string upcaseof(std::string_view src) {
  auto ret = std::string(src);
  for(auto& i:ret)
    i=char(std::toupper(i));
  return ret;
  }
 
WayPoint::WayPoint() {
  }
 
WayPoint::WayPoint(const zenkit::WayPoint &dat)
  : pos(dat.position.x, dat.position.y, dat.position.z),
    dir(dat.direction.x, dat.direction.y, dat.direction.z),
    underWater(dat.under_water),
    name(upcaseof(dat.name)) {
  }
 
WayPoint::WayPoint(const Vec3& pos, std::string_view name)
  :pos(pos),freePoint(true),name(upcaseof(name)){
  }
 
WayPoint::WayPoint(const Vec3& pos, const Vec3& dir, std::string_view name, bool isFp)
  :pos(pos), dir(dir), freePoint(isFp), name(upcaseof(name)){
  }
 
bool WayPoint::isFreePoint() const {
  return freePoint;
  }
 
bool WayPoint::isConnected() const {
  return conn.size()>0;
  }
 
bool WayPoint::checkName(std::string_view n, bool inexact) const {
  if(n.empty())
    return false;
  if(name==n)
    return true;
  if(inexact && name.find(n)!=std::string::npos)
    return true;
  return false;
  }
 
Vec3 WayPoint::position() const {
  return pos;
  }
 
Vec3 WayPoint::direction() const {
  return dir;
  }
 
float WayPoint::qDistTo(float ix, float iy, float iz) const {
  float dx = pos.x-ix;
  float dy = pos.y-iy;
  float dz = pos.z-iz;
  return dx*dx+dy*dy+dz*dz;
  }
 
void WayPoint::connect(WayPoint &w) {
  int32_t l = int32_t(std::sqrt(qDistTo(w.pos.x,w.pos.y,w.pos.z)));
  if(l<=0)
    return;
  Conn c;
  c.point = &w;
  c.len   = l;
  conn.push_back(c);
  }
 
bool WayPoint::hasLadderConn(const WayPoint* w) const {
  if(w!=nullptr && w->ladder!=nullptr && w->ladder==ladder)
    return true;
  return false;
  }