Initial attempt at mean removal

Assumes that the system in passed in with the correct dimensionality
and modified matrix. It is kind of a broken mode at the moment,
committing only so that we can look at what its doing.