Fixed issues with coordinate wrapping during integration; improved implementation of select matrix operations
