Fixed bug to disallow inverted pose estimates (fixed problems that weren't)
actually fixed in previous commit.