khanat-code-old/code/nel/tools/3d/object_viewer/basis_edit.cpp
2014-06-12 19:27:09 +02:00

338 lines
8.3 KiB
C++

// NeL - MMORPG Framework <http://dev.ryzom.com/projects/nel/>
// Copyright (C) 2010 Winch Gate Property Limited
//
// This program is free software: you can redistribute it and/or modify
// it under the terms of the GNU Affero General Public License as
// published by the Free Software Foundation, either version 3 of the
// License, or (at your option) any later version.
//
// This program is distributed in the hope that it will be useful,
// but WITHOUT ANY WARRANTY; without even the implied warranty of
// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
// GNU Affero General Public License for more details.
//
// You should have received a copy of the GNU Affero General Public License
// along with this program. If not, see <http://www.gnu.org/licenses/>.
#include "std_afx.h"
#include "object_viewer.h"
#include "basis_edit.h"
#include "nel/misc/matrix.h"
#include "nel/misc/vector.h"
/////////////////////////////////////////////////////////////////////////////
// CBasisEdit dialog
CBasisEdit::CBasisEdit(CWnd* pParent /*=NULL*/)
{
//{{AFX_DATA_INIT(CBasisEdit)
m_Psi = 0;
m_Theta = 0;
m_Phi = 0;
//}}AFX_DATA_INIT
}
void CBasisEdit::DoDataExchange(CDataExchange* pDX)
{
CDialog::DoDataExchange(pDX);
//{{AFX_DATA_MAP(CBasisEdit)
DDX_Control(pDX, IDC_PHI_SCROLLBAR, m_PhiCtrl);
DDX_Control(pDX, IDC_PSI_SCROLLBAR, m_PsiCtrl);
DDX_Control(pDX, IDC_THETA_SCROLLBAR, m_ThetaCtrl);
DDX_Text(pDX, IDC_PSI_VALUE, m_Psi);
DDX_Text(pDX, IDC_THETA_VALUE, m_Theta);
DDX_Text(pDX, IDC_PHI_VALUE, m_Phi);
//}}AFX_DATA_MAP
}
BEGIN_MESSAGE_MAP(CBasisEdit, CDialog)
//{{AFX_MSG_MAP(CBasisEdit)
ON_WM_PAINT()
ON_WM_HSCROLL()
//}}AFX_MSG_MAP
END_MESSAGE_MAP()
/////////////////////////////////////////////////////////////////////////////
// CBasisEdit message handlers
void CBasisEdit::init(uint32 x, uint32 y, CWnd *pParent)
{
nlassert(_Wrapper); // _Wrapper should have been set before init !!
Create(IDD_BASIS_EDIT, pParent);
RECT r;
GetClientRect(&r);
m_PsiCtrl.SetScrollRange(0, 359);
m_ThetaCtrl.SetScrollRange(0, 359);
m_PhiCtrl.SetScrollRange(0, 359);
MoveWindow(x, y, r.right, r.bottom);
updateAnglesFromReader();
ShowWindow(SW_SHOW);
UpdateData(FALSE);
}
// build an euler matrix
NLMISC::CMatrix BuildEulerMatrix(float psi, float theta, float phi)
{
float ca = cosf(psi), sa = sinf(psi)
, cb = cosf(theta), sb = sinf(theta)
, cc = cosf(phi), sc = sinf(phi);
NLMISC::CMatrix m;
m.identity();
m.setRot(NLMISC::CVector(ca * cb * cc - sa * sc, -cc * sa - ca * cb *sc, ca * sb)
,NLMISC::CVector(cb * cc * sa + ca * sc, ca * cc - cb * sa * sc, sa *sb)
,NLMISC::CVector(-cc * sb, sb * sc, cb)
);
return m;
}
// get back the euler angles from a matrix
NLMISC::CVector GetEulerAngles(const NLMISC::CMatrix &mat)
{
float m[3][3];
// we got cos theta = m33
NLMISC::CVector v[3];
mat.getRot(v[0], v[1], v[2]);
for (uint l = 0; l < 3; ++l)
{
m[0][l] = v[l].x; m[1][l] = v[l].y; m[2][l] = v[l].z;
}
// there are eight triplet that may satisfy the equation
// we compute them all, and test them against the matrix
float b0, b1, a0, a1, a2, a3, c0, c1, c2, c3;
b0 = acosf(m[2][2]);
b1 = (float) NLMISC::Pi - b0;
float sb0 = sinf(b0), sb1 = sinf(b1);
if (fabsf(sb0) > 10E-6)
{
a0 = m[2][0] / sb0;
c0 = m[1][2] / sb0;
}
else
{
a0 = c0 = 1.f;
}
if (fabs(sb1) > 10E-6)
{
a1 = m[2][0] / sb1;
c1 = m[1][2] / sb1;
}
else
{
a1 = c1 = 1.f;
}
a2 = (float) NLMISC::Pi - a0;
a3 = (float) NLMISC::Pi - a1;
c2 = (float) NLMISC::Pi - c0;
c3 = (float) NLMISC::Pi - c1;
NLMISC::CVector sol[] =
{
NLMISC::CVector(b0, a0, c0)
,NLMISC::CVector(b0, a2, c0)
,NLMISC::CVector(b0, a0, c2)
,NLMISC::CVector(b0, a2, c2)
,NLMISC::CVector(b1, a1, c1)
,NLMISC::CVector(b1, a3, c1)
,NLMISC::CVector(b1, a1, c3)
,NLMISC::CVector(b1, a3, c3)
};
// now we take the triplet that fit best the 6 other equations
float bestGap = 0.f;
uint bestIndex;
for (uint k = 0; k < 8; ++k)
{
float ca = cosf(sol[k].x), sa = sinf(sol[k].x)
, cb = cosf(sol[k].y), sb = sinf(sol[k].y)
, cc = cosf(sol[k].z), sc = sinf(sol[k].z);
float gap = fabsf(m[0][0] - ca * cb * cc + sa * sc);
gap += fabsf(m[1][0] + cc * sa + ca * cb *sc);
gap += fabsf(m[0][1] - cb * cc * sa - ca * sc);
gap += fabsf(m[0][1] - cb * cc * sa - ca * sc);
gap += fabsf(m[1][1] - ca * cc + cb * sa * sc);
gap += fabsf(m[2][1] - sb *ca);
gap += fabsf(m[0][2] + cc * sb);
if (k == 0 || gap < bestGap)
{
bestGap = gap;
bestIndex = k;
}
}
return sol[bestIndex];
}
void CBasisEdit::updateAnglesFromReader()
{
nlassert(_Wrapper); // _Wrapper should have been set before init !!
// read plane basis
NL3D::CPlaneBasis pb = _Wrapper->get();
NLMISC::CMatrix mat;
mat.setRot(pb.X, pb.Y, pb.X ^ pb.Y);
NLMISC::CVector angles = GetEulerAngles(mat);
m_PsiCtrl.SetScrollPos((uint) (360.f * angles.x / (2.f * (float) NLMISC::Pi)));
m_ThetaCtrl.SetScrollPos((uint) (360.f * angles.y / (2.f * (float) NLMISC::Pi)));
m_PhiCtrl.SetScrollPos((uint) (360.f * angles.z / (2.f * (float) NLMISC::Pi)));
UpdateData(FALSE);
}
// just project a vector with orthogonal proj
static CPoint BasisVectXForm(NLMISC::CVector &v, float size)
{
const float sq = sqrtf(2.f) / 2.f;
return CPoint((int) (size * (sq * (v.x + v.y) )), (int) (size * (-v.z + sq * (v.x - v.y))));
}
// draw a basis using the given colors, and hte given dc
void DrawBasisInDC(const CPoint &center, float size, const NLMISC::CMatrix &m, CDC &dc, NLMISC::CRGBA col[3])
{
// draw the basis
CPoint px = center + BasisVectXForm(m.getI(), size);
CPoint py = center + BasisVectXForm(m.getJ(), size);
CPoint pz = center + BasisVectXForm(m.getK(), size);
CPen p[3];
p[0].CreatePen(PS_SOLID, 1, col[0].R + (col[0].G << 8) + (col[0].B << 16) );
p[1].CreatePen(PS_SOLID, 1, col[1].R + (col[1].G << 8) + (col[1].B << 16) );
p[2].CreatePen(PS_SOLID, 1, col[2].R + (col[2].G << 8) + (col[2].B << 16) );
// draw letters indicating each axis
// X
CPen *old = dc.SelectObject(&p[0]);
dc.MoveTo(center);
dc.LineTo(px);
dc.MoveTo(px + CPoint(2, 2));
dc.LineTo(px + CPoint(5, 5));
dc.MoveTo(px + CPoint(4, 2));
dc.LineTo(px + CPoint(3, 5));
// Y
dc.SelectObject(&p[1]);
dc.MoveTo(center);
dc.LineTo(py);
dc.MoveTo(py + CPoint(2, 2));
dc.LineTo(py + CPoint(4, 4));
dc.MoveTo(py + CPoint(4, 2));
dc.LineTo(py + CPoint(1, 5));
// Z
dc.SelectObject(&p[2]);
dc.MoveTo(center);
dc.LineTo(pz);
dc.MoveTo(pz + CPoint(2, 2));
dc.LineTo(pz + CPoint(5, 2));
dc.MoveTo(pz + CPoint(4, 2));
dc.LineTo(pz + CPoint(1, 5));
dc.MoveTo(pz + CPoint(2, 4));
dc.LineTo(pz + CPoint(5, 4));
dc.SelectObject(old);
}
void CBasisEdit::OnPaint()
{
CPaintDC dc(this); // device context for painting
NLMISC::CRGBA c1[] ={ NLMISC::CRGBA::White, NLMISC::CRGBA::White, NLMISC::CRGBA::White };
NLMISC::CRGBA c2[] ={ NLMISC::CRGBA::Green, NLMISC::CRGBA::Green, NLMISC::CRGBA::Red };
if (_Wrapper)
{
// read plane basis
NL3D::CPlaneBasis pb = _Wrapper->get();
CPoint center(20, 20);
// draw a white box on the left
dc.FillSolidRect(0, 0, 39, 39, 0x777777);
NLMISC::CMatrix m;
m.identity();
DrawBasisInDC(center, 18, m, dc, c1);
m.setRot(pb.X, pb.Y, pb.X ^ pb.Y);
DrawBasisInDC(center, 18, m, dc, c2);
}
// Do not call CDialog::OnPaint() for painting messages
}
void CBasisEdit::OnHScroll(UINT nSBCode, UINT nPos, CScrollBar* pScrollBar)
{
UpdateData();
if (nSBCode == SB_THUMBPOSITION || nSBCode == SB_THUMBTRACK)
{
NLMISC::CVector angles(2.f * (float) NLMISC::Pi * m_PsiCtrl.GetScrollPos() / 360.f
, 2.f * (float) NLMISC::Pi * m_ThetaCtrl.GetScrollPos() / 360.f
, 2.f * (float) NLMISC::Pi * m_PhiCtrl.GetScrollPos() / 360.f
);
if (pScrollBar == &m_PsiCtrl)
{
angles.x = 2.f * (float) NLMISC::Pi * nPos / 360.f;
m_PsiCtrl.SetScrollPos(nPos);
}
if (pScrollBar == &m_ThetaCtrl)
{
angles.y = 2.f * (float) NLMISC::Pi * nPos / 360.f;
m_ThetaCtrl.SetScrollPos(nPos);
}
if (pScrollBar == &m_PhiCtrl)
{
angles.z = 2.f * (float) NLMISC::Pi * nPos / 360.f;
m_PhiCtrl.SetScrollPos(nPos);
}
NLMISC::CMatrix mat = BuildEulerMatrix(angles.x, angles.y, angles.z);
NL3D::CPlaneBasis pb;
pb.X = mat.getI();
pb.Y = mat.getJ();
_Wrapper->setAndUpdateModifiedFlag(pb);
Invalidate();
}
CDialog::OnHScroll(nSBCode, nPos, pScrollBar);
UpdateData(FALSE);
}