GPUDisplay.cxx

Go to the documentation of this file.

// Copyright 2019-2020 CERN and copyright holders of ALICE O2.
// See https://alice-o2.web.cern.ch/copyright for details of the copyright holders.
// All rights not expressly granted are reserved.
//
// This software is distributed under the terms of the GNU General Public
// License v3 (GPL Version 3), copied verbatim in the file "COPYING".
//
// In applying this license CERN does not waive the privileges and immunities
// granted to it by virtue of its status as an Intergovernmental Organization
// or submit itself to any jurisdiction.
 
 
#include "GPUDisplay.h"
#include "frontend/GPUDisplayInfo.inc"
 
#include "GPUTPCDef.h"
#include "HandMadeMath.h"
 
#include <vector>
#include <memory>
#include <cstring>
#include <stdexcept>
#include <mutex>
#include <condition_variable>
 
#ifndef _WIN32
#include "../utils/linux_helpers.h"
#endif
 
#include "GPUChainTracking.h"
#include "GPUQA.h"
#include "GPUTPCTrackingData.h"
#include "GPUChainTracking.h"
#include "GPUTPCTrack.h"
#include "GPUTPCTracker.h"
#include "GPUTPCGMMergedTrack.h"
#include "GPUO2DataTypes.h"
#include "GPUSettings.h"
 
#include "frontend/GPUDisplayFrontend.h"
#include "backend/GPUDisplayBackend.h"
#include "helpers/GPUDisplayColors.inc"
 
constexpr hmm_mat4 MY_HMM_IDENTITY = {{{1, 0, 0, 0}, {0, 1, 0, 0}, {0, 0, 1, 0}, {0, 0, 0, 1}}};
 
using namespace o2::gpu;
 
const GPUSettingsDisplay& GPUDisplay::GetConfig(GPUChainTracking* chain)
{
  static GPUSettingsDisplay defaultConfig;
  return (chain && chain->mConfigDisplay) ? *chain->mConfigDisplay : defaultConfig;
}
 
const GPUSettingsProcessing& GPUDisplay::GetProcessingConfig(GPUChainTracking* chain)
{
  static GPUSettingsProcessing defaultConfig;
  return chain ? chain->GetProcessingSettings() : defaultConfig;
}
 
GPUDisplay::GPUDisplay(GPUDisplayFrontend* frontend, GPUChainTracking* chain, GPUQA* qa, const GPUParam* param, const GPUCalibObjectsConst* calib, const GPUSettingsDisplay* config, const GPUSettingsProcessing* proc) : GPUDisplayInterface(), mFrontend(frontend), mChain(chain), mConfig(config ? *config : GetConfig(chain)), mProcessingSettings(proc ? *proc : GetProcessingConfig(chain)), mQA(qa)
{
  mViewMatrix = std::make_unique<hmm_mat4>();
  mModelMatrix = std::make_unique<hmm_mat4>();
  mParam = param ? param : &mChain->GetParam();
  mCalib = calib;
  mCfgL = mConfig.light;
  mCfgH = mConfig.heavy;
  mCfgR = mConfig.renderer;
  mBackend.reset(GPUDisplayBackend::getBackend(mConfig.displayRenderer.c_str()));
  if (!mBackend) {
    throw std::runtime_error("Error obtaining display backend");
  }
  mBackend->mDisplay = this;
  frontend->mDisplay = this;
  frontend->mBackend = mBackend.get();
  mCfgR.rendererCompatSmoothing &= !mBackend->CoreProfile();
}
 
void GPUDisplay::calcXYZ(const float* matrix)
{
  mXYZ[0] = -(matrix[0] * matrix[12] + matrix[1] * matrix[13] + matrix[2] * matrix[14]);
  mXYZ[1] = -(matrix[4] * matrix[12] + matrix[5] * matrix[13] + matrix[6] * matrix[14]);
  mXYZ[2] = -(matrix[8] * matrix[12] + matrix[9] * matrix[13] + matrix[10] * matrix[14]);
 
  mAngle[0] = -asinf(matrix[6]); // Invert rotY*rotX*rotZ
  float A = cosf(mAngle[0]);
  if (fabsf(A) > 0.005) {
    mAngle[1] = atan2f(-matrix[2] / A, matrix[10] / A);
    mAngle[2] = atan2f(matrix[4] / A, matrix[5] / A);
  } else {
    mAngle[1] = 0;
    mAngle[2] = atan2f(-matrix[1], -matrix[0]);
  }
 
  mRPhiTheta[0] = sqrtf(mXYZ[0] * mXYZ[0] + mXYZ[1] * mXYZ[1] + mXYZ[2] * mXYZ[2]);
  mRPhiTheta[1] = atan2f(mXYZ[0], mXYZ[2]);
  mRPhiTheta[2] = atan2f(mXYZ[1], sqrtf(mXYZ[0] * mXYZ[0] + mXYZ[2] * mXYZ[2]));
 
  createQuaternionFromMatrix(mQuat, matrix);
 
  /*float mAngle[1] = -asinf(matrix[2]); //Calculate Y-axis angle - for rotX*rotY*rotZ
  float C = cosf( angle_y );
  if (fabsf(C) > 0.005) //Gimball lock?
  {
      mAngle[0]  = atan2f(-matrix[6] / C, matrix[10] / C);
      mAngle[2]  = atan2f(-matrix[1] / C, matrix[0] / C);
  }
  else
  {
      mAngle[0]  = 0; //set x-angle
      mAngle[2]  = atan2f(matrix[4], matrix[5]);
  }*/
}
 
