void IDifferentialEquationSolver.CopyVariablesToSolver(int offset, double[] variables) { Array.Copy(variables, offset, relativePosition, 0, 3); Array.Copy(variables, offset + 3, relativeVelocity, 0, 3); RealMatrix.Normalize(variables, offset + 6, 4); Array.Copy(variables, offset + 6, relativeQuaternion, 0, 4); Array.Copy(variables, offset + 10, omega, 0, 3); SetRelative(); }