smt: gsp: Change angle convergence in lab

Instead of looking at the magnitude of the quaternion error vector, look at
the projected error about the Z axis.