updated to fly with relative pose