diff --git a/gear_sonic_deploy/src/g1/g1_deploy_onnx_ref/src/g1_deploy_onnx_ref.cpp b/gear_sonic_deploy/src/g1/g1_deploy_onnx_ref/src/g1_deploy_onnx_ref.cpp index cd4ecc3..aa81783 100644 --- a/gear_sonic_deploy/src/g1/g1_deploy_onnx_ref/src/g1_deploy_onnx_ref.cpp +++ b/gear_sonic_deploy/src/g1/g1_deploy_onnx_ref/src/g1_deploy_onnx_ref.cpp @@ -2657,7 +2657,7 @@ class G1Deploy { // IMU pitch correction: G1's IMU is mounted with ~6° forward pitch offset. // The NN was trained with a perfect IMU, so we pre-rotate by -6° about Y axis // to correct the bias before it enters observations (gravity dir, heading, etc.). - constexpr double IMU_PITCH_OFFSET_RAD = -6.0 * M_PI / 180.0; // negative = correct forward lean + constexpr double IMU_PITCH_OFFSET_RAD = 6.0 * M_PI / 180.0; // positive = correct backward lean static const auto imu_pitch_correction = quat_from_angle_axis_d(IMU_PITCH_OFFSET_RAD, {0.0, 1.0, 0.0}); std::array base_quat = quat_mul_d(imu_pitch_correction, base_quat_raw); std::array base_ang_vel = float_to_double<3>(ls->imu_state().gyroscope());