Path interface improvements and save/restore robots positions