Added some basic functionality to the Quat class. Split some of main.cpp into the Body class and header.
Rotation not yet implemented.