Ejemplo n.º 1
0
void GetRPY(const tf::Matrix3x3 &m, double &r, double &p, double &y) {
    m.getRPY(r, p, y);
}