Added current pose publisher to the controller