Computing the Sine and Cosine of the COM for the Rotation Matrix

• The angle ? is not needed in the rotation matrix for the

reference vector. The trigonometric functions can be

computed directly using only a square root.