Fixed some transforms, move to 3d and quaternion math in progress...