void GPUDisplay::SetCollisionFirstCluster(uint32_t collision, int32_t sector, int32_t cluster)
{
  mNCollissions = std::max<uint32_t>(mNCollissions, collision + 1);
  mOverlayTFClusters.resize(mNCollissions);
  mOverlayTFClusters[collision][sector] = cluster;
}
 
void GPUDisplay::mAnimationCloseAngle(float& newangle, float lastAngle)
{
  const float delta = lastAngle > newangle ? (2 * CAMath::Pi()) : (-2 * CAMath::Pi());
  while (fabsf(newangle + delta - lastAngle) < fabsf(newangle - lastAngle)) {
    newangle += delta;
  }
}
void GPUDisplay::mAnimateCloseQuaternion(float* v, float lastx, float lasty, float lastz, float lastw)
{
  float distPos2 = (lastx - v[0]) * (lastx - v[0]) + (lasty - v[1]) * (lasty - v[1]) + (lastz - v[2]) * (lastz - v[2]) + (lastw - v[3]) * (lastw - v[3]);
  float distNeg2 = (lastx + v[0]) * (lastx + v[0]) + (lasty + v[1]) * (lasty + v[1]) + (lastz + v[2]) * (lastz + v[2]) + (lastw + v[3]) * (lastw + v[3]);
  if (distPos2 > distNeg2) {
    for (int32_t i = 0; i < 4; i++) {
      v[i] = -v[i];
    }
  }
}
 
void GPUDisplay::ResizeScene(int32_t width, int32_t height, bool init)
{
  if (height == 0) { // Prevent A Divide By Zero By
    height = 1;      // Making Height Equal One
  }
 
  mBackend->resizeScene(width, height);
 
  if (init) {
    mResetScene = true;
    *mViewMatrix = MY_HMM_IDENTITY;
    *mModelMatrix = MY_HMM_IDENTITY;
  }
}
 
void GPUDisplay::updateConfig()
{
  mBackend->setQuality();
  mBackend->setDepthBuffer();
}
 
inline void GPUDisplay::drawVertices(const vboList& v, const GPUDisplayBackend::drawType t)
{
  mNDrawCalls += mBackend->drawVertices(v, t);
}
 
int32_t GPUDisplay::InitDisplay(bool initFailure)
{
  int32_t retVal = initFailure;
  try {
    if (!initFailure) {
      retVal = InitDisplay_internal();
    }
  } catch (const std::runtime_error& e) {
    GPUError("%s", e.what());
    retVal = 1;
  }
  mInitResult = retVal == 0 ? 1 : -1;
  return (retVal);
}
 
int32_t GPUDisplay::InitDisplay_internal()
{
  mThreadBuffers.resize(getNumThreads());
  mThreadTracks.resize(getNumThreads());
  if (mBackend->InitBackend()) {
    return 1;
  }
  mYFactor = mBackend->getYFactor();
  mDrawTextInCompatMode = !mBackend->mFreetypeInitialized && mFrontend->mCanDrawText == 1;
  int32_t height = 0, width = 0;
  mFrontend->getSize(width, height);
  if (height == 0 || width == 0) {
    width = GPUDisplayFrontend::INIT_WIDTH;
    height = GPUDisplayFrontend::INIT_HEIGHT;
  }
  ResizeScene(width, height, true);
  return 0;
}
 
void GPUDisplay::ExitDisplay()
{
  mBackend->ExitBackend();
}
 
int32_t GPUDisplay::DrawGLScene()
{
  // Make sure event gets not overwritten during display
  mSemLockDisplay.Lock();
 
  int32_t retVal = 0;
  if (mChain) {
    mIOPtrs = &mChain->mIOPtrs;
    mCalib = &mChain->GetCalib();
  }
  if (!mIOPtrs) {
    mNCollissions = 0;
  } else if (!mOverlayTFClusters.size()) {
    mNCollissions = std::max(1u, mIOPtrs->nMCInfosTPCCol);
  }
  try {
    DrawGLScene_internal();
  } catch (const std::runtime_error& e) {
    GPUError("Runtime error %s during display", e.what());
    retVal = 1;
  }
 
  if (mLoadAndShowEvent) {
    {
      std::lock_guard<std::mutex> lock(mMutexLoadAndShowEvent);
      mLoadAndShowEvent = false;
    }
    mCVLoadAndShowEvent.notify_one();
  }
  mSemLockDisplay.Unlock();
 
  return retVal;
}
 
