ellensohn/cps_rmp220_support
1
0
Fork 0
mirror of https://github.com/bjoernellens1/cps_rmp220_support.git synced 2025-01-18 15:46:59 +00:00
Code Issues Packages Projects Releases Wiki Activity

update

Browse Source
This commit is contained in:
Your Name 2025-01-15 09:22:19 +01:00
parent 91c376089f
commit d449eacee0
1 changed files with 14 additions and 0 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

14
nodes/odom_publisher_linus.py
View File

@ -25,6 +25,20 @@ def odom_callback(msg):
# Publish the transform
tf_broadcaster.sendTransform(odom_trans)
# print debug info
rospy.loginfo("Position: x={}, y={}, z={}".format(
msg.pose.pose.position.x,
msg.pose.pose.position.y,
msg.pose.pose.position.z
))
rospy.loginfo("Orientation: x={}, y={}, z={}, w={}".format(
msg.pose.pose.orientation.x,
msg.pose.pose.orientation.y,
msg.pose.pose.orientation.z,
msg.pose.pose.orientation.w
))
if __name__ == "__main__":
rospy.init_node("tf2_broadcaster")