Subversion Repositories gelsvn

Rev

Go to most recent revision | Details | Last modification | View Log | RSS feed

Rev Author Line No. Line
39 bj 1 
#include <iostream>
2 
 
3 
#include "QEM.h"
4 
#include "LinAlg/LapackFunc.h"
220 jab 5 
#include <gsl/gsl_matrix.h>
6 
#include <gsl/gsl_linalg.h>
39 bj 7 
 
8 
using namespace LinAlg;
9 
using namespace CGLA;
10 
using namespace std;
11 
 
12 
namespace Geometry
13 
{
214 jab 14 
	Vec3d QEM::opt_pos(double sv_thresh) const
39 bj 15 
	{
220 jab 16 
			// FIX ME - NOT CLEAR WHAT HAPPENS IN UNDERDETERMINDED CASE.
17 
			CMatrix A_num(A);
18 
			CVector b_num(b);
19 
			CVector x(3);
20 
			x = LinearLSSolve(A,b);
21 
			Vec3d p(-x[0], -x[1], -x[2]);
22 
			return p;
23 
	}
39 bj 24 
 
25 
}