Fixed bug in matrix multiplication and bugs in normalize function. Also
added printf's for all math structures and did some math testing.