Use matrices for rotation.
Remove unnecessary setf.