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
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
106
107
108
109
110
111
112
113
114
115
116
117
118
119
120
121
122
123
124
125
126
127
|
/*=========================================================================
Program: Insight Segmentation & Registration Toolkit
Module: $RCSfile: itkFourierSeriesPath.txx,v $
Language: C++
Date: $Date: 2006-11-09 14:23:29 $
Version: $Revision: 1.8 $
Copyright (c) Insight Software Consortium. All rights reserved.
See ITKCopyright.txt or http://www.itk.org/HTML/Copyright.htm for details.
This software is distributed WITHOUT ANY WARRANTY; without even
the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
PURPOSE. See the above copyright notices for more information.
=========================================================================*/
#ifndef __itkFourierSeriesPath_txx
#define __itkFourierSeriesPath_txx
#include "itkFourierSeriesPath.h"
#include <math.h>
namespace itk
{
template<unsigned int VDimension>
typename FourierSeriesPath<VDimension>::OutputType
FourierSeriesPath<VDimension>
::Evaluate( const InputType & input ) const
{
InputType theta;
OutputType output;
int numHarmonics;
numHarmonics = m_CosCoefficients->Size();
output.Fill(0);
const double PI = 4.0 * atan( 1.0 );
if( numHarmonics > 0 ) { output += m_CosCoefficients->ElementAt(0); }
for(int n=1; n<numHarmonics; n++)
{
// input defined over [0,1] maps to theta defined over [0,2pi * n]
theta = PI * 2.0 * n * input;
output += ( m_CosCoefficients->ElementAt(n) * vcl_cos(theta) +
m_SinCoefficients->ElementAt(n) * vcl_sin(theta) ) * 2.0;
}
return output;
}
template<unsigned int VDimension>
typename FourierSeriesPath<VDimension>::VectorType
FourierSeriesPath<VDimension>
::EvaluateDerivative(const InputType & input) const
{
InputType theta;
VectorType output;
int numHarmonics;
numHarmonics = m_CosCoefficients->Size();
output.Fill(0);
const double PI = 4.0 * atan( 1.0 );
for(int n=1; n<numHarmonics; n++)
{
// input defined over [0,1] maps to theta defined over [0,2pi * n]
theta = PI * 2.0 * n * input;
output += ( m_SinCoefficients->ElementAt(n) * vcl_cos(theta) -
m_CosCoefficients->ElementAt(n) * vcl_sin(theta) ) * (2.0 * n);
}
return output;
}
template<unsigned int VDimension>
void
FourierSeriesPath<VDimension>
::AddHarmonic( const VectorType & CosCoefficients,
const VectorType & SinCoefficients )
{
unsigned int numHarmonics = m_CosCoefficients->Size();
m_CosCoefficients->InsertElement(numHarmonics, CosCoefficients);
m_SinCoefficients->InsertElement(numHarmonics, SinCoefficients);
this->Modified();
}
/**
* Constructor
*/
template <unsigned int VDimension>
FourierSeriesPath<VDimension>
::FourierSeriesPath()
{
this->SetDefaultInputStepSize( 1.0/50.0 );
m_CosCoefficients = CoefficientsType::New();
m_SinCoefficients = CoefficientsType::New();
}
/**
* Standard "PrintSelf" method
*/
template <unsigned int VDimension>
void
FourierSeriesPath<VDimension>
::PrintSelf( std::ostream& os, Indent indent) const
{
Superclass::PrintSelf( os, indent );
os << indent << "Cos Coefficients: " << m_CosCoefficients << std::endl;
os << indent << "Sin Coefficients: " << m_SinCoefficients << std::endl;
}
} // end namespaceitk
#endif
|
