fixed pose estimate after solve