Add quat debug stuff, lots of little cleanup stuff. Add project/unproject in mat4