/*
    openDCM, dimensional constraint manager
    Copyright (C) 2012  Stefan Troeger <stefantroeger@gmx.net>

    This library is free software; you can redistribute it and/or modify
    it under the terms of the GNU Lesser General Public License as published by
    the Free Software Foundation; either version 2.1 of the License, or
    (at your option) any later version.

    This library 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 Lesser General Public License for more details.

    You should have received a copy of the GNU Lesser General Public License along
    with this library; if not, write to the Free Software Foundation, Inc.,
    51 Franklin Street, Fifth Floor, Boston, MA 02110-1301 USA.
*/

#ifndef GCM_GEOMETRY_3D_H
#define GCM_GEOMETRY_3D_H

#include <opendcm/core/geometry.hpp>

namespace dcm {
namespace tag {

struct point3D  {
    typedef mpl::int_<3>  parameters;
    typedef mpl::int_<1>  rotations;
    typedef mpl::int_<1>  translations;
    typedef weight::point weight; 
};

struct direction3D  {
    typedef mpl::int_<3>  parameters;
    typedef mpl::int_<1>  rotations;
    typedef mpl::int_<0>  translations;
    typedef weight::direction weight; 
};

struct line3D  {
    typedef mpl::int_<6> parameters;
    typedef mpl::int_<2> rotations;
    typedef mpl::int_<1> translations;
    typedef weight::line weight; 
};

struct plane3D  {
    typedef mpl::int_<6>  parameters;
    typedef mpl::int_<2>  rotations;
    typedef mpl::int_<1>  translations;
    typedef weight::plane weight; 
};

struct cylinder3D  {
    typedef mpl::int_<7>  parameters;
    typedef mpl::int_<2>  rotations;
    typedef mpl::int_<1>  translations;
    typedef weight::cylinder weight; 
};
}

namespace modell {
  
  struct XYZ {
    /*Modell XYZ: 
     * 0 = X;
     * 1 = Y;
     * 2 = Z;
     */    
    template<typename Scalar, typename Accessor, typename Vector, typename Type>
    void extract(Type& t, Vector& v) {
      Accessor a;
      v(0) = a.template get<Scalar, 0>(t);
      v(1) = a.template get<Scalar, 1>(t);
      v(2) = a.template get<Scalar, 2>(t);
    }
    
    template<typename Scalar, typename Accessor, typename Vector, typename Type>
    void inject(Type& t, Vector& v) {
      Accessor a;
      a.template set<Scalar, 0>(v(0), t);
      a.template set<Scalar, 1>(v(1), t);
      a.template set<Scalar, 2>(v(2), t);
    };
  };
  
  struct XYZ2 {
    /*Modell XYZ2: two xyz parts after each other 
     * 0 = X;
     * 1 = Y;
     * 2 = Z;
     * 3 = X dir;
     * 4 = Y dir;
     * 5 = Z dir;
     */    
    template<typename Scalar, typename Accessor, typename Vector, typename Type>
    void extract(Type& t, Vector& v) {
      Accessor a;
      v(0) = a.template get<Scalar, 0>(t);
      v(1) = a.template get<Scalar, 1>(t);
      v(2) = a.template get<Scalar, 2>(t);
      v(3) = a.template get<Scalar, 3>(t);
      v(4) = a.template get<Scalar, 4>(t);
      v(5) = a.template get<Scalar, 5>(t);
    }
    
    template<typename Scalar, typename Accessor, typename Vector, typename Type>
    void inject(Type& t, Vector& v) {
      Accessor a;
      a.template set<Scalar, 0>(v(0), t);
      a.template set<Scalar, 1>(v(1), t);
      a.template set<Scalar, 2>(v(2), t);
      a.template set<Scalar, 3>(v(3), t);
      a.template set<Scalar, 4>(v(4), t);
      a.template set<Scalar, 5>(v(5), t);
    };
  };
  
  struct XYZ2P {
    /*Modell XYZ2P: two xyz parts after each other and one parameter
     * 0 = X;
     * 1 = Y;
     * 2 = Z;
     * 3 = X dir;
     * 4 = Y dir;
     * 5 = Z dir;
     * 6 = Parameter
     */    
    template<typename Scalar, typename Accessor, typename Vector, typename Type>
    void extract(Type& t, Vector& v) {
      Accessor a;
      v(0) = a.template get<Scalar, 0>(t);
      v(1) = a.template get<Scalar, 1>(t);
      v(2) = a.template get<Scalar, 2>(t);
      v(3) = a.template get<Scalar, 3>(t);
      v(4) = a.template get<Scalar, 4>(t);
      v(5) = a.template get<Scalar, 5>(t);
      v(6) = a.template get<Scalar, 6>(t);
    }
    
    template<typename Scalar, typename Accessor, typename Vector, typename Type>
    void inject(Type& t, Vector& v) {
      Accessor a;
      a.template set<Scalar, 0>(v(0), t);
      a.template set<Scalar, 1>(v(1), t);
      a.template set<Scalar, 2>(v(2), t);
      a.template set<Scalar, 3>(v(3), t);
      a.template set<Scalar, 4>(v(4), t);
      a.template set<Scalar, 5>(v(5), t);
      a.template set<Scalar, 6>(v(6), t);
    };
  };
  
}

}

#endif //GCM_GEOMETRY_3D_H