Added some draft code for quaternion math