CHANGE These look like type operations on pose. Perhaps implement XArmPose(ManipulatorPose(PoseStamped)) No conversions in main logic _Originally posted by @spomichter in https://github.com/dimensionalOS/dimos/pull/970#discussion_r2684447609_