fixed Eigen-KDL 3D Vector conversion functions
fixed error in Eigen vector type
Merge branch 'hydro-devel' of github.com:fevb/geometry into fevb