GEEKING

App/util/HitTest.cpp

@@ -0,0 +1,157 @@
+/* Copyright 2003-2005 ROBLOX Corporation, All Rights Reserved */
+#include "stdafx.h"
+
+#include "Util/HitTest.h"
+#include "Util/Math.h"
+#include "Util/Extents.h"
+#include "AppDraw/DrawAdorn.h"
+#include "AppDraw/HitTest.h"
+#include "G3D/CollisionDetection.h"
+#include "G3D/Capsule.h"
+#include "v8datamodel/FastLogSettings.h"
+
+namespace RBX {
+
+bool HandleHitTest::hitTestHandleWorld(	const Extents& worldExtents,
+									    HandleType handleType,
+										const RbxRay& gridRay, 
+										Vector3& hitPointWorld,
+										NormalId& worldNormalId,
+										const int normalIdMask)
+{
+	CoordinateFrame location(worldExtents.center());
+	Extents localExtents = Extents::fromCenterCorner(Vector3::zero(), worldExtents.size() * 0.5);
+
+	return hitTestHandleLocal(	localExtents,
+								location,
+								handleType,
+								gridRay,
+								hitPointWorld,
+								worldNormalId,
+								normalIdMask);
+}
+
+bool HandleHitTest::hitTestHandleLocal(	const Extents& localExtents,
+										const CoordinateFrame& location,
+										HandleType handleType,
+										const RbxRay& gridRay, 
+										Vector3& hitPointWorld,
+										NormalId& localNormalId,
+										const int normalIdMask)
+{
+    for (int i = 0; i < 6; ++i)
+    {
+        if(normalIdMask & (1<<i))
+        {
+            if (handleType == HANDLE_MOVE)
+            {
+                const NormalId normalId = intToNormalId(i);
+                const Vector3 handlePos = DrawAdorn::handlePosInObject(
+                    gridRay.origin(),
+                    localExtents,
+                    HANDLE_MOVE,
+                    normalId );
+                const Vector3 handleInWorld = location.pointToWorldSpace(handlePos);
+                const float handleRadius = DrawAdorn::scaleHandleRelativeToCamera(
+                    gridRay.origin(),
+                    HANDLE_MOVE,
+                    handleInWorld );
+
+                const Vector3 arrow = location.vectorToWorldSpace(normalIdToVector3(normalId) * handleRadius);
+                float capsuleRadius = (RBX::ClientAppSettings::singleton().GetValueAxisAdornmentGrabSize()/100.0f) * handleRadius;
+                
+                Vector3 hitPoint;
+
+                if ( G3D::CollisionDetection::collisionTimeForMovingPointFixedCapsule(
+                        gridRay.origin(), 
+                        gridRay.direction(), 
+                        G3D::Capsule(handleInWorld,handleInWorld + arrow, capsuleRadius), 
+                        hitPoint ) != G3D::inf() ) 
+                {
+                    localNormalId = normalId;
+                    hitPointWorld = hitPoint;
+                    return true;
+                }
+            }
+            else
+            {
+                Vector3 localCenter = DrawAdorn::handlePosInObject(
+                    gridRay.origin(),
+                    localExtents, 
+                    handleType, 
+                    intToNormalId(i) );
+
+                Vector3 worldCenter = location.pointToWorldSpace(localCenter);
+
+                float handleRadius = DrawAdorn::scaleHandleRelativeToCamera(
+                    gridRay.origin(),
+                    handleType,
+                    worldCenter);
+
+                Vector3 tempHitPoint;
+
+                float collision_time = G3D::CollisionDetection::collisionTimeForMovingPointFixedSphere(
+                    gridRay.origin(),
+                    gridRay.direction(),
+                    Sphere(worldCenter, handleRadius),
+                    tempHitPoint );
+
+                if ( collision_time != G3D::inf() ) 
+                {
+                    localNormalId = NormalId(i);
+                    hitPointWorld = worldCenter;
+                    return true;
+                }
+            }
+        }
+    }
+    return false;
+}
+
+bool HandleHitTest::hitTestMoveHandleWorld(const Extents& worldExtents,
+										const RbxRay& gridRay, 
+										Vector3& hitPointWorld,
+										NormalId& worldNormalId,
+										const int normalIdMask)
+{
+	const CoordinateFrame location(worldExtents.center());
+    const Vector3 halfSize = worldExtents.size() / 2;
+    const Extents localExtents(-halfSize,halfSize);
+
+	for (int i = 0; i < 6; ++i) 
+	{
+		if(normalIdMask & (1<<i))
+		{
+			const NormalId normalId = intToNormalId(i);
+            const Vector3 handlePos = DrawAdorn::handlePosInObject(
+                gridRay.origin(),
+                localExtents,
+                HANDLE_MOVE,
+                normalId );
+            const Vector3 handleInWorld = location.pointToWorldSpace(handlePos);
+            const float handleRadius = DrawAdorn::scaleHandleRelativeToCamera(
+                gridRay.origin(),
+                HANDLE_MOVE,
+                handleInWorld );
+
+            const Vector3 arrow = normalIdToVector3(normalId) * handleRadius;
+			float capsuleRadius = (RBX::ClientAppSettings::singleton().GetValueAxisAdornmentGrabSize()/100.0f) * handleRadius;
+            
+            Vector3 hitPoint;
+
+            if ( G3D::CollisionDetection::collisionTimeForMovingPointFixedCapsule(
+                    gridRay.origin(), 
+                    gridRay.direction(), 
+                    G3D::Capsule(handleInWorld,handleInWorld + arrow, capsuleRadius), 
+                    hitPoint ) != G3D::inf() ) 
+            {
+                worldNormalId = normalId;
+                hitPointWorld = hitPoint;
+                return true;
+            }
+		}
+	}
+	return false;
+}
+
+}	// namespace RBX