nbv_sim/utils.py
Michel Breyer 9a03a26172 Cleanup
2021-07-06 14:00:04 +02:00

14 lines
382 B
Python

from geometry_msgs.msg import PoseStamped
import rospy
from robot_utils.ros.conversions import *
class CartesianPoseControllerClient:
def __init__(self, topic="/command"):
self.target_pub = rospy.Publisher(topic, PoseStamped, queue_size=10)
def send_target(self, pose):
msg = to_pose_stamped_msg(pose, "panda_link0")
self.target_pub.publish(msg)