void GPUDisplay::DrawGLScene_cameraAndAnimation(float animateTime, float& mixSlaveImage, hmm_mat4& nextViewMatrix)
{
  HighResTimer timer(mUpdateVertexLists && mChain->GetProcessingSettings().debugLevel >= 2);
  int32_t mMouseWheelTmp = mFrontend->mMouseWheel;
  mFrontend->mMouseWheel = 0;
  bool lookOrigin = mCfgR.camLookOrigin ^ mFrontend->mKeys[mFrontend->KEY_ALT];
  bool yUp = mCfgR.camYUp ^ mFrontend->mKeys[mFrontend->KEY_CTRL] ^ lookOrigin;
  bool rotateModel = mFrontend->mKeys[mFrontend->KEY_RCTRL] || mFrontend->mKeys[mFrontend->KEY_RALT];
  bool rotateModelTPC = mFrontend->mKeys[mFrontend->KEY_RALT];
 
  // Calculate rotation / translation scaling factors
  float scalefactor = mFrontend->mKeys[mFrontend->KEY_SHIFT] ? 0.2f : 1.0f;
  float rotatescalefactor = scalefactor * 0.25f;
  if (mCfgL.drawSector != -1) {
    scalefactor *= 0.2f;
  }
  float* const mViewMatrixP = &mViewMatrix->Elements[0][0];
  float sqrdist = sqrtf(sqrtf(mViewMatrixP[12] * mViewMatrixP[12] + mViewMatrixP[13] * mViewMatrixP[13] + mViewMatrixP[14] * mViewMatrixP[14]) * GL_SCALE_FACTOR) * 0.8f;
  if (sqrdist < 0.2f) {
    sqrdist = 0.2f;
  }
  if (sqrdist > 5.f) {
    sqrdist = 5.f;
  }
  scalefactor *= sqrdist;
 
  // Perform new rotation / translation / animation
 
  if (animateCamera(animateTime, mixSlaveImage, nextViewMatrix)) {
    // Do nothing else
  } else if (mResetScene) {
    const float initialZpos = mCfgH.projectXY ? 16 : (mParam->par.continuousTracking ? (mMaxClusterZ * GL_SCALE_FACTOR + 8) : 8);
    nextViewMatrix = nextViewMatrix * HMM_Translate({{0, 0, -initialZpos}});
    *mViewMatrix = MY_HMM_IDENTITY;
    *mModelMatrix = MY_HMM_IDENTITY;
 
    mCfgL.pointSize = 2.0f;
    mCfgL.lineWidth = 1.4f;
    mCfgL.drawSector = -1;
    mCfgL.showCollision = -1;
    mCfgH.xAdd = mCfgH.zAdd = 0;
    mCfgR.camLookOrigin = mCfgR.camYUp = false;
    mAngleRollOrigin = -1e9f;
    mCfgR.fov = 45.f;
    mUpdateDrawCommands = true;
 
    mResetScene = false;
  } else {
    float moveZ = scalefactor * ((float)mMouseWheelTmp / 150 + (float)(mFrontend->mKeys[(uint8_t)'W'] - mFrontend->mKeys[(uint8_t)'S']) * (!mFrontend->mKeys[mFrontend->KEY_SHIFT]) * 0.2f * mFPSScale);
    float moveY = scalefactor * ((float)(mFrontend->mKeys[mFrontend->KEY_PAGEDOWN] - mFrontend->mKeys[mFrontend->KEY_PAGEUP]) * 0.2f * mFPSScale);
    float moveX = scalefactor * ((float)(mFrontend->mKeys[(uint8_t)'A'] - mFrontend->mKeys[(uint8_t)'D']) * (!mFrontend->mKeys[mFrontend->KEY_SHIFT]) * 0.2f * mFPSScale);
    float rotRoll = rotatescalefactor * mFPSScale * 2 * (mFrontend->mKeys[(uint8_t)'E'] - mFrontend->mKeys[(uint8_t)'F']) * (!mFrontend->mKeys[mFrontend->KEY_SHIFT]);
    float rotYaw = rotatescalefactor * mFPSScale * 2 * (mFrontend->mKeys[mFrontend->KEY_RIGHT] - mFrontend->mKeys[mFrontend->KEY_LEFT]);
    float rotPitch = rotatescalefactor * mFPSScale * 2 * (mFrontend->mKeys[mFrontend->KEY_DOWN] - mFrontend->mKeys[mFrontend->KEY_UP]);
 
    float mouseScale = 1920.f / std::max<float>(1920.f, mBackend->mScreenWidth);
    if (mFrontend->mMouseDnR && mFrontend->mMouseDn) {
      moveZ += -scalefactor * mouseScale * ((float)mFrontend->mMouseMvY - (float)mFrontend->mMouseDnY) / 4;
      rotRoll += -rotatescalefactor * mouseScale * ((float)mFrontend->mMouseMvX - (float)mFrontend->mMouseDnX);
    } else if (mFrontend->mMouseDnR) {
      moveX += scalefactor * 0.5f * mouseScale * ((float)mFrontend->mMouseDnX - (float)mFrontend->mMouseMvX) / 4;
      moveY += scalefactor * 0.5f * mouseScale * ((float)mFrontend->mMouseMvY - (float)mFrontend->mMouseDnY) / 4;
    } else if (mFrontend->mMouseDn) {
      rotYaw += rotatescalefactor * mouseScale * ((float)mFrontend->mMouseMvX - (float)mFrontend->mMouseDnX);
      rotPitch += rotatescalefactor * mouseScale * ((float)mFrontend->mMouseMvY - (float)mFrontend->mMouseDnY);
    }
 
    if (mFrontend->mKeys[(uint8_t)'<'] && !mFrontend->mKeysShift[(uint8_t)'<']) {
      mAnimationDelay += moveX;
      if (mAnimationDelay < 0.05f) {
        mAnimationDelay = 0.05f;
      }
      moveX = 0.f;
      moveY = 0.f;
      SetInfo("Animation delay set to %1.2f", mAnimationDelay);
    }
 
    if (yUp) {
      mAngleRollOrigin = 0;
    } else if (!lookOrigin) {
      mAngleRollOrigin = -1e6;
    }
    if (lookOrigin) {
      if (!yUp) {
        if (mAngleRollOrigin < -1e6) {
          mAngleRollOrigin = yUp ? 0.f : -mAngle[2];
        }
        mAngleRollOrigin += rotRoll;
        nextViewMatrix = nextViewMatrix * HMM_Rotate(mAngleRollOrigin, {{0, 0, 1}});
        float tmpX = moveX, tmpY = moveY;
        moveX = tmpX * cosf(mAngle[2]) - tmpY * sinf(mAngle[2]);
        moveY = tmpX * sinf(mAngle[2]) + tmpY * cosf(mAngle[2]);
      }
 
      const float x = mXYZ[0], y = mXYZ[1], z = mXYZ[2];
      float r = sqrtf(x * x + +y * y + z * z);
      float r2 = sqrtf(x * x + z * z);
      float phi = atan2f(z, x);
      phi += moveX * 0.1f;
      float theta = atan2f(mXYZ[1], r2);
      theta -= moveY * 0.1f;
      const float max_theta = CAMath::Pi() / 2 - 0.01f;
      if (theta >= max_theta) {
        theta = max_theta;
      } else if (theta <= -max_theta) {
        theta = -max_theta;
      }
      if (moveZ >= r - 0.1f) {
        moveZ = r - 0.1f;
      }
      r -= moveZ;
      r2 = r * cosf(theta);
      mXYZ[0] = r2 * cosf(phi);
      mXYZ[2] = r2 * sinf(phi);
      mXYZ[1] = r * sinf(theta);
 
      if (yUp) {
        nextViewMatrix = MY_HMM_IDENTITY;
      }
      nextViewMatrix = nextViewMatrix * HMM_LookAt({{mXYZ[0], mXYZ[1], mXYZ[2]}}, {{0, 0, 0}}, {{0, 1, 0}});
    } else {
      nextViewMatrix = nextViewMatrix * HMM_Translate({{moveX, moveY * mYFactor, moveZ}});
      if (!rotateModel) {
        if (rotYaw != 0.f) {
          nextViewMatrix = nextViewMatrix * HMM_Rotate(rotYaw, {{0, 1, 0}});
        }
        if (rotPitch != 0.f) {
          nextViewMatrix = nextViewMatrix * HMM_Rotate(rotPitch * mYFactor, {{1, 0, 0}});
        }
        if (!yUp && rotRoll != 0.f) {
          nextViewMatrix = nextViewMatrix * HMM_Rotate(rotRoll * mYFactor, {{0, 0, 1}});
        }
      }
      nextViewMatrix = nextViewMatrix * *mViewMatrix; // Apply previous translation / rotation
      if (yUp) {
        calcXYZ(&nextViewMatrix.Elements[0][0]);
        nextViewMatrix = HMM_Rotate(mAngle[2] * 180.f / CAMath::Pi(), {{0, 0, 1}}) * nextViewMatrix;
      }
      if (rotateModel) {
        if (rotYaw != 0.f) {
          *mModelMatrix = HMM_Rotate(rotYaw, {{nextViewMatrix.Elements[0][1], nextViewMatrix.Elements[1][1], nextViewMatrix.Elements[2][1]}}) * *mModelMatrix;
        }
        if (rotPitch != 0.f) {
          *mModelMatrix = HMM_Rotate(rotPitch, {{nextViewMatrix.Elements[0][0], nextViewMatrix.Elements[1][0], nextViewMatrix.Elements[2][0]}}) * *mModelMatrix;
        }
        if (rotRoll != 0.f) {
          if (rotateModelTPC) {
            *mModelMatrix = HMM_Rotate(-rotRoll, {{0, 0, 1}}) * *mModelMatrix;
          } else {
            *mModelMatrix = HMM_Rotate(-rotRoll, {{nextViewMatrix.Elements[0][2], nextViewMatrix.Elements[1][2], nextViewMatrix.Elements[2][2]}}) * *mModelMatrix;
          }
        }
      }
    }
 
    // Graphichs Options
    float minSize = 0.4f / (mCfgR.drawQualityDownsampleFSAA > 1 ? mCfgR.drawQualityDownsampleFSAA : 1);
    int32_t deltaLine = mFrontend->mKeys[(uint8_t)'+'] * mFrontend->mKeysShift[(uint8_t)'+'] - mFrontend->mKeys[(uint8_t)'-'] * mFrontend->mKeysShift[(uint8_t)'-'];
    mCfgL.lineWidth += (float)deltaLine * mFPSScale * 0.02f * mCfgL.lineWidth;
    if (mCfgL.lineWidth < minSize) {
      mCfgL.lineWidth = minSize;
    }
    if (deltaLine) {
      SetInfo("%s line width: %f", deltaLine > 0 ? "Increasing" : "Decreasing", mCfgL.lineWidth);
      mUpdateDrawCommands = true;
    }
    minSize *= 2;
    int32_t deltaPoint = mFrontend->mKeys[(uint8_t)'+'] * (!mFrontend->mKeysShift[(uint8_t)'+']) - mFrontend->mKeys[(uint8_t)'-'] * (!mFrontend->mKeysShift[(uint8_t)'-']);
    mCfgL.pointSize += (float)deltaPoint * mFPSScale * 0.02f * mCfgL.pointSize;
    if (mCfgL.pointSize < minSize) {
      mCfgL.pointSize = minSize;
    }
    if (deltaPoint) {
      SetInfo("%s point size: %f", deltaPoint > 0 ? "Increasing" : "Decreasing", mCfgL.pointSize);
      mUpdateDrawCommands = true;
    }
  }
 
  // Store position
  if (animateTime < 0) {
    *mViewMatrix = nextViewMatrix;
    calcXYZ(&mViewMatrix->Elements[0][0]);
  }
 
  if (mFrontend->mMouseDn || mFrontend->mMouseDnR) {
    mFrontend->mMouseDnX = mFrontend->mMouseMvX;
    mFrontend->mMouseDnY = mFrontend->mMouseMvY;
  }
  if (timer.IsRunning()) {
    GPUInfo("Display Time: Camera:\t\t%6.0f us", timer.GetCurrentElapsedTime(true) * 1e6);
  }
}
 
