Function RotUpToAngle

deps/glomap/glomap/math/gravity.cc:26–28

}

double RotUpToAngle(const Eigen::Matrix3d& R_up) {
  return RotationToAngleAxis(R_up)[1];
}

Eigen::Matrix3d AngleToRotUp(double angle) {
  Eigen::Vector3d aa(0, angle, 0);