Cleans up rotate functionality and tests
fixes matrix multiplication bug
Adds homogeneous matrices and accompanying tests
Updated readme
updated readme