Added vector versions of Geometry Point/Vector3 to Eigen Vector3d conversion functions.
Added vector versions of Geometry Point/Vector3 to Eigen Vector3d conversion functions.

WPI-ARC/arc_utilities,UM-ARM-Lab/arc_utilities,UM-ARM-Lab/arc_utilities,WPI-ARC/arc_utilities,UM-ARM-Lab/arc_utilities,WPI-ARC/arc_utilities