Vec2d.h

Go to the documentation of this file.

//    Copyright 2004, SenseGraphics AB
//
//    This file is part of H3D API.
//
//    H3D API 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.
//
//    H3D API 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 H3D API; if not, write to the Free Software
//    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
//
//    A commercial license is also available. Please contact us at 
//    www.sensegraphics.com for more information.
//
//
//

#ifndef __VEC2D_H__
#define __VEC2D_H__

#include "H3DApi.h"
#include "H3DBasicTypes.h"
#include "H3DMath.h"
#include "H3DTemplateOperators.h"
#include "Exception.h"
#include "Vec2f.h" 

namespace H3D {
  namespace ArithmeticTypes {
    struct H3DAPI_API Vec2d {
      H3D_API_EXCEPTION( Vec2dNormalizeError );
      
      Vec2d(): x(0.0), y(0.0) {}

      Vec2d( H3DDouble _x,
             H3DDouble _y ) : x(_x), y(_y) {}
                                                
      Vec2d( const Vec2f &v ): x( v.x ), y( v.y ) {}

      inline H3DDouble dotProduct( const Vec2d &v ) const {
        return x*v.x + y*v.y;
      }
      
      inline H3DDouble &operator[]( int i ) { 
        if( i == 0 ) return x;
        if( i == 1 ) return y;
        
        throw Exception::H3DAPIException( "Invalid index", 
                                          H3D_FULL_LOCATION );
      }

      inline const H3DDouble &operator[]( int i ) const { 
        if( i == 0 ) return x;
        if( i == 1 ) return y;
        
        throw Exception::H3DAPIException( "Invalid index", 
                                          H3D_FULL_LOCATION );
      }

      inline void normalize() {
        H3DDouble l2 = x*x+y*y;
        // if the length already is 1 we don't have to do anything
        if( H3DAbs(l2-1) > Constants::d_epsilon ) {
          H3DDouble l = H3DSqrt( l2 );
          if( H3DAbs(l) < Constants::d_epsilon ) {
            string s = "Trying to normalize zero length Vec2d.";
            throw Vec2dNormalizeError( s );
          } else {
            x /= l; 
            y /= l;
          }
        }
      }
      
      inline void normalizeSafe() {
        H3DDouble l2 = x*x+y*y;
        // if the length already is 1 we don't have to do anything
        if( H3DAbs(l2-1) > Constants::d_epsilon ) {
          H3DDouble l = H3DSqrt( l2 );
          if( H3DAbs(l) >= Constants::d_epsilon ) {
            x /= l; 
            y /= l;
          }
        }
      }

      inline H3DDouble lengthSqr() {
        return x*x + y*y;
      }
      
      inline H3DDouble length() {
        return H3DSqrt( x*x + y*y );
      }
      
      H3DDouble x, y;
    };
    
                                
    inline ostream& operator<<( ostream &os, const Vec2d &v ) {
      os << v.x << " " << v.y;
      return os;
    } 

    inline bool operator==( const Vec2d &v1, const Vec2d &v2 ) {
      return v1.x == v2.x && v1.y == v2.y;
    }
    inline Vec2d operator+( const Vec2d &v1, const Vec2d &v2 ) {
      return Vec2d( v1.x + v2.x, v1.y + v2.y );
    }
    inline Vec2d operator*( const Vec2d &v, const double &d ) {
      return Vec2d( v.x * d, v.y * d );
    }

    inline H3DDouble operator*( const Vec2d &v1, const Vec2d &v2 ) {
      return v1.dotProduct( v2 );
    }

    inline Vec2d operator*( const double &a, const Vec2d &b ) { return b * a; }
    
    inline Vec2d operator-( const Vec2d &b ) { return b * (double)-1; }

    inline Vec2d operator-( const Vec2d &a, const Vec2d &b ) { return a + (-b); }
                                
    // \}

  }
}

#endif

---