Skip to content

Commit

Permalink
Fix accel bug in PIPA calculation
Browse files Browse the repository at this point in the history
  • Loading branch information
n7275 committed Feb 26, 2024
1 parent 6f64e8e commit e9c7888
Showing 1 changed file with 3 additions and 3 deletions.
6 changes: 3 additions & 3 deletions Orbitersdk/samples/ProjectApollo/src_sys/imu.cpp
Original file line number Diff line number Diff line change
Expand Up @@ -500,9 +500,9 @@ void IMU::Timestep(double simdt)
SetOrbiterAttitudeReference();
calculatePhase(-GimbalPositionforPhase);

accel.x += pipaBiasScale.PIPA_BiasX + accel.x * pipaBiasScale.PIPA_ScalePPM_X;
accel.y += pipaBiasScale.PIPA_BiasY + accel.y * pipaBiasScale.PIPA_ScalePPM_Y;
accel.z += pipaBiasScale.PIPA_BiasZ + accel.z * pipaBiasScale.PIPA_ScalePPM_Z;
accel.x = pipaBiasScale.PIPA_BiasX + accel.x * pipaBiasScale.PIPA_ScalePPM_X;
accel.y = pipaBiasScale.PIPA_BiasY + accel.y * pipaBiasScale.PIPA_ScalePPM_Y;
accel.z = pipaBiasScale.PIPA_BiasZ + accel.z * pipaBiasScale.PIPA_ScalePPM_Z;

// pulse PIPAs
pulses = RemainingPIPA.X + (accel.x * LastSimDT / pipaRate);
Expand Down

0 comments on commit e9c7888

Please sign in to comment.