src/libengrid/curve.cpp

   1 // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
   2 // +                                                                      +
   3 // + This file is part of enGrid.                                         +
   4 // +                                                                      +
   5 // + Copyright 2008-2014 enGits GmbH                                      +
   6 // +                                                                      +
   7 // + enGrid is free software: you can redistribute it and/or modify       +
   8 // + it under the terms of the GNU General Public License as published by +
   9 // + the Free Software Foundation, either version 3 of the License, or    +
  10 // + (at your option) any later version.                                  +
  11 // +                                                                      +
  12 // + enGrid is distributed in the hope that it will be useful,            +
  13 // + but WITHOUT ANY WARRANTY; without even the implied warranty of       +
  14 // + MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the        +
  15 // + GNU General Public License for more details.                         +
  16 // +                                                                      +
  17 // + You should have received a copy of the GNU General Public License    +
  18 // + along with enGrid. If not, see <http://www.gnu.org/licenses/>.       +
  19 // +                                                                      +
  20 // ++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++++
  21 //
  22 #include "curve.h"
  23
  24 mat3_t Curve::computeBase(double l, Curve* curve)
  25 {
  26   vec3_t g3 = normal(l);
  27   g3.normalise();
  28   vec3_t g1 = curve->position(l) - position(l);
  29   g1.normalise();
  30   vec3_t g2 = g3.cross(g1);
  31   g2.normalise();
  32   mat3_t A;
  33   clinit(A) = g1, g2, g3;
  34   return A.transp();
  35 }
  36
  37 mat3_t Curve::computeOrthoBase(double l, Curve *curve)
  38 {
  39   vec3_t g3 = normal(l);
  40   g3.normalise();
  41   vec3_t x = position(l);
  42   vec3_t x_curve = curve->intersection(x, g3);
  43   vec3_t g1 = x_curve - x;
  44   g1.normalise();
  45   vec3_t g2 = g3.cross(g1);
  46   g2.normalise();
  47   mat3_t A;
  48   clinit(A) = g1, g2, g3;
  49   return A.transp();
  50 }