diff --git a/armer/robots/ROSRobot.py b/armer/robots/ROSRobot.py index 385bfb1..707d65e 100644 --- a/armer/robots/ROSRobot.py +++ b/armer/robots/ROSRobot.py @@ -944,6 +944,8 @@ def named_pose_cb(self, goal: MoveToNamedPoseGoal) -> None: MoveToNamedPoseResult(success=False), 'Unknown named pose' ) + rospy.logwarn(f"-- Named pose goal ({goal.pose_name}) is unknown; refusing to move...") + return qd = np.array(self.named_poses[goal.pose_name]) @@ -1288,7 +1290,7 @@ def get_named_pose_configs_cb( :return: [description] :rtype: GetNamedPoseConfigsResponse """ - return self.custom_configs + return str(self.custom_configs) def set_pid(self, msg): """ @@ -1501,6 +1503,7 @@ def __vel_move(self, twist_stamped: TwistStamped) -> None: self.last_update = rospy.get_time() def pose_within_workspace(self, pose=Pose): + # TODO: The workspace should be stored in param server!!! path = rospy.get_param('/robot_workspace', '') if path == '': # No workspace defined - assume infinite workspace