First outcast on a step with backward euler. Attempted having u being 2 longer than the matrix.
Reverted to the same indexing used in project 1. It works, but may contain a small error.