Correct a few bugs in the optitrack sensor. Also add the quaternion to the tracked object.