added CloseEnough for vector<double> and Eigen2d
added CloseEnough for vector<double> and Eigen2d

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