Merge pull request #13602 from CedricGuillemet/Physicsiteration13

Center/Extent fix for aggregates

Author: sebavan

packages/dev/core/src/Physics/v2/physicsAggregate.ts

@@ -94,6 +94,11 @@ export interface PhysicsAggregateParameters {
      * Extents for box
      */
     extents?: Vector3;
+
+    /**
+     * mesh local center
+     */
+    center?: Vector3;
 }
 /**
  * Helper class to create and interact with a PhysicsAggregate.
@@ -155,6 +160,7 @@ export class PhysicsAggregate {
 
         this.body = new PhysicsBody(transformNode, this._scene);
         this._addSizeOptions();
+        this._options.center = _options.center ?? this.body.getObjectCenterDelta();
         this.shape = new PhysicsShape({ type, parameters: this._options as any }, this._scene);
 
         this.material = new PhysicsMaterial(this._options.friction, this._options.restitution, this._scene);
@@ -190,13 +196,11 @@ export class PhysicsAggregate {
                     this._options.pointB = this._options.pointB ? this._options.pointB : new Vector3(0, impostorExtents.y * 0.5, 0);
                 }
                 break;
+            case ShapeType.MESH:
+            case ShapeType.CONVEX_HULL:
             case ShapeType.BOX:
                 this._options.extents = this._options.extents ? this._options.extents : new Vector3(impostorExtents.x, impostorExtents.y, impostorExtents.z);
                 break;
-            case ShapeType.MESH:
-            case ShapeType.CONVEX_HULL: {
-                break;
-            }
         }
     }
 

packages/dev/core/src/Physics/v2/physicsBody.ts

@@ -372,6 +372,7 @@ export class PhysicsBody {
             if (worldMatrix) {
                 worldMatrix.decompose(scaling, undefined, undefined);
             }
+            tmAbstractMesh.refreshBoundingInfo();
             const boundingInfo = tmAbstractMesh.getBoundingInfo();
             // get the global scaling of the object
             const size = boundingInfo.boundingBox.extendSize.scale(2).multiplyInPlace(scaling);
@@ -388,6 +389,28 @@ export class PhysicsBody {
         }
     }
 
+    /**
+     * returns the delta between the object bounding box center and the mesh origin
+     * @returns delta between object bounding box center and origin
+     */
+    public getObjectCenterDelta(): Vector3 {
+        const tmAbstractMesh = this.transformNode as AbstractMesh;
+        if (tmAbstractMesh.getBoundingInfo) {
+            const delta = new Vector3();
+            const boundingInfo = tmAbstractMesh.getBoundingInfo();
+            this.transformNode.computeWorldMatrix(true);
+            tmAbstractMesh.refreshBoundingInfo();
+            delta.copyFrom(boundingInfo.boundingBox.centerWorld);
+            delta.subtractInPlace(tmAbstractMesh.getAbsolutePosition());
+            delta.x /= tmAbstractMesh.scaling.x;
+            delta.y /= tmAbstractMesh.scaling.y;
+            delta.z /= tmAbstractMesh.scaling.z;
+            return delta;
+        } else {
+            return Vector3.Zero();
+        }
+    }
+
     /**
      * @returns geometric center of the associated mesh
      */