blob: fe8c3e418043e54e199691f4fdf45dddfb6f83f3 (
plain) (
blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
|
/*
* CurvedElement.cc
*
* Created on: Mar 22, 2011
* Author: jakob
*/
#include <assert.h>
#include <math.h>
#include "CurvedElement.h"
namespace vhc {
using namespace std;
CurvedElement::CurvedElement(const Vector3D& entry, const Vector3D& exit, double sectionRadius, double curvature, Element* next):
Element(entry, exit, sectionRadius, next),
curvature(curvature),
curvatureCenter(Vector3D::Null) {
double k = curvature;
//pas possible que le rayon de courbure soit plus petit la moitie
//de la distance entre les points d'entree et de sortie
assert(1.0 / k >= (exit - entry).norm() / 2);
Vector3D midpoint = (getEntryPosition() + getExitPosition())/ 2;
curvatureCenter = midpoint + sqrt(1.0 - (k * k) / 4 * getDiagonal().normSquare()) * (getDiagonal().unit().cross(Vector3D::k));
}
}
|