Subversion Repositories gelsvn

Rev

Rev 39 | Rev 220 | Go to most recent revision | Show entire file | Ignore whitespace | Details | Blame | Last modification | View Log | RSS feed

Rev 39 Rev 214
Line 7... Line 7...
7 
using namespace CGLA;
 7 
using namespace CGLA;
8 
using namespace std;
 8 
using namespace std;
9 
 
 9 
 
10 
namespace Geometry
 10 
namespace Geometry
11 
{
 11 
{
12 
	Vec3f QEM::opt_pos(double sv_thresh) const
 12 
	Vec3d QEM::opt_pos(double sv_thresh) const
13 
	{
 13 
	{
14 
		CMatrix A_num(A);
 14 
		CMatrix A_num(A);
15 
		CVector b_num(b);
 15 
		CVector b_num(b);
16 
 
 16 
 
17 
		CMatrix U;
 17 
		CMatrix U;
Line 28... Line 28...
28
28
29 
		CMatrix A_inv = (V * s) * U;
 29 
		CMatrix A_inv = (V * s) * U;
30 
 
 30 
 
31 
		CVector x(3);
 31 
		CVector x(3);
32 
		x = A_inv * b_num;
 32 
		x = A_inv * b_num;
33 
		Vec3f p(-x[0], -x[1], -x[2]);
 33 
		Vec3d p(-x[0], -x[1], -x[2]);
34 
		if(s[0] == 0)
 34 
		if(s[0] == 0)
35 
			{
 35 
			{
36 
				cout << A << b << s << U << V << endl;
 36 
				cout << A << b << s << U << V << endl;
37 
			}
 37 
			}
38
- 
 
39 
 
 - 
 
40 
		return p;
 38 
		return p;
41 
	}
 39 
	}
42 
}
 40 
}