5 files changed, 76 insertions, 14 deletions

diff --git a/OpenSim/Region/Physics/BasicPhysicsPlugin/BasicPhysicsPlugin.cs b/OpenSim/Region/Physics/BasicPhysicsPlugin/BasicPhysicsPlugin.cs
index 46037df..d5cb99f 100644
--- a/OpenSim/Region/Physics/BasicPhysicsPlugin/BasicPhysicsPlugin.cs
+++ b/OpenSim/Region/Physics/BasicPhysicsPlugin/BasicPhysicsPlugin.cs
@@ -181,6 +181,7 @@ namespace OpenSim.Region.Physics.BasicPhysicsPlugin
         private PhysicsVector _position;
         private PhysicsVector _velocity;
         private PhysicsVector _acceleration;
+        private PhysicsVector m_rotationalVelocity = PhysicsVector.Zero;
         private bool flying;
         private bool iscolliding;
 
@@ -190,7 +191,11 @@ namespace OpenSim.Region.Physics.BasicPhysicsPlugin
             _position = new PhysicsVector();
             _acceleration = new PhysicsVector();
         }
-
+        public override PhysicsVector RotationalVelocity
+        {
+            get { return m_rotationalVelocity; }
+            set { m_rotationalVelocity = value; }
+        }
         public override bool IsPhysical
         {
             get { return false; }
diff --git a/OpenSim/Region/Physics/BulletXPlugin/BulletXPlugin.cs b/OpenSim/Region/Physics/BulletXPlugin/BulletXPlugin.cs
index efc99e4..cdccc70 100644
--- a/OpenSim/Region/Physics/BulletXPlugin/BulletXPlugin.cs
+++ b/OpenSim/Region/Physics/BulletXPlugin/BulletXPlugin.cs
@@ -643,6 +643,7 @@ namespace OpenSim.Region.Physics.BulletXPlugin
         protected PhysicsVector _size;
         protected PhysicsVector _acceleration;
         protected AxiomQuaternion _orientation;
+        protected PhysicsVector m_rotationalVelocity = PhysicsVector.Zero;
         protected RigidBody rigidBody;
         private Boolean iscolliding = false;
 
@@ -662,6 +663,11 @@ namespace OpenSim.Region.Physics.BulletXPlugin
                 }
             }
         }
+        public override PhysicsVector RotationalVelocity
+        {
+            get { return m_rotationalVelocity; }
+            set { m_rotationalVelocity = value; }
+        }
         public override PhysicsVector Velocity
         {
             get { return _velocity; }
diff --git a/OpenSim/Region/Physics/Manager/PhysicsActor.cs b/OpenSim/Region/Physics/Manager/PhysicsActor.cs
index b151e16..2d8eb9a 100644
--- a/OpenSim/Region/Physics/Manager/PhysicsActor.cs
+++ b/OpenSim/Region/Physics/Manager/PhysicsActor.cs
@@ -36,6 +36,8 @@ namespace OpenSim.Region.Physics.Manager
 
     public delegate void OrientationUpdate(Quaternion orientation);
 
+    
+
     public abstract class PhysicsActor
     {
 #pragma warning disable 67
@@ -69,6 +71,7 @@ namespace OpenSim.Region.Physics.Manager
         public abstract bool Flying { get; set; }
 
         public abstract bool IsColliding { get; set; }
+        public abstract PhysicsVector RotationalVelocity { get; set; }
 
         public abstract bool Kinematic { get; set; }
 
@@ -144,7 +147,11 @@ namespace OpenSim.Region.Physics.Manager
         {
             return;
         }
-
+        public override PhysicsVector RotationalVelocity
+        {
+            get { return PhysicsVector.Zero; }
+            set { return; }
+        }
         public override void SetMomentum(PhysicsVector momentum)
         {
             return;
diff --git a/OpenSim/Region/Physics/OdePlugin/OdePlugin.cs b/OpenSim/Region/Physics/OdePlugin/OdePlugin.cs
index 8b8aac6..512b96e 100644
--- a/OpenSim/Region/Physics/OdePlugin/OdePlugin.cs
+++ b/OpenSim/Region/Physics/OdePlugin/OdePlugin.cs
@@ -617,6 +617,7 @@ namespace OpenSim.Region.Physics.OdePlugin
         private PhysicsVector _velocity;
         private PhysicsVector _target_velocity;
         private PhysicsVector _acceleration;
+        private PhysicsVector m_rotationalVelocity;
         private static float PID_D = 4000.0f;
         private static float PID_P = 7000.0f;
         private static float POSTURE_SERVO = 10000.0f;
@@ -682,7 +683,11 @@ namespace OpenSim.Region.Physics.OdePlugin
                 }
             }
         }
