Added error pose publishing to estimator