Calculating the distance between two planes in rviz
Hello everyone, I am working on a project to calculate the distance between the vehicle's base and the ground. I am working on Ubuntu 11.10 with ROS-electric(with PCL) and using Asus xtion pro live RGB-D sensor. I have successfully filtered two planes. Necessary for the foot placement of a humanoid robot. Here is the video: http://www.youtube.com/watch?v=6x4PLk89mig . Is there an easy way to calculate the distance between these two planes rather than me plugging in formula(or developing a ROS node) to calculate the distance between the planes.
thanks, karthik.