Fix: Clean up and restore support for integrating DAE states
The support for integrating DAE states with CollocatedIntegratedOptimizationProblem had undergone some decay. This PR cleans up and fixes the state integration functionality.
The support for integrating DAE states with CollocatedIntegratedOptimizationProblem had undergone some decay. This PR cleans up and fixes the state integration functionality.