void GPUDisplay::DrawGLScene_drawCommands()
{
#define LOOP_SECTOR for (int32_t iSector = (mCfgL.drawSector == -1 ? 0 : mCfgL.drawRelatedSectors ? (mCfgL.drawSector % (NSECTORS / 4)) : mCfgL.drawSector); iSector < NSECTORS; iSector += (mCfgL.drawSector == -1 ? 1 : mCfgL.drawRelatedSectors ? (NSECTORS / 4) : NSECTORS))
#define LOOP_SECTOR2 for (int32_t iSector = (mCfgL.drawSector == -1 ? 0 : mCfgL.drawRelatedSectors ? (mCfgL.drawSector % (NSECTORS / 4)) : mCfgL.drawSector) % (NSECTORS / 2); iSector < NSECTORS / 2; iSector += (mCfgL.drawSector == -1 ? 1 : mCfgL.drawRelatedSectors ? (NSECTORS / 4) : NSECTORS))
#define LOOP_COLLISION for (int32_t iCol = (mCfgL.showCollision == -1 ? 0 : mCfgL.showCollision); iCol < mNCollissions; iCol += (mCfgL.showCollision == -1 ? 1 : mNCollissions))
#define LOOP_COLLISION_COL(cmd)  \
  LOOP_COLLISION                 \
  {                              \
    if (mCfgL.colorCollisions) { \
      SetCollisionColor(iCol);   \
    }                            \
    cmd;                         \
  }
 
  if (mCfgL.drawGrid) {
    if (mCfgL.drawTPC) {
      SetColorGrid();
      LOOP_SECTOR drawVertices(mGlDLGrid[iSector], GPUDisplayBackend::LINES);
    }
    if (mCfgL.drawTRD) {
      SetColorGridTRD();
      LOOP_SECTOR2 drawVertices(mGlDLGridTRD[iSector], GPUDisplayBackend::LINES);
    }
  }
  if (mCfgL.drawClusters) {
    if (mCfgL.drawTRD) {
      SetColorTRD();
      mBackend->lineWidthFactor(2);
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tTRDCLUSTER][iCol], GPUDisplayBackend::LINES));
      if (mCfgL.drawFinal && mCfgL.colorClusters) {
        SetColorFinal();
      }
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tTRDATTACHED][iCol], GPUDisplayBackend::LINES));
      mBackend->lineWidthFactor(1);
    }
    if (mCfgL.drawTOF) {
      SetColorTOF();
      mBackend->pointSizeFactor(2);
      // LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tTOFCLUSTER][iCol], GPUDisplayBackend::POINTS));
      drawVertices(mGlDLPoints[0][tTOFCLUSTER][0], GPUDisplayBackend::POINTS);
      mBackend->pointSizeFactor(1);
    }
    if (mCfgL.drawITS) {
      SetColorITS();
      // LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tITSCLUSTER][iCol], GPUDisplayBackend::POINTS));
      drawVertices(mGlDLPoints[0][tITSCLUSTER][0], GPUDisplayBackend::POINTS);
    }
    if (mCfgL.drawTPC) {
      SetColorClusters();
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tCLUSTER][iCol], GPUDisplayBackend::POINTS));
 
      if (mCfgL.drawInitLinks) {
        if (mCfgL.excludeClusters) {
          goto skip1;
        }
        if (mCfgL.colorClusters) {
          SetColorInitLinks();
        }
      }
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tINITLINK][iCol], GPUDisplayBackend::POINTS));
 
      if (mCfgL.drawLinks) {
        if (mCfgL.excludeClusters) {
          goto skip1;
        }
        if (mCfgL.colorClusters) {
          SetColorLinks();
        }
      } else {
        SetColorClusters();
      }
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tLINK][iCol], GPUDisplayBackend::POINTS));
 
      if (mCfgL.drawSeeds) {
        if (mCfgL.excludeClusters) {
          goto skip1;
        }
        if (mCfgL.colorClusters) {
          SetColorSeeds();
        }
      }
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tSEED][iCol], GPUDisplayBackend::POINTS));
 
    skip1:
      SetColorClusters();
      if (mCfgL.drawTracklets) {
        if (mCfgL.excludeClusters) {
          goto skip2;
        }
        if (mCfgL.colorClusters) {
          SetColorTracklets();
        }
      }
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tTRACKLET][iCol], GPUDisplayBackend::POINTS));
 
      if (mCfgL.drawTracks) {
        if (mCfgL.excludeClusters) {
          goto skip2;
        }
        if (mCfgL.colorClusters) {
          SetColorTracks();
        }
      }
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tSECTORTRACK][iCol], GPUDisplayBackend::POINTS));
 
    skip2:;
      if (mCfgL.drawExtrapolatedTracks) {
        if (mCfgL.excludeClusters) {
          goto skip3;
        }
        if (mCfgL.colorClusters) {
          SetColorExtrapolatedTracks();
        }
      } else {
        SetColorClusters();
      }
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tEXTRAPOLATEDTRACK][iCol], GPUDisplayBackend::POINTS));
      SetColorClusters();
 
      if (mCfgL.drawFinal && mCfgL.propagateTracks < 2) {
        if (mCfgL.excludeClusters) {
          goto skip3;
        }
        if (mCfgL.colorClusters) {
          SetColorFinal();
        }
      }
      LOOP_SECTOR LOOP_COLLISION_COL(drawVertices(mGlDLPoints[iSector][tFINALTRACK][iCol], GPUDisplayBackend::POINTS));
    skip3:;
    }
  }
 
  if (!mCfgH.clustersOnly && mCfgL.excludeClusters != 1) {
    if (mCfgL.drawTPC) {
      if (mCfgL.drawInitLinks) {
        SetColorInitLinks();
        LOOP_SECTOR drawVertices(mGlDLLines[iSector][tINITLINK], GPUDisplayBackend::LINES);
      }
      if (mCfgL.drawLinks) {
        SetColorLinks();
        LOOP_SECTOR drawVertices(mGlDLLines[iSector][tLINK], GPUDisplayBackend::LINES);
      }
      if (mCfgL.drawSeeds) {
        SetColorSeeds();
        LOOP_SECTOR drawVertices(mGlDLLines[iSector][tSEED], GPUDisplayBackend::LINE_STRIP);
      }
      if (mCfgL.drawTracklets) {
        SetColorTracklets();
        LOOP_SECTOR drawVertices(mGlDLLines[iSector][tTRACKLET], GPUDisplayBackend::LINE_STRIP);
      }
      if (mCfgL.drawTracks) {
        SetColorTracks();
        LOOP_SECTOR drawVertices(mGlDLLines[iSector][tSECTORTRACK], GPUDisplayBackend::LINE_STRIP);
      }
      if (mCfgL.drawExtrapolatedTracks) {
        SetColorExtrapolatedTracks();
        LOOP_SECTOR drawVertices(mGlDLLines[iSector][tEXTRAPOLATEDTRACK], GPUDisplayBackend::LINE_STRIP);
      }
    }
    if (mCfgL.drawFinal) {
      SetColorFinal();
      LOOP_SECTOR LOOP_COLLISION
      {
        if (mCfgL.colorCollisions) {
          SetCollisionColor(iCol);
        }
        if (mCfgL.propagateTracks < 2) {
          drawVertices(mGlDLFinal[iSector][iCol][0], GPUDisplayBackend::LINE_STRIP);
        }
        if (mCfgL.propagateTracks > 0 && mCfgL.propagateTracks < 3) {
          drawVertices(mGlDLFinal[iSector][iCol][1], GPUDisplayBackend::LINE_STRIP);
        }
        if (mCfgL.propagateTracks == 2) {
          drawVertices(mGlDLFinal[iSector][iCol][2], GPUDisplayBackend::LINE_STRIP);
        }
        if (mCfgL.propagateTracks == 3) {
          drawVertices(mGlDLFinal[iSector][iCol][3], GPUDisplayBackend::LINE_STRIP);
        }
      }
      if (mCfgH.drawTracksAndFilter ? (mCfgH.drawTPCTracks || mCfgH.drawTRDTracks || mCfgH.drawTOFTracks) : mCfgH.drawITSTracks) {
        drawVertices(mGlDLFinalITS, GPUDisplayBackend::LINE_STRIP);
      }
    }
    if (mCfgH.markClusters || mCfgH.markAdjacentClusters || mCfgH.markFakeClusters) {
      if (mCfgH.markFakeClusters) {
        mBackend->pointSizeFactor(3);
      }
      SetColorMarked();
      LOOP_SECTOR LOOP_COLLISION drawVertices(mGlDLPoints[iSector][tMARKED][iCol], GPUDisplayBackend::POINTS);
      if (mCfgH.markFakeClusters) {
        mBackend->pointSizeFactor(1);
      }
    }
  }
}
 
