Searched refs:fJe_inverse (Results 1 – 3 of 3) sorted by relevance
506 void vpAfma4::get_fJe_inverse(const vpColVector &q, vpMatrix &fJe_inverse) const in get_fJe_inverse()508 fJe_inverse.resize(4, 6); in get_fJe_inverse()509 fJe_inverse = 0; in get_fJe_inverse()521 fJe_inverse[0][0] = (-s1 * this->_a1 - c1 * this->_d3) / det; in get_fJe_inverse()522 fJe_inverse[0][1] = (c1 * this->_a1 - s1 * this->_d3) / det; in get_fJe_inverse()524 fJe_inverse[1][2] = fJe_inverse[2][5] = 1.; in get_fJe_inverse()526 fJe_inverse[2][0] = -fJe_inverse[0][0]; in get_fJe_inverse()527 fJe_inverse[2][1] = -fJe_inverse[0][1]; in get_fJe_inverse()529 fJe_inverse[3][3] = c14; in get_fJe_inverse()530 fJe_inverse[3][4] = s14; in get_fJe_inverse()
1203 vpMatrix fJe_inverse; in setVelocity() local1204 get_fJe_inverse(q, fJe_inverse); in setVelocity()1213 vpMatrix eJe_inverse = fJe_inverse * fVe; in setVelocity()
133 void get_fJe_inverse(const vpColVector &q, vpMatrix &fJe_inverse) const;