diff --git a/src/UsgsAstroPushFrameSensorModel.cpp b/src/UsgsAstroPushFrameSensorModel.cpp index 034fb51d63cfcd8b1d81918ac162c45769bc5d5c..10542000c09c8a554d2511ff8c050e7c0a269a33 100644 --- a/src/UsgsAstroPushFrameSensorModel.cpp +++ b/src/UsgsAstroPushFrameSensorModel.cpp @@ -518,6 +518,11 @@ void UsgsAstroPushFrameSensorModel::applyTransformToState(ale::Rotation const& r applyRotationTranslationToXyzVec(r, zero_t, velocities); j["m_velocities"] = velocities; + // Apply the transform to the reference point + std::vector<double> refPt = j["m_referencePointXyz"]; + applyRotationTranslationToXyzVec(r, t, refPt); + j["m_referencePointXyz"] = refPt; + // We do not change the Sun position or velocity. The idea is that // the Sun is so far, that minor camera adjustments won't affect // where the Sun is. diff --git a/src/Utilities.cpp b/src/Utilities.cpp index 337e1e37abb1a462bbc7df372fdd7f51e111e3f5..fcf20e63e6c5c31609d7699fc11011bc2a1cb090 100644 --- a/src/Utilities.cpp +++ b/src/Utilities.cpp @@ -34,7 +34,7 @@ void calculateRotationMatrixFromEuler(double euler[], double rotationMatrix[]) { rotationMatrix[8] = cos_a * cos_b; } -// uses a quaternion to calclate a rotation matrix. +// uses a quaternion to calculate a rotation matrix. // in - q[4] // out - rotationMatrix[9] void calculateRotationMatrixFromQuaternions(double q[4],