void GetHighland(const tf::Matrix3x3 & m, tf::Vector3 & xaxis, tf::Vector3 & zaxis) { tf::Vector3 v1, v2, v3; xaxis = m.getColumn(0); zaxis = m.getColumn(2); }