Fix GetWorldRotation(), and a host of related Sit fixes.

avinationmerge
Kitto Flora 2009-12-17 02:54:02 -05:00
parent 83fad75e22
commit 6483470ec5
3 changed files with 43 additions and 38 deletions

View File

@ -1775,7 +1775,7 @@ namespace OpenSim.Region.Framework.Scenes
{ {
Quaternion newRot; Quaternion newRot;
if (this.LinkNum == 0) if (this.LinkNum < 2) //KF Single or root prim
{ {
newRot = RotationOffset; newRot = RotationOffset;
} }

View File

@ -1661,14 +1661,14 @@ namespace OpenSim.Region.Framework.Scenes
// Rotation is the sittiing Av's rotation // Rotation is the sittiing Av's rotation
Quaternion partRot; Quaternion partRot;
if (part.LinkNum == 1) // if (part.LinkNum == 1)
{ // Root prim of linkset // { // Root prim of linkset
partRot = part.ParentGroup.RootPart.RotationOffset; // partRot = part.ParentGroup.RootPart.RotationOffset;
} // }
else // else
{ // single or child prim // { // single or child prim
partRot = part.GetWorldRotation(); partRot = part.GetWorldRotation();
} // }
Quaternion partIRot = Quaternion.Inverse(partRot); Quaternion partIRot = Quaternion.Inverse(partRot);
Quaternion avatarRot = Quaternion.Inverse(Quaternion.Inverse(Rotation) * partIRot); // world or. of the av Quaternion avatarRot = Quaternion.Inverse(Quaternion.Inverse(Rotation) * partIRot); // world or. of the av
@ -1763,14 +1763,14 @@ namespace OpenSim.Region.Framework.Scenes
bool SitTargetisSet = (Vector3.Zero != avSitOffSet); //NB Latest SL Spec shows Sit Rotation setting is ignored. bool SitTargetisSet = (Vector3.Zero != avSitOffSet); //NB Latest SL Spec shows Sit Rotation setting is ignored.
// Quaternion partIRot = Quaternion.Inverse(part.GetWorldRotation()); // Quaternion partIRot = Quaternion.Inverse(part.GetWorldRotation());
Quaternion partRot; Quaternion partRot;
if (part.LinkNum == 1) // if (part.LinkNum == 1)
{ // Root prim of linkset // { // Root prim of linkset
partRot = part.ParentGroup.RootPart.RotationOffset; // partRot = part.ParentGroup.RootPart.RotationOffset;
} // }
else // else
{ // single or child prim // { // single or child prim
partRot = part.GetWorldRotation(); partRot = part.GetWorldRotation();
} // }
Quaternion partIRot = Quaternion.Inverse(partRot); Quaternion partIRot = Quaternion.Inverse(partRot);
//Console.WriteLine("SendSitResponse offset=" + offset + " Occup=" + part.IsOccupied + " TargSet=" + SitTargetisSet); //Console.WriteLine("SendSitResponse offset=" + offset + " Occup=" + part.IsOccupied + " TargSet=" + SitTargetisSet);
// Sit analysis rewritten by KF 091125 // Sit analysis rewritten by KF 091125
@ -1846,15 +1846,15 @@ namespace OpenSim.Region.Framework.Scenes
Vector3 offsetr; // = offset * partIRot; Vector3 offsetr; // = offset * partIRot;
// KF: In a linkset, offsetr needs to be relative to the group root! 091208 // KF: In a linkset, offsetr needs to be relative to the group root! 091208
// offsetr = (part.OffsetPosition * Quaternion.Inverse(part.ParentGroup.RootPart.RotationOffset)) + (offset * partIRot); // offsetr = (part.OffsetPosition * Quaternion.Inverse(part.ParentGroup.RootPart.RotationOffset)) + (offset * partIRot);
if (part.LinkNum < 2) // if (part.LinkNum < 2) 091216 All this was necessary because of the GetWorldRotation error.
{ // Single, or Root prim of linkset, target is ClickOffset * RootRot // { // Single, or Root prim of linkset, target is ClickOffset * RootRot
offsetr = offset * partIRot; offsetr = offset * partIRot;
} //
else // else
{ // Child prim, offset is (ChildOffset * RootRot) + (ClickOffset * ChildRot) // { // Child prim, offset is (ChildOffset * RootRot) + (ClickOffset * ChildRot)
offsetr = //(part.OffsetPosition * Quaternion.Inverse(part.ParentGroup.RootPart.RotationOffset)) + // offsetr = //(part.OffsetPosition * Quaternion.Inverse(part.ParentGroup.RootPart.RotationOffset)) +
(offset * partRot); // (offset * partRot);
} // }
//Console.WriteLine(" "); //Console.WriteLine(" ");
//Console.WriteLine("link number ={0}", part.LinkNum); //Console.WriteLine("link number ={0}", part.LinkNum);
@ -2170,6 +2170,7 @@ namespace OpenSim.Region.Framework.Scenes
{ {
if (part != null) if (part != null)
{ {
//Console.WriteLine("Link #{0}, Rot {1}", part.LinkNum, part.GetWorldRotation());
if (part.GetAvatarOnSitTarget() == UUID) if (part.GetAvatarOnSitTarget() == UUID)
{ {
//Console.WriteLine("Scripted Sit"); //Console.WriteLine("Scripted Sit");
@ -2190,14 +2191,14 @@ namespace OpenSim.Region.Framework.Scenes
// Non-scripted sit by Kitto Flora 21Nov09 // Non-scripted sit by Kitto Flora 21Nov09
// Calculate angle of line from prim to Av // Calculate angle of line from prim to Av
Quaternion partIRot; Quaternion partIRot;
if (part.LinkNum == 1) // if (part.LinkNum == 1)
{ // Root prim of linkset // { // Root prim of linkset
partIRot = Quaternion.Inverse(part.ParentGroup.RootPart.RotationOffset); // partIRot = Quaternion.Inverse(part.ParentGroup.RootPart.RotationOffset);
} // }
else // else
{ // single or child prim // { // single or child prim
partIRot = Quaternion.Inverse(part.GetWorldRotation()); partIRot = Quaternion.Inverse(part.GetWorldRotation());
} // }
Vector3 sitTargetPos= part.AbsolutePosition + m_avUnscriptedSitPos; Vector3 sitTargetPos= part.AbsolutePosition + m_avUnscriptedSitPos;
float y_diff = (m_avInitialPos.Y - sitTargetPos.Y); float y_diff = (m_avInitialPos.Y - sitTargetPos.Y);
float x_diff = ( m_avInitialPos.X - sitTargetPos.X); float x_diff = ( m_avInitialPos.X - sitTargetPos.X);
@ -2253,14 +2254,14 @@ namespace OpenSim.Region.Framework.Scenes
// collisionPoint.Z = global sit surface height // collisionPoint.Z = global sit surface height
SceneObjectPart part = m_scene.GetSceneObjectPart(localid); SceneObjectPart part = m_scene.GetSceneObjectPart(localid);
Quaternion partIRot; Quaternion partIRot;
if (part.LinkNum == 1) // if (part.LinkNum == 1)
{ // Root prim of linkset /// { // Root prim of linkset
partIRot = Quaternion.Inverse(part.ParentGroup.RootPart.RotationOffset); // partIRot = Quaternion.Inverse(part.ParentGroup.RootPart.RotationOffset);
} // }
else // else
{ // single or child prim // { // single or child prim
partIRot = Quaternion.Inverse(part.GetWorldRotation()); partIRot = Quaternion.Inverse(part.GetWorldRotation());
} // }
float offZ = collisionPoint.Z - m_initialSitTarget.Z; float offZ = collisionPoint.Z - m_initialSitTarget.Z;
Vector3 offset = new Vector3(0.0f, 0.0f, offZ) * partIRot; // Altitude correction Vector3 offset = new Vector3(0.0f, 0.0f, offZ) * partIRot; // Altitude correction
//Console.WriteLine("sitPoint={0}, offset={1}", sitPoint, offset); //Console.WriteLine("sitPoint={0}, offset={1}", sitPoint, offset);

View File

@ -2682,6 +2682,10 @@ Console.WriteLine(" JointCreateFixed");
l_orientation.Z = ori.Z; l_orientation.Z = ori.Z;
l_orientation.W = ori.W; l_orientation.W = ori.W;
// if(l_position.Y != m_lastposition.Y){
// Console.WriteLine("UP&V {0} {1}", m_primName, l_position);
// }
if (l_position.X > ((int)_parent_scene.WorldExtents.X - 0.05f) || l_position.X < 0f || l_position.Y > ((int)_parent_scene.WorldExtents.Y - 0.05f) || l_position.Y < 0f) if (l_position.X > ((int)_parent_scene.WorldExtents.X - 0.05f) || l_position.X < 0f || l_position.Y > ((int)_parent_scene.WorldExtents.Y - 0.05f) || l_position.Y < 0f)
{ {
//base.RaiseOutOfBounds(l_position); //base.RaiseOutOfBounds(l_position);