Working on Fixed point class, Matrix class using fixed point.
Upped SDFilesystem SPI freq to 5MHz from 1MHz to reduce write time (15ms to 6ms on mbed)
Did some cleanup of SystemState, minor fixes here and there.
Removed *printf from everywhere possible to reduce code size. Saved 4k or so. Minor fixes.