[WIP] Improvesment in speed and a test for soder.m.

The test isn't working yet. I think I must be defining something wrong in the test.