void GPUDisplay::DrawGLScene_internal(float animateTime, bool renderToMixBuffer) // negative time = no mixing
{
  if (mRequestScreenshot || mAnimateScreenshot) {
    const uint32_t factor = std::max(1, mCfgR.drawQualityDownsampleFSAA) * std::max(1, mCfgR.screenshotScaleFactor);
    if (std::max(mBackend->mScreenWidth, mBackend->mScreenHeight) * factor > mBackend->mMaxRenderSize) {
      GPUError("Screenshot not taken: requested render size %u x %u (window x FSAA x screenshot scale) exceeds the maximum size %u x %u", mBackend->mScreenWidth * factor, mBackend->mScreenHeight * factor, mBackend->mMaxRenderSize, mBackend->mMaxRenderSize);
      mRequestScreenshot = false;
      mAnimateScreenshot = 0;
    }
  }
  bool doScreenshot = (mRequestScreenshot || mAnimateScreenshot) && animateTime < 0;
 
  updateOptions();
  if (animateTime < 0 && (mUpdateEventData || mResetScene || mUpdateVertexLists) && mIOPtrs) {
    disableUnsupportedOptions();
  }
  if (mUpdateEventData || mUpdateVertexLists) {
    mUpdateDrawCommands = true;
  }
 
  HighResTimer timerDraw(mUpdateVertexLists);
  if (animateTime < 0 && (mUpdateEventData || mResetScene) && mIOPtrs) {
    timerDraw.ResetStart();
    DrawGLScene_updateEventData();
    mTimerFPS.ResetStart();
    mFramesDoneFPS = 0;
    mFPSScaleadjust = 0;
    mUpdateVertexLists = true;
    mUpdateEventData = false;
  }
 
  hmm_mat4 nextViewMatrix = MY_HMM_IDENTITY;
  float mixSlaveImage = 0.f;
  DrawGLScene_cameraAndAnimation(animateTime, mixSlaveImage, nextViewMatrix);
 
  // Prepare Event
  if (mUpdateVertexLists && mIOPtrs) {
    size_t totalVertizes = DrawGLScene_updateVertexList();
    if (timerDraw.IsRunning()) {
      printf("Event visualization time: %'d us (vertices %'ld / %'ld bytes)\n", (int32_t)(timerDraw.GetCurrentElapsedTime() * 1000000.), (int64_t)totalVertizes, (int64_t)(totalVertizes * sizeof(mVertexBuffer[0][0])));
    }
  }
 
  // Draw Event
  nextViewMatrix = nextViewMatrix * *mModelMatrix;
  const float zFar = ((mParam->par.continuousTracking ? (mMaxClusterZ * GL_SCALE_FACTOR) : 8.f) + 50.f) * 2.f;
  const hmm_mat4 proj = HMM_Perspective(mCfgR.fov, (float)mBackend->mRenderWidth / (float)mBackend->mRenderHeight, 0.1f, zFar);
  if (!mBackend->prepareDraw(proj, nextViewMatrix, doScreenshot || mRequestScreenshot, renderToMixBuffer, mixSlaveImage)) {
    return; // No image available (e.g. hidden window), retry with the next frame
  }
  mBackend->pointSizeFactor(1);
  mBackend->lineWidthFactor(1);
 
  if (mUpdateDrawCommands || mBackend->backendNeedRedraw()) {
    mNDrawCalls = 0;
    DrawGLScene_drawCommands();
  }
 
  if (mCfgL.drawField) {
    mBackend->drawField();
  }
 
  mUpdateDrawCommands = false;
  mUpdateRenderPipeline = false;
  mBackend->finishDraw(doScreenshot, renderToMixBuffer, mixSlaveImage);
 
  if (animateTime < 0) {
    mFramesDone++;
    mFramesDoneFPS++;
    double fpstime = mTimerFPS.GetCurrentElapsedTime();
    char info[1024];
    float fps = (double)mFramesDoneFPS / fpstime;
    snprintf(info, 1024,
             "FPS: %6.2f (Sector: %d, 1:Clusters %d, 2:Prelinks %d, 3:Links %d, 4:Seeds %d, 5:Tracklets %d, 6:Tracks %d, 7:GTracks %d, 8:Merger %d) (%d frames, %d draw calls) "
             "(X %1.2f Y %1.2f Z %1.2f / R %1.2f Phi %1.1f Theta %1.1f) / Yaw %1.1f Pitch %1.1f Roll %1.1f)",
             fps, mCfgL.drawSector, mCfgL.drawClusters, mCfgL.drawInitLinks, mCfgL.drawLinks, mCfgL.drawSeeds, mCfgL.drawTracklets, mCfgL.drawTracks, mCfgL.drawExtrapolatedTracks, mCfgL.drawFinal, mFramesDone, mNDrawCalls, mXYZ[0], mXYZ[1], mXYZ[2], mRPhiTheta[0], mRPhiTheta[1] * 180 / CAMath::Pi(),
             mRPhiTheta[2] * 180 / CAMath::Pi(), mAngle[1] * 180 / CAMath::Pi(), mAngle[0] * 180 / CAMath::Pi(), mAngle[2] * 180 / CAMath::Pi());
    if (fpstime > 1.) {
      if (mPrintInfoText & 2) {
        GPUInfo("%s", info);
      }
      if (mFPSScaleadjust++) {
        mFPSScale = 60 / fps;
      }
      mTimerFPS.ResetStart();
      mFramesDoneFPS = 0;
    }
 
    if (mPrintInfoText & 1) {
      showInfo(info);
    }
  }
 
  mBackend->finishFrame(mRequestScreenshot, renderToMixBuffer, mixSlaveImage);
  if (doScreenshot) {
    mRequestScreenshot = false;
    std::vector<char> pixels = mBackend->getPixels();
    char tmpFileName[48];
    if (mAnimateScreenshot) {
      snprintf(tmpFileName, 48, "mAnimation%d_%05d.bmp", mAnimationExport, mAnimationFrame);
    }
    DoScreenshot(mAnimateScreenshot ? tmpFileName : mScreenshotFile.c_str(), pixels);
  }
}
 
void GPUDisplay::ShowNextEvent(const GPUTrackingInOutPointers* ptrs)
{
  if (ptrs) {
    mIOPtrs = ptrs;
  }
  if (mMaxClusterZ <= 0) {
    mResetScene = true;
  }
  mFrontend->mNeedUpdate = 1;
  mUpdateEventData = true;
  mLoadAndShowEvent = true;
  mSemLockDisplay.Unlock();
}
 
void GPUDisplay::BlockTillNextEvent() { mSemLockDisplay.Lock(); }
 
void GPUDisplay::UnblockDisplay()
{
  mSemLockDisplay.Trylock();
  mSemLockDisplay.Unlock();
}
 
void GPUDisplay::WaitTillEventShown()
{
  std::unique_lock<std::mutex> lock(mMutexLoadAndShowEvent);
  while (mLoadAndShowEvent) {
    mCVLoadAndShowEvent.wait(lock);
  }
}
 
int32_t GPUDisplay::StartDisplay()
{
  mLoadAndShowEvent = true;
  if (mFrontend->StartDisplay()) {
    return (1);
  }
  while (mInitResult == 0) {
    Sleep(10);
  }
  return (mInitResult != 1);
}