(position, orientation, frame)
| 15 | from open3d_ros_helper import open3d_ros_helper as orh |
| 16 | |
| 17 | def get_stamped_pose(position, orientation, frame): |
| 18 | stamped_pose = geometry_msgs.msg.PoseStamped() |
| 19 | stamped_pose.header.frame_id = frame |
| 20 | stamped_pose.header.stamp = rospy.Time.now() |
| 21 | stamped_pose.pose.position.x = position[0] |
| 22 | stamped_pose.pose.position.y = position[1] |
| 23 | stamped_pose.pose.position.z = position[2] |
| 24 | stamped_pose.pose.orientation.x = orientation[0] |
| 25 | stamped_pose.pose.orientation.y = orientation[1] |
| 26 | stamped_pose.pose.orientation.z = orientation[2] |
| 27 | stamped_pose.pose.orientation.w = orientation[3] |
| 28 | return stamped_pose |
| 29 | |
| 30 | def get_pose_msg(position, orientation): |
| 31 | pose_goal = geometry_msgs.msg.Pose() |
no outgoing calls
no test coverage detected