aboutsummaryrefslogtreecommitdiffstatshomepage
path: root/OpenSim/Region/Framework/Scenes/ScenePresence.cs
diff options
context:
space:
mode:
Diffstat (limited to 'OpenSim/Region/Framework/Scenes/ScenePresence.cs')
-rw-r--r--OpenSim/Region/Framework/Scenes/ScenePresence.cs53
1 files changed, 38 insertions, 15 deletions
diff --git a/OpenSim/Region/Framework/Scenes/ScenePresence.cs b/OpenSim/Region/Framework/Scenes/ScenePresence.cs
index 9c71492..7b228c6 100644
--- a/OpenSim/Region/Framework/Scenes/ScenePresence.cs
+++ b/OpenSim/Region/Framework/Scenes/ScenePresence.cs
@@ -1559,9 +1559,9 @@ namespace OpenSim.Region.Framework.Scenes
1559 if (allowUpdate && (m_moveToPositionInProgress && !m_autopilotMoving)) 1559 if (allowUpdate && (m_moveToPositionInProgress && !m_autopilotMoving))
1560 { 1560 {
1561 double distanceToTarget = Util.GetDistanceTo(AbsolutePosition, m_moveToPositionTarget); 1561 double distanceToTarget = Util.GetDistanceTo(AbsolutePosition, m_moveToPositionTarget);
1562// m_log.DebugFormat( 1562 m_log.DebugFormat(
1563// "[SCENE PRESENCE]: Abs pos of {0} is {1}, target {2}, distance {3}", 1563 "[SCENE PRESENCE]: Abs pos of {0} is {1}, target {2}, distance {3}",
1564// Name, AbsolutePosition, m_moveToPositionTarget, distanceToTarget); 1564 Name, AbsolutePosition, m_moveToPositionTarget, distanceToTarget);
1565 1565
1566 // Check the error term of the current position in relation to the target position 1566 // Check the error term of the current position in relation to the target position
1567 if (distanceToTarget <= 1) 1567 if (distanceToTarget <= 1)
@@ -1575,7 +1575,7 @@ namespace OpenSim.Region.Framework.Scenes
1575 { 1575 {
1576 try 1576 try
1577 { 1577 {
1578 // move avatar in 2D at one meter/second towards target, in avatar coordinate frame. 1578 // move avatar in 3D at one meter/second towards target, in avatar coordinate frame.
1579 // This movement vector gets added to the velocity through AddNewMovement(). 1579 // This movement vector gets added to the velocity through AddNewMovement().
1580 // Theoretically we might need a more complex PID approach here if other 1580 // Theoretically we might need a more complex PID approach here if other
1581 // unknown forces are acting on the avatar and we need to adaptively respond 1581 // unknown forces are acting on the avatar and we need to adaptively respond
@@ -1584,9 +1584,8 @@ namespace OpenSim.Region.Framework.Scenes
1584 (m_moveToPositionTarget - AbsolutePosition) // vector from cur. pos to target in global coords 1584 (m_moveToPositionTarget - AbsolutePosition) // vector from cur. pos to target in global coords
1585 * Matrix4.CreateFromQuaternion(Quaternion.Inverse(bodyRotation)); // change to avatar coords 1585 * Matrix4.CreateFromQuaternion(Quaternion.Inverse(bodyRotation)); // change to avatar coords
1586 // Ignore z component of vector 1586 // Ignore z component of vector
1587 Vector3 LocalVectorToTarget2D = new Vector3((float)(LocalVectorToTarget3D.X), (float)(LocalVectorToTarget3D.Y), 0f); 1587// Vector3 LocalVectorToTarget2D = new Vector3((float)(LocalVectorToTarget3D.X), (float)(LocalVectorToTarget3D.Y), 0f);
1588 LocalVectorToTarget2D.Normalize(); 1588 LocalVectorToTarget3D.Normalize();
1589 agent_control_v3 += LocalVectorToTarget2D;
1590 1589
1591 // update avatar movement flags. the avatar coordinate system is as follows: 1590 // update avatar movement flags. the avatar coordinate system is as follows:
1592 // 1591 //
@@ -1609,31 +1608,48 @@ namespace OpenSim.Region.Framework.Scenes
1609 1608
1610 // based on the above avatar coordinate system, classify the movement into 1609 // based on the above avatar coordinate system, classify the movement into
1611 // one of left/right/back/forward. 1610 // one of left/right/back/forward.
1612 if (LocalVectorToTarget2D.Y > 0)//MoveLeft 1611 if (LocalVectorToTarget3D.X < 0) //MoveBack
1612 {
1613 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_BACK;
1614 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_BACK;
1615 updated = true;
1616 }
1617 else if (LocalVectorToTarget3D.X > 0) //Move Forward
1618 {
1619 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_FORWARD;
1620 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_FORWARD;
1621 updated = true;
1622 }
1623
1624 if (LocalVectorToTarget3D.Y > 0) //MoveLeft
1613 { 1625 {
1614 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_LEFT; 1626 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_LEFT;
1615 //AgentControlFlags 1627 //AgentControlFlags
1616 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_LEFT; 1628 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_LEFT;
1617 updated = true; 1629 updated = true;
1618 } 1630 }
1619 else if (LocalVectorToTarget2D.Y < 0) //MoveRight 1631 else if (LocalVectorToTarget3D.Y < 0) //MoveRight
1620 { 1632 {
1621 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_RIGHT; 1633 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_RIGHT;
1622 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_RIGHT; 1634 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_RIGHT;
1623 updated = true; 1635 updated = true;
1624 } 1636 }
1625 if (LocalVectorToTarget2D.X < 0) //MoveBack 1637
1638 if (LocalVectorToTarget3D.Z > 0) //Up
1626 { 1639 {
1627 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_BACK; 1640 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_UP;
1628 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_BACK; 1641 //AgentControlFlags
1642 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_UP;
1629 updated = true; 1643 updated = true;
1630 } 1644 }
1631 else if (LocalVectorToTarget2D.X > 0) //Move Forward 1645 else if (LocalVectorToTarget3D.Z < 0) //Down
1632 { 1646 {
1633 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_FORWARD; 1647 m_movementflag += (byte)(uint)Dir_ControlFlags.DIR_CONTROL_FLAG_DOWN;
1634 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_FORWARD; 1648 AgentControlFlags |= (uint)Dir_ControlFlags.DIR_CONTROL_FLAG_DOWN;
1635 updated = true; 1649 updated = true;
1636 } 1650 }
1651
1652 agent_control_v3 += LocalVectorToTarget3D;
1637 } 1653 }
1638 catch (Exception e) 1654 catch (Exception e)
1639 { 1655 {
@@ -1682,6 +1698,13 @@ namespace OpenSim.Region.Framework.Scenes
1682 "[SCENE PRESENCE]: Avatar {0} received request to move to position {1} in {2}", 1698 "[SCENE PRESENCE]: Avatar {0} received request to move to position {1} in {2}",
1683 Name, pos, m_scene.RegionInfo.RegionName); 1699 Name, pos, m_scene.RegionInfo.RegionName);
1684 1700
1701 Vector3 heightAdjust = new Vector3(0, 0, Appearance.AvatarHeight / 2);
1702 pos += heightAdjust;
1703
1704 // Anti duck-walking measure
1705 if (Math.Abs(pos.Z - AbsolutePosition.Z) < 0.2f)
1706 pos.Z = AbsolutePosition.Z;
1707
1685 m_moveToPositionInProgress = true; 1708 m_moveToPositionInProgress = true;
1686 m_moveToPositionTarget = pos; 1709 m_moveToPositionTarget = pos;
1687 1710