Uptade pose2d converter to try to fix quat output