bool TrackballTransformManipulator::rotate()
{
if ( ( getCurrentX() != getLastX() ) || ( getCurrentY() != getLastY() ) )
{
DP_ASSERT( getViewState()->getCamera().isPtrTo<FrustumCamera>() );
TransformSharedPtr transform = m_transformPath->getTail().staticCast<Transform>();
FrustumCameraSharedPtr const& camera = getViewState()->getCamera().staticCast<FrustumCamera>();
if ( camera && transform )
{
unsigned int rtWidth = getRenderTarget()->getWidth();
unsigned int rtHeight = getRenderTarget()->getHeight();
Vec2f camWinSize = camera->getWindowSize();
if ( ( 0 < rtHeight ) && ( 0 < rtWidth )
&& ( FLT_EPSILON < fabs( camWinSize[0] ) )
&& ( FLT_EPSILON < fabs( camWinSize[1] ) ) )
{
// get all the matrices needed here
Mat44f m2w, w2m, w2v, v2w, v2s, m2v;
m_transformPath->getModelToWorldMatrix( m2w, w2m ); // model->world and world->model
w2v = camera->getWorldToViewMatrix(); // world->view
v2w = camera->getViewToWorldMatrix(); // view->world
v2s = camera->getProjection(); // view->screen (normalized)
m2v = m2w * w2v;
const Sphere3f& bs = transform->getBoundingSphere();
// center of the object in view coordinates
Vec4f centerV = Vec4f( bs.getCenter(), 1.0f ) * m2v;
DP_ASSERT( fabs( centerV[3] - 1.0f ) < FLT_EPSILON );
// center of the object in normalized screen coordinates
Vec4f centerNS = centerV * v2s;
DP_ASSERT( centerNS[3] != 0.0f );
centerNS /= centerNS[3];
// center of the object in screen space
Vec2f centerS( rtWidth * ( 1 + centerNS[0] ) / 2, rtHeight * ( 1 - centerNS[1] ) / 2 );
// move the input points relative to the center
// move the input points absolutely
//Vec2f last( m_orbitCursor );
Vec2f last( getLastCursorPosition() );
Vec2f p0( last[0] - centerS[0], centerS[1] - last[1] );
Vec2f p1( getCurrentX() - centerS[0], centerS[1] - getCurrentY() );
DP_ASSERT( p0[0] != p1[0] || p0[1] != p1[1] );
// get the scaling (from model to view)
Vec3f scaling, translation;
Quatf orientation, scaleOrientation;
decompose( m2v, translation, orientation, scaling, scaleOrientation );
float maxScale = std::max( scaling[0], std::max( scaling[1], scaling[2] ) );
DP_ASSERT( FLT_EPSILON < fabs( maxScale ) );
// determine the radius in screen space (in the centers depth)
Vec2f centerWindowSize = - centerV[2] / getViewState()->getTargetDistance() * camWinSize;
float radius = bs.getRadius() * maxScale * rtWidth / centerWindowSize[0];
// with p0, p1, and the radius determine the axis and angle of rotation via the Trackball utility
// => axis is in view space then
Vec3f axis;
float angle;
m_trackball.setSize( radius );
m_trackball.apply( p0, p1, axis, angle );
float dx = p1[0]-p0[0];
float dy = p1[1]-p0[1];
checkLockAxis(dx, dy);
if ( m_activeLockAxis[static_cast<size_t>(Axis::X)] )
{
if ( dx < 0 )
axis = Vec3f(0.f, -1.f, 0.f);
else if ( dx > 0)
axis = Vec3f(0.f, 1.f, 0.f);
else
return false;
}
else if ( m_activeLockAxis[static_cast<size_t>(Axis::Y)] )
{
if ( dy < 0 )
axis = Vec3f(1.f, 0.f, 0.f);
else if ( dy > 0)
axis = Vec3f(-1.f, 0.f, 0.f);
else
return false;
}
// transform axis back into model space
axis = Vec3f( Vec4f( axis, 0.0f ) * v2w * w2m );
axis.normalize();
// create the rotation around the center (in model space)
Trafo trafo;
trafo.setCenter( bs.getCenter() );
trafo.setOrientation( Quatf( axis, angle ) );
// concatenate this rotation with the current transformation
trafo.setMatrix( transform->getTrafo().getMatrix() * trafo.getMatrix() );
// concatenate this rotation with the original transformation
//trafo.setMatrix( m_matrix * trafo.getMatrix() );
// set the current transform
transform->setTrafo( trafo );
return true;
}
}
}
return false;
}
void UnwrapMod::fnAlignAndFit(int axis)
{
//get our selection
Box3 bounds;
bounds.Init();
//get the bounding box
Point3 pnorm(0.0f,0.0f,0.0f);
int ct = 0;
TimeValue t = GetCOREInterface()->GetTime();
for (int ldID = 0; ldID < mMeshTopoData.Count(); ldID++)
{
MeshTopoData *ld = mMeshTopoData[ldID];
Matrix3 tm = mMeshTopoData.GetNodeTM(t,ldID);
for (int k = 0; k < ld->GetNumberFaces(); k++)
{
if (ld->GetFaceSelected(k))
{
// Grap the three points, xformed
int pcount = 3;
// if (gfaces[k].flags & FLAG_QUAD) pcount = 4;
pcount = ld->GetFaceDegree(k);//gfaces[k]->count;
Point3 temp_point[4];
for (int j=0; j<pcount; j++)
{
int index = ld->GetFaceGeomVert(k,j);//gfaces[k]->t[j];
bounds += ld->GetGeomVert(index) *tm;//gverts.d[index].p;
if (j < 4)
temp_point[j] = ld->GetGeomVert(index);//gverts.d[index].p;
}
pnorm += VectorTransform(Normalize(temp_point[1]-temp_point[0]^temp_point[2]-temp_point[1]),tm);
ct++;
}
}
}
if (ct == 0) return;
theHold.Begin();
SuspendAnimate();
AnimateOff();
pnorm = pnorm / (float) ct;
Matrix3 tm(1);
//if just a primary axis set the tm;
Point3 center = bounds.Center();
// build the scale
Point3 scale(bounds.Width().x ,bounds.Width().y , bounds.Width().z);
if (scale.x == 0.0f) scale.x = 1.0f;
if (scale.y == 0.0f) scale.y = 1.0f;
if (scale.z == 0.0f) scale.z = 1.0f;
if (axis == 0) // x axi
{
tm.SetRow(0,Point3(0.0f,-scale.y,0.0f));
tm.SetRow(1,Point3(0.0f,0.0f,scale.z));
tm.SetRow(2,Point3(scale.x,0.0f,0.0f));
if ((fnGetMapMode() == PLANARMAP) || (fnGetMapMode() == PELTMAP) || (fnGetMapMode() == SPHERICALMAP) || (fnGetMapMode() == BOXMAP))
tm.SetRow(3,center);
else if (fnGetMapMode() == CYLINDRICALMAP)
{
center.x = bounds.pmin.x;
tm.SetRow(3,center);
}
Matrix3 ptm(1), id(1);
tm = tm ;
SetXFormPacket tmpck(tm,ptm);
tmControl->SetValue(t,&tmpck,TRUE,CTRL_RELATIVE);
}
else if (axis == 1) // y axi
{
tm.SetRow(0,Point3(scale.x,0.0f,0.0f));
tm.SetRow(1,Point3(0.0f,0.0f,scale.z));
tm.SetRow(2,Point3(0.0f,scale.y,0.0f));
if ((fnGetMapMode() == PLANARMAP) || (fnGetMapMode() == PELTMAP)|| (fnGetMapMode() == SPHERICALMAP) || (fnGetMapMode() == BOXMAP))
tm.SetRow(3,center);
else if (fnGetMapMode() == CYLINDRICALMAP)
{
center.y = bounds.pmin.y;
tm.SetRow(3,center);
}
Matrix3 ptm(1), id(1);
tm = tm;
SetXFormPacket tmpck(tm,ptm);
tmControl->SetValue(t,&tmpck,TRUE,CTRL_RELATIVE);
}
else if (axis == 2) //z axi
{
tm.SetRow(0,Point3(scale.x,0.0f,0.0f));
tm.SetRow(1,Point3(0.0f,scale.y,0.0f));
tm.SetRow(2,Point3(0.0f,0.0f,scale.z));
if ((fnGetMapMode() == PLANARMAP) || (fnGetMapMode() == PELTMAP)|| (fnGetMapMode() == SPHERICALMAP) || (fnGetMapMode() == BOXMAP))
tm.SetRow(3,center);
else if (fnGetMapMode() == CYLINDRICALMAP)
{
center.z = bounds.pmin.z;
tm.SetRow(3,center);
}
Matrix3 ptm(1), id(1);
tm = tm;
SetXFormPacket tmpck(tm,ptm);
tmControl->SetValue(t,&tmpck,TRUE,CTRL_RELATIVE);
}
else if (axis == 3) // normal
{
int numberOfSelectionGroups = 0;
for (int ldID = 0; ldID < mMeshTopoData.Count(); ldID++)
{
MeshTopoData *ld = mMeshTopoData[ldID];
if (ld->GetFaceSelection().NumberSet())
numberOfSelectionGroups++;
}
if ((fnGetMapMode() == PLANARMAP) || (fnGetMapMode() == PELTMAP) || (numberOfSelectionGroups > 1))
{
//get our tm
Matrix3 tm;
UnwrapMatrixFromNormal(pnorm,tm);
Matrix3 itm = Inverse(tm);
//find our x and y scale
float xmax = 0.0f;
float ymax = 0.0f;
float zmax = 0.0f;
Box3 localBounds;
localBounds.Init();
for (int ldID = 0; ldID < mMeshTopoData.Count(); ldID++)
{
MeshTopoData *ld = mMeshTopoData[ldID];
Matrix3 tm = mMeshTopoData.GetNodeTM(t,ldID);
for (int k = 0; k < ld->GetNumberFaces(); k++)
{
if (ld->GetFaceSelected(k))
{
// Grap the three points, xformed
int pcount = 3;
// if (gfaces[k].flags & FLAG_QUAD) pcount = 4;
pcount = ld->GetFaceDegree(k);//gfaces[k]->count;
Point3 temp_point[4];
for (int j=0; j<pcount; j++)
{
int index = ld->GetFaceGeomVert(k,j);//gfaces[k]->t[j];
Point3 p = ld->GetGeomVert(index) * tm * itm;//gverts.d[index].p * itm;
localBounds += p;
}
}
}
}
// center = localBounds.Center();
xmax = localBounds.pmax.x - localBounds.pmin.x;
ymax = localBounds.pmax.y - localBounds.pmin.y;
zmax = localBounds.pmax.z - localBounds.pmin.z;
if (xmax < 0.001f)
xmax = 1.0f;
if (ymax < 0.001f)
ymax = 1.0f;
if (zmax < 0.001f)
zmax = 1.0f;
Point3 vec;
vec = Normalize(tm.GetRow(0)) * xmax;
tm.SetRow(0,vec);
vec = Normalize(tm.GetRow(1)) * ymax;
tm.SetRow(1,vec);
vec = Normalize(tm.GetRow(2)) * zmax;
tm.SetRow(2,vec);
tm.SetRow(3,center);
Matrix3 ptm(1), id(1);
tm = tm ;
SetXFormPacket tmpck(tm,ptm);
tmControl->SetValue(t,&tmpck,TRUE,CTRL_RELATIVE);
}
else if ((fnGetMapMode() == CYLINDRICALMAP) || (fnGetMapMode() == SPHERICALMAP)|| (fnGetMapMode() == BOXMAP))
{
for (int ldID = 0; ldID < mMeshTopoData.Count(); ldID++)
{
//get our first 2 rings
Tab<int> openEdges;
Tab<int> startRing;
Tab<int> endRing;
MeshTopoData *ld = mMeshTopoData[ldID];
//skip any local data that has no selections
if (ld->GetFaceSelection().NumberSet() == 0)
continue;
Matrix3 nodeTM = mMeshTopoData.GetNodeTM(t,ldID);
for (int i = 0; i < ld->GetNumberGeomEdges(); i++)//TVMaps.gePtrList.Count(); i++)
{
int numberSelectedFaces = 0;
int ct = ld->GetGeomEdgeNumberOfConnectedFaces(i);//TVMaps.gePtrList[i]->faceList.Count();
for (int j = 0; j < ct; j++)
{
int faceIndex = ld->GetGeomEdgeConnectedFace(i,j);//TVMaps.gePtrList[i]->faceList[j];
if (ld->GetFaceSelected(faceIndex))//fsel[faceIndex])
numberSelectedFaces++;
}
if (numberSelectedFaces == 1)
{
openEdges.Append(1,&i,1000);
}
}
GetOpenEdges(ld,openEdges, startRing);
GetOpenEdges(ld,openEdges, endRing);
Point3 zVec = pnorm;
Point3 centerS(0.0f,0.0f,0.0f), centerE;
if ((startRing.Count() != 0) && (endRing.Count() != 0))
{
//get the center start
Box3 BoundsS, BoundsE;
BoundsS.Init();
BoundsE.Init();
//get the center end
for (int i = 0; i < startRing.Count(); i++)
{
int eIndex = startRing[i];
int a = ld->GetGeomEdgeVert(eIndex,0);//TVMaps.gePtrList[eIndex]->a;
int b = ld->GetGeomEdgeVert(eIndex,1);//TVMaps.gePtrList[eIndex]->b;
BoundsS += ld->GetGeomVert(a) * nodeTM;//TVMaps.geomPoints[a];
BoundsS += ld->GetGeomVert(b) * nodeTM;//TVMaps.geomPoints[b];
}
for (int i = 0; i < endRing.Count(); i++)
{
int eIndex = endRing[i];
int a = ld->GetGeomEdgeVert(eIndex,0);//TVMaps.gePtrList[eIndex]->a;
int b = ld->GetGeomEdgeVert(eIndex,1);//TVMaps.gePtrList[eIndex]->b;
BoundsE += ld->GetGeomVert(a) * nodeTM;//TVMaps.geomPoints[a];
BoundsE += ld->GetGeomVert(b) * nodeTM;//TVMaps.geomPoints[b];
}
centerS = BoundsS.Center();
centerE = BoundsE.Center();
//create the vec
zVec = centerE - centerS;
}
else if ((startRing.Count() != 0) && (endRing.Count() == 0))
{
//get the center start
Box3 BoundsS;
BoundsS.Init();
//get the center end
for (int i = 0; i < startRing.Count(); i++)
{
int eIndex = startRing[i];
int a = ld->GetGeomEdgeVert(eIndex,0);//TVMaps.gePtrList[eIndex]->a;
int b = ld->GetGeomEdgeVert(eIndex,1);//TVMaps.gePtrList[eIndex]->b;
BoundsS += ld->GetGeomVert(a) * nodeTM;//TVMaps.geomPoints[a];
BoundsS += ld->GetGeomVert(b) * nodeTM;//TVMaps.geomPoints[b];
}
centerS = BoundsS.Center();
int farthestPoint= -1;
Point3 fp;
float farthestDist= 0.0f;
for (int k=0; k < ld->GetNumberFaces(); k++)
{
if (ld->GetFaceSelected(k))
{
// Grap the three points, xformed
int pcount = 3;
// if (gfaces[k].flags & FLAG_QUAD) pcount = 4;
pcount = ld->GetFaceDegree(k);//gfaces[k]->count;
for (int j=0; j<pcount; j++)
{
int index = ld->GetFaceGeomVert(k,j);//gfaces[k]->t[j];
Point3 p = ld->GetGeomVert(index)* nodeTM;//gverts.d[index].p;
float d = LengthSquared(p-centerS);
if ((d > farthestDist) || (farthestPoint == -1))
{
farthestDist = d;
farthestPoint = index;
fp = p;
}
}
}
}
centerE = fp;
//create the vec
zVec = centerE - centerS;
}
else
{
zVec = Point3(0.0f,0.0f,1.0f);
}
//get our tm
Matrix3 tm;
UnwrapMatrixFromNormal(zVec,tm);
tm.SetRow(3,centerS);
Matrix3 itm = Inverse(tm);
//find our x and y scale
float xmax = 0.0f;
float ymax = 0.0f;
float zmax = 0.0f;
Box3 localBounds;
localBounds.Init();
for (int k = 0; k < ld->GetNumberFaces(); k++)//gfaces.Count(); k++)
{
if (ld->GetFaceSelected(k))
{
// Grap the three points, xformed
int pcount = 3;
// if (gfaces[k].flags & FLAG_QUAD) pcount = 4;
pcount = ld->GetFaceDegree(k);//gfaces[k]->count;
Point3 temp_point[4];
for (int j=0; j<pcount; j++)
{
int index = ld->GetFaceGeomVert(k,j);//gfaces[k]->t[j];
Point3 p = ld->GetGeomVert(index) * nodeTM * itm;//gverts.d[index].p * itm;
localBounds += p;
}
}
}
center = localBounds.Center() * tm;
if (fnGetMapMode() == CYLINDRICALMAP)
{
if ((startRing.Count() == 0) && (endRing.Count() == 0))
{
centerS = center;
centerS.z = localBounds.pmin.z;
}
else
{
centerS = centerS * itm;
centerS.z = localBounds.pmin.z;
centerS = centerS * tm;
}
}
else if ((fnGetMapMode() == SPHERICALMAP) || (fnGetMapMode() == BOXMAP))
{
centerS = center;
}
Point3 bc = localBounds.Center();
bc.z = localBounds.pmin.z;
bc = bc * tm;
xmax = localBounds.pmax.x - localBounds.pmin.x;
ymax = localBounds.pmax.y - localBounds.pmin.y;
zmax = localBounds.pmax.z - localBounds.pmin.z;
Point3 vec;
vec = Normalize(tm.GetRow(0)) * xmax;
tm.SetRow(0,vec);
vec = Normalize(tm.GetRow(1)) * ymax;
tm.SetRow(1,vec);
vec = Normalize(tm.GetRow(2)) * zmax;
tm.SetRow(2,vec);
tm.SetRow(3,centerS);
Matrix3 ptm(1), id(1);
tm = tm;
SetXFormPacket tmpck(tm,ptm);
tmControl->SetValue(t,&tmpck,TRUE,CTRL_RELATIVE);
}
}
}
ResumeAnimate();
if ((fnGetMapMode() == PLANARMAP) || (fnGetMapMode() == CYLINDRICALMAP) || (fnGetMapMode() == SPHERICALMAP) || (fnGetMapMode() == BOXMAP))
ApplyGizmo();
theHold.Accept(GetString(IDS_MAPPING_ALIGN));
fnGetGizmoTM();
if (ip) ip->RedrawViews(ip->GetTime());
}
