[+] Better testing
[+] Added types.hpp
[+] Lots of cleanup and switched to column major matrices