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 4123dc6..20b14fe 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 @@ -2659,7 +2659,7 @@ class G1Deploy { // Runtime-adjustable via keys 9/0 (±1° steps), default -6°. double pitch_offset_rad = g_imu_pitch_offset_deg.load() * M_PI / 180.0; double half = pitch_offset_rad / 2.0; - std::array pitch_quat = {std::cos(half), std::sin(half), 0.0, 0.0}; // w,x,y,z + std::array pitch_quat = {std::cos(half), 0.0, std::sin(half), 0.0}; // w,x,y,z — Y-axis rotation std::array base_quat = quat_mul_d(pitch_quat, base_quat_raw); std::array base_ang_vel = float_to_double<3>(ls->imu_state().gyroscope()); std::array base_accel = float_to_double<3>(ls->imu_state().accelerometer());