Go to the documentation of this file.00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013
00014
00015
00016
00017
00018
00019
00020 #include "conditionalgaussian.h"
00021 #include <cmath>
00022 #include "../wrappers/rng/rng.h"
00023
00024 namespace BFL
00025 {
00026 using namespace MatrixWrapper;
00027
00028 ConditionalGaussian::ConditionalGaussian(int dim,
00029 int num_conditional_arguments)
00030 : ConditionalPdf<ColumnVector,ColumnVector>(dim, num_conditional_arguments)
00031 , _diff(dim)
00032 , _Mu(dim)
00033 , _Low_triangle(dim,dim)
00034 , _samples(dim)
00035 , _SampleValue(dim)
00036 {}
00037
00039 ConditionalGaussian::~ConditionalGaussian(){}
00040
00041
00042 ConditionalGaussian* ConditionalGaussian::Clone() const
00043 {
00044 return new ConditionalGaussian(*this);
00045 }
00046
00047 Probability
00048 ConditionalGaussian::ProbabilityGet(const ColumnVector& input) const
00049 {
00050
00051 _Mu = ExpectedValueGet();
00052 _diff = input - _Mu;
00053
00054 Probability temp = _diff.transpose() * (ColumnVector)(CovarianceGet().inverse() * _diff);
00055 Probability result = exp(-0.5 * temp) / sqrt(pow(M_PI*2,(double)DimensionGet()) * CovarianceGet().determinant());
00056 return result;
00057 }
00058
00059 bool
00060 ConditionalGaussian::SampleFrom (vector<Sample<ColumnVector> >& samples, const int num_samples, int method, void * args) const
00061 {
00062 return Pdf<ColumnVector>::SampleFrom(samples, num_samples, method, args);
00063 }
00064
00065 bool
00066 ConditionalGaussian::SampleFrom (Sample<ColumnVector>& sample, int method, void * args) const
00067 {
00068
00069
00070
00071
00072
00073
00074
00075 _Mu = ExpectedValueGet();
00076
00077 switch(method)
00078 {
00079 case DEFAULT:
00080 {
00081 bool result = CovarianceGet().cholesky_semidefinite(_Low_triangle);
00082 for (unsigned int j=1; j < DimensionGet()+1; j++){_samples(j) = rnorm(0,1);}
00083 _SampleValue = (_Low_triangle * _samples) + _Mu;
00084 sample.ValueSet(_SampleValue);
00085 return result;
00086 }
00087 case BOXMULLER:
00088 {
00089 cerr << "Box-Muller not implemented yet!" << endl;
00090 return false;
00091 }
00092 case CHOLESKY:
00093 {
00094 bool result = CovarianceGet().cholesky_semidefinite(_Low_triangle);
00095
00096
00097
00098
00099
00100
00101
00102
00103
00104 for (unsigned int j=1; j < DimensionGet()+1; j++) _samples(j) = rnorm(0,1);
00105 _SampleValue = (_Low_triangle * _samples) + _Mu;
00106 sample.ValueSet(_SampleValue);
00107 return result;
00108 }
00109 default:
00110 cerr << "Conditional Gaussian: Sampling method " << method
00111 << "not implemented yet!" << endl;
00112 return false;
00113 }
00114 }
00115
00116 }
bfl
Author(s): Klaas Gadeyne, Wim Meeussen, Tinne Delaet and many others. See web page for a full contributor list. ROS package maintained by Wim Meeussen.
autogenerated on Thu Feb 11 2016 22:31:56