Switch from MatrixXd to Data::Matrix6x for holding jacobians

src/algorithm/jacobian.hpp

src/algorithm/jacobian.hxx

src/algorithm/operational-frames.hpp

src/python/algorithms.hpp

unittest/jacobian.cpp

unittest/operational-frames.cpp