Adds support for raycasting in drake

This adds support for raycasting as we wrote it together.  Also adds a test for raycasting which is very similar to the simple example we wrote up.