1 files changed, 31 insertions, 2 deletions

diff --git a/OpenSim/Region/ScriptEngine/Common/LSL_BuiltIn_Commands.cs b/OpenSim/Region/ScriptEngine/Common/LSL_BuiltIn_Commands.cs
index 42c5abc..cbd4db2 100644
--- a/OpenSim/Region/ScriptEngine/Common/LSL_BuiltIn_Commands.cs
+++ b/OpenSim/Region/ScriptEngine/Common/LSL_BuiltIn_Commands.cs
@@ -450,14 +450,43 @@ namespace OpenSim.Region.ScriptEngine.Common
         public LSL_Types.Vector3 llRot2Left(LSL_Types.Quaternion r)
         {
             m_host.AddScriptLPS(1);
-            return (new LSL_Types.Vector3(0, 1, 0) * r);
+            double x,y,z,m;
+            m = Math.Sqrt(r.x*r.x+r.y*r.y+r.z*r.z+r.s*r.s);
+            // m is always greater than zero
+            if (m!=1) // if m is not equal to 1 then Rotation needs to be normalized
+            {
+                r.x/=m;
+                r.y/=m;
+                r.z/=m;
+                r.s/=m;
+            }
+            // Fast Algebric Calculations instead of Vectors & Quaternions Product
+            x = 2*(r.x*r.y-r.z*r.s);
+            y = -r.x*r.x+r.y*r.y-r.z*r.z+r.s*r.s;
+            z = 2*(r.x*r.s+r.y*r.z);
+            return (new LSL_Types.Vector3(x,y,z)); 
         }
 
         public LSL_Types.Vector3 llRot2Up(LSL_Types.Quaternion r)
         {
             m_host.AddScriptLPS(1);
-            return (new LSL_Types.Vector3(0, 0, 1) * r);
+            double x,y,z,m;
+            m = Math.Sqrt(r.x*r.x+r.y*r.y+r.z*r.z+r.s*r.s);
+            // m is always greater than zero
+            if (m!=1) // if m is not equal to 1 then Rotation needs to be normalized
+            {
+                r.x/=m;
+                r.y/=m;
+                r.z/=m;
+                r.s/=m;
+            }
+            // Fast Algebric Calculations instead of Vectors & Quaternions Product
+            x = 2*(r.x*r.z+r.y*r.s);
+            y = 2*(-r.x*r.s+r.y*r.z);
+            z = -r.x*r.x-r.y*r.y+r.z*r.z+r.s*r.s;
+            return (new LSL_Types.Vector3(x,y,z));
         }
+        
         public LSL_Types.Quaternion llRotBetween(LSL_Types.Vector3 a, LSL_Types.Vector3 b)
         {
             //A and B should both be normalized