Implemented NAV_PATH_UPDATED and UPDATE_NAV_PATH messages