bool isEqual(const yarp::sig::Matrix& m1, const yarp::sig::Matrix& m2, double precision) { if (m1.cols() != m2.cols() || m1.rows() != m2.rows()) { return false; } for (size_t i = 0; i < m1.rows(); i++) { if (!isEqual(m1.getRow(i), m2.getRow(i), precision)) { return false; } } return true; }
yarp::sig::Vector iCub::skinDynLib::toVector(yarp::sig::Matrix m) { Vector res(m.rows()*m.cols(),0.0); for (int r = 0; r < m.rows(); r++) { res.setSubvector(r*m.cols(),m.getRow(r)); } return res; }