How to get visualization_msgs::Marker::CUBE vertex coordinates?
Hello!
I have a visualization_msgs::Marker::CUBE called box with the values:
box.pose.position.x = (m_point[0].x + m_point[1].x)/2;
box.pose.position.y = (m_point[0].y + m_point[1].y)/2;
box.pose.position.z = (m_point[0].z + m_point[1].z)/2;
box.pose.orientation.x = 0.0;
box.pose.orientation.y = 0.0;
box.pose.orientation.z = 0.0;
box.pose.orientation.w = 1.0;
box.scale.x = (m_point[0].x - m_point[1].x);
box.scale.y = (m_point[0].y - m_point[1].y);
box.scale.z = (m_point[0].z - m_point[1].z);
where m.point[0] is min and m.point[1] is max.
Is there a way I can get the xyz coordinates of the corner or edge of this box?
Thanks!