-
+        public override PhysicsVector RotationalVelocity
+        {
+            get { return m_rotationalVelocity; }
+            set { m_rotationalVelocity = value; }
+        }
         public override PhysicsVector Size
         {
             get { return new PhysicsVector(CAPSULE_RADIUS*2, CAPSULE_RADIUS*2, CAPSULE_LENGTH); }
@@ -858,6 +863,7 @@ namespace OpenSim.Region.Physics.OdePlugin
         private PhysicsVector _velocity;
         private PhysicsVector m_lastVelocity = new PhysicsVector(0.0f,0.0f,0.0f);
         private PhysicsVector m_lastposition = new PhysicsVector(0.0f, 0.0f, 0.0f);
+        private PhysicsVector m_rotationalVelocity;
         private PhysicsVector _size;
         private PhysicsVector _acceleration;
         public Quaternion _orientation;
@@ -887,6 +893,7 @@ namespace OpenSim.Region.Physics.OdePlugin
             _position = pos;
             _size = size;
             _acceleration = new PhysicsVector();
+            m_rotationalVelocity = PhysicsVector.Zero;
             _orientation = rotation;
             _mesh = mesh;
             _pbs = pbs;
@@ -1224,7 +1231,12 @@ namespace OpenSim.Region.Physics.OdePlugin
         }
         public void Move(float timestep)
         {
-
+            
+        }
+        public override PhysicsVector RotationalVelocity
+        {
+            get{ return m_rotationalVelocity;}
+            set { m_rotationalVelocity = value; }
         }
 
         public void UpdatePositionAndVelocity() {
@@ -1234,6 +1246,8 @@ namespace OpenSim.Region.Physics.OdePlugin
                 d.Vector3 vec = d.BodyGetPosition(Body);
                 d.Quaternion ori = d.BodyGetQuaternion(Body);
                 d.Vector3 vel = d.BodyGetLinearVel(Body);
+                d.Vector3 rotvel = d.BodyGetAngularVel(Body);
+               
                 PhysicsVector l_position = new PhysicsVector();
                 //  kluge to keep things in bounds.  ODE lets dead avatars drift away (they should be removed!)
                 if (vec.X < 0.0f) vec.X = 0.0f;
@@ -1256,7 +1270,7 @@ namespace OpenSim.Region.Physics.OdePlugin
                     try
                     {
                         disableBody();
-                        
+
                     }
                     catch (System.Exception e)
                     {
@@ -1264,13 +1278,16 @@ namespace OpenSim.Region.Physics.OdePlugin
                         {
                             d.BodyDestroy(Body);
                             Body = (IntPtr)0;
-                            
+
                         }
-                    }       
+                    }
                     IsPhysical = false;
                     _velocity.X = 0;
                     _velocity.Y = 0;
                     _velocity.Z = 0;
+                    m_rotationalVelocity.X = 0;
+                    m_rotationalVelocity.Y = 0;
+                    m_rotationalVelocity.Z = 0;
                     _zeroFlag = true;
                 }
 
@@ -1293,11 +1310,13 @@ namespace OpenSim.Region.Physics.OdePlugin
                     _velocity.X = 0.0f;
                     _velocity.Y = 0.0f;
                     _velocity.Z = 0.0f;
-                    _orientation.w = 0f;
-                    _orientation.x = 0f;
-                    _orientation.y = 0f;
-                    _orientation.z = 0f;
-
+                    //_orientation.w = 0f;
+                    //_orientation.x = 0f;
+                    //_orientation.y = 0f;
+                    //_orientation.z = 0f;
+                    m_rotationalVelocity.X = 0;
+                    m_rotationalVelocity.Y = 0;
+                    m_rotationalVelocity.Z = 0;
 
                 }
                 else
@@ -1310,6 +1329,10 @@ namespace OpenSim.Region.Physics.OdePlugin
                     _velocity.Y = vel.Y;
                     _velocity.Z = vel.Z;
 
+                    m_rotationalVelocity.X = rotvel.X;
+                    m_rotationalVelocity.Y = rotvel.Y;
+                    m_rotationalVelocity.Z = rotvel.Z;
+                    //System.Console.WriteLine("ODE: " + m_rotationalVelocity.ToString());
                     _orientation.w = ori.W;
                     _orientation.x = ori.X;
                     _orientation.y = ori.Y;
@@ -1317,6 +1340,17 @@ namespace OpenSim.Region.Physics.OdePlugin
                 }
 
             }
+            else
+            {
+                // Not a body..   so Make sure the client isn't interpolating
+                _velocity.X = 0;
+                _velocity.Y = 0;
+                _velocity.Z = 0;
+                m_rotationalVelocity.X = 0;
+                m_rotationalVelocity.Y = 0;
+                m_rotationalVelocity.Z = 0;
+                _zeroFlag = true;
+            }
 
         }
         public override void SetMomentum(PhysicsVector momentum)
diff --git a/OpenSim/Region/Physics/PhysXPlugin/PhysXPlugin.cs b/OpenSim/Region/Physics/PhysXPlugin/PhysXPlugin.cs
index 5483703..d282e9d 100644
--- a/OpenSim/Region/Physics/PhysXPlugin/PhysXPlugin.cs
+++ b/OpenSim/Region/Physics/PhysXPlugin/PhysXPlugin.cs
@@ -184,6 +184,7 @@ namespace OpenSim.Region.Physics.PhysXPlugin
     {
         private PhysicsVector _position;
         private PhysicsVector _velocity;
+        private PhysicsVector m_rotationalVelocity = PhysicsVector.Zero;
         private PhysicsVector _acceleration;
         private NxCharacter _character;
         private bool flying;
@@ -214,7 +215,11 @@ namespace OpenSim.Region.Physics.PhysXPlugin
             get { return iscolliding; }
             set { iscolliding = value; }
         }
-
+        public override PhysicsVector RotationalVelocity
+        {
+            get { return m_rotationalVelocity; }
+            set { m_rotationalVelocity = value; }
+        }
         public override PhysicsVector Position
         {
             get { return _position; }
@@ -314,6 +319,7 @@ namespace OpenSim.Region.Physics.PhysXPlugin
         private PhysicsVector _position;
         private PhysicsVector _velocity;
         private PhysicsVector _acceleration;
+        private PhysicsVector m_rotationalVelocity;
         private NxActor _prim;
 
         public PhysXPrim(NxActor prim)
@@ -329,7 +335,11 @@ namespace OpenSim.Region.Physics.PhysXPlugin
             get { return false; }
             set { return; }
         }
-
+        public override PhysicsVector RotationalVelocity
+        {
+            get { return m_rotationalVelocity; }
+            set { m_rotationalVelocity = value; }
+        }
         public override bool Flying
         {
             get { return false; //no flying prims for you