Minor fixes to math plus matrix2x2 added