Collision Geometries correctly positioned (Self collisions solved)