Added Quaternions and did some more testing in main.