simgear/math/SGLineSegment.hxx

   1 // Copyright (C) 2006  Mathias Froehlich - Mathias.Froehlich@web.de
   2 //
   3 // This library is free software; you can redistribute it and/or
   4 // modify it under the terms of the GNU Library General Public
   5 // License as published by the Free Software Foundation; either
   6 // version 2 of the License, or (at your option) any later version.
   7 //
   8 // This library is distributed in the hope that it will be useful,
   9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
  10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
  11 // Library General Public License for more details.
  12 //
  13 // You should have received a copy of the GNU General Public License
  14 // along with this program; if not, write to the Free Software
  15 // Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
  16 //
  17
  18 #ifndef SGLineSegment_H
  19 #define SGLineSegment_H
  20
  21 template<typename T>
  22 class SGLineSegment {
  23 public:
  24   SGLineSegment()
  25   { }
  26   SGLineSegment(const SGVec3<T>& start, const SGVec3<T>& end) :
  27     _start(start),
  28     _direction(end - start)
  29   { }
  30   template<typename S>
  31   explicit SGLineSegment(const SGLineSegment<S>& lineSegment) :
  32     _start(lineSegment.getStart()),
  33     _direction(lineSegment.getDirection())
  34   { }
  35
  36   void set(const SGVec3<T>& start, const SGVec3<T>& end)
  37   { _start = start; _direction = end - start; }
  38
  39   const SGVec3<T>& getStart() const
  40   { return _start; }
  41   SGVec3<T> getEnd() const
  42   { return _start + _direction; }
  43   const SGVec3<T>& getDirection() const
  44   { return _direction; }
  45   SGVec3<T> getNormalizedDirection() const
  46   { return normalize(getDirection()); }
  47
  48   SGVec3<T> getCenter() const
  49   { return _start + T(0.5)*_direction; }
  50
  51   SGLineSegment<T> transform(const SGMatrix<T>& matrix) const
  52   {
  53     SGLineSegment<T> lineSegment;
  54     lineSegment._start = matrix.xformPt(_start);
  55     lineSegment._direction = matrix.xformVec(_direction);
  56     return lineSegment;
  57   }
  58
  59 private:
  60   SGVec3<T> _start;
  61   SGVec3<T> _direction;
  62 };
  63
  64 /// Output to an ostream
  65 template<typename char_type, typename traits_type, typename T>
  66 inline
  67 std::basic_ostream<char_type, traits_type>&
  68 operator<<(std::basic_ostream<char_type, traits_type>& s,
  69            const SGLineSegment<T>& lineSegment)
  70 {
  71   return s << "line segment: start = " << lineSegment.getStart()
  72            << ", end = " << lineSegment.getEnd();
  73 }
  74
  75 #endif