Fix intrinsics processing in case USAC parameters * fixed USAC intrinsics processing * change mat to matx33d, added test