C++ (Cpp) quat_from_rpy_cmd_f示例

示例#1

文件： stabilization_attitude_quat_transformations.c 项目： 2770862886/paparazzi

void quat_from_rpy_cmd_i(struct Int32Quat *quat, struct Int32Eulers *rpy) {
  struct FloatEulers rpy_f;
  EULERS_FLOAT_OF_BFP(rpy_f, *rpy);
  struct FloatQuat quat_f;
  quat_from_rpy_cmd_f(&quat_f, &rpy_f);
  QUAT_BFP_OF_REAL(*quat, quat_f);
}

示例#2

文件： stabilization_attitude_quat_float.c 项目： HeinrichChristian/paparazzi

void stabilization_attitude_set_rpy_setpoint_i(struct Int32Eulers *rpy) {
  // copy euler setpoint for debugging
  EULERS_FLOAT_OF_BFP(stab_att_sp_euler, *rpy);

  quat_from_rpy_cmd_f(&stab_att_sp_quat, &stab_att_sp_euler);
}