In particular, we weren't setting NAV_CONTROLLER_OUTPUT.wp_dist correctly before a recent commit from Randy