inline Real cosDis(const MatD& a, const MatD& b){ return (a.array()*b.array()).sum()/(a.norm()*b.norm()); //return a.col(0).dot(b.col(0))/(a.norm()*b.norm()); }