2d_nav and 2d_nav_slam for mp_400 replaced