Physics::CollisionDetection:fix missing normal, other improvements