Use current rotation matrix for vision instead of delayed rotation