Optimizations/documentation

+ Added Quaternion utility class.
+ Inlined performance critical methods.