Vectorizes raycasting code

Test now does a comparison between non-vectorized and vectorized code.  Speeds up 629 raycasts by 65x.
doh.  andy... everything else in drake is 3xN (including the output of forwardKin).  can we flip this?