NavMesh: Paths don't follow NavMesh surface

[musk]

You could consider using a physics engine. like Havok

Chaotic movement of a man within a room

In this PG, the purple box is the crowd agent (a box attached to the crowd agent actually) and the grey box is a physics impostor that follows the agent. You can achieve that with just a call to setLinearVelocity. See lines 91-100 https://www.babylonjs-playground.com/#X5XCVT#146