Tunning params, adding extra arrow marker to show platform speed, and considering radius leg for body3d matching function.