Updated matrix math library to include a a new normalize function that attempts to assign the errors in a more sophisticated manner than the simple normalize function. Also makes use of taylor expansion to avoid square root (how much of a saving is this?). Not sure which normalize function we'll end up using.