switch from custom message to a PoseStamped

[Maik93]

I don't think that there's any need of a custom message here.

A geometry_msg PoseStamped can be used instead, with the benefit of a native visualization in rviz2 and no dependencies between other packages and this one when reading the published pose.