fixed angle bug in pose estimate tool and 2d nav goal tool