Debugging

Matrix mult leaves (1,1) with constant magnitude due to Im(1,1) drift.
Repaired mathematical methods
Merge pull request #1 from ghallsimpsons/debug

Debug