Clean up

Removed unnecessary for-loops, and weird exception throwing statement, added comment.

Changed the part in gauss where diagonal elements where made = 1, to avoid silly ArrayIndexOutOfBoundsException.

Moved the rounding to Matrix, because before it wasn't actually doing anything with the elements of the Matrix, it just played with the values.