Bug Fixes.

A shit ton of fixes for matrices and quaternion.