1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105 106 107 108 109 110 111 112 113 114 115 116 117 118 119 120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 140 141 142 143 144 145
|
/*=========================================================================
Program: Visualization Toolkit
Copyright (c) Ken Martin, Will Schroeder, Bill Lorensen
All rights reserved.
See Copyright.txt or http://www.kitware.com/Copyright.htm for details.
This software is distributed WITHOUT ANY WARRANTY; without even
the implied warranty of MERCHANTABILITY or FITNESS FOR A PARTICULAR
PURPOSE. See the above copyright notice for more information.
=========================================================================*/
#include "vtkOpenXRCamera.h"
#include "vtkObjectFactory.h"
#include "vtkOpenGLError.h"
#include "vtkOpenGLState.h"
#include "vtkOpenXR.h"
#include "vtkOpenXRRenderWindow.h"
#include "vtkPerspectiveTransform.h"
#include "vtkRenderer.h"
#include "vtkTimerLog.h"
#include "vtkTransform.h"
#include "vtkMatrix3x3.h"
#include "vtkQuaternion.h"
#include "vtkMath.h"
#include "vtkOpenXRManager.h"
#include <cassert>
#include <cmath>
#include "vtkOpenXRUtilities.h"
VTK_ABI_NAMESPACE_BEGIN
vtkStandardNewMacro(vtkOpenXRCamera);
vtkOpenXRCamera::vtkOpenXRCamera() = default;
vtkOpenXRCamera::~vtkOpenXRCamera() = default;
//------------------------------------------------------------------------------
void vtkOpenXRCamera::UpdateWorldToEyeMatrices(vtkRenderer* ren)
{
vtkOpenXRRenderWindow* win = vtkOpenXRRenderWindow::SafeDownCast(ren->GetRenderWindow());
// Get physical to world matrix, which we then invert as we are trying to
// compute the world to view matrix which we do as
// viewCoord = physicalToEye * worldToPhysical * worldCoord
win->GetPhysicalToWorldMatrix(this->WorldToPhysicalMatrix);
this->WorldToPhysicalMatrix->Invert();
// at this point it is now correctly worldToPhysical
const XrPosef* xrPose = vtkOpenXRManager::GetInstance().GetViewPose(LEFT_EYE);
if (xrPose == nullptr)
{
vtkErrorMacro(<< "No pose for left eye, cannot update view transform");
return;
}
// Convert a XrPosef to a vtk view matrix
vtkOpenXRUtilities::SetMatrixFromXrPose(this->PhysicalToLeftEyeMatrix, *xrPose);
this->PhysicalToLeftEyeMatrix->Invert();
vtkMatrix4x4::Multiply4x4(
this->PhysicalToLeftEyeMatrix, this->WorldToPhysicalMatrix, this->WorldToLeftEyeMatrix);
xrPose = vtkOpenXRManager::GetInstance().GetViewPose(RIGHT_EYE);
if (xrPose == nullptr)
{
vtkErrorMacro(<< "No pose for right eye, cannot update view transform");
return;
}
// Convert a XrPosef to a vtk view matrix
vtkOpenXRUtilities::SetMatrixFromXrPose(this->PhysicalToRightEyeMatrix, *xrPose);
this->PhysicalToRightEyeMatrix->Invert();
vtkMatrix4x4::Multiply4x4(
this->PhysicalToRightEyeMatrix, this->WorldToPhysicalMatrix, this->WorldToRightEyeMatrix);
}
//------------------------------------------------------------------------------
void vtkOpenXRCamera::UpdateEyeToProjectionMatrices(vtkRenderer* ren)
{
vtkVRRenderWindow* win = vtkVRRenderWindow::SafeDownCast(ren->GetRenderWindow());
double scale = win->GetPhysicalScale();
double znear = this->ClippingRange[0] / scale;
double zfar = this->ClippingRange[1] / scale;
XrFovf const* xrFov = vtkOpenXRManager::GetInstance().GetProjectionFov(LEFT_EYE);
if (xrFov == nullptr)
{
vtkErrorMacro(<< "No fov for left eye, cannot update projection matrix");
return;
}
vtkOpenXRUtilities::CreateProjectionFov(this->LeftEyeToProjectionMatrix, *xrFov, znear, zfar);
xrFov = vtkOpenXRManager::GetInstance().GetProjectionFov(RIGHT_EYE);
if (xrFov == nullptr)
{
vtkErrorMacro(<< "No fov for right eye, cannot update projection matrix");
return;
}
vtkOpenXRUtilities::CreateProjectionFov(this->RightEyeToProjectionMatrix, *xrFov, znear, zfar);
}
//------------------------------------------------------------------------------
void vtkOpenXRCamera::Render(vtkRenderer* ren)
{
vtkOpenGLClearErrorMacro();
vtkOpenXRRenderWindow* win = vtkOpenXRRenderWindow::SafeDownCast(ren->GetRenderWindow());
vtkOpenGLState* ostate = win->GetState();
int renSize[2];
win->GetRenderBufferSize(renSize[0], renSize[1]);
// if were on a stereo renderer draw to special parts of screen
if (this->LeftEye)
{
// Left Eye
if (win->GetMultiSamples() && !ren->GetSelector())
{
ostate->vtkglEnable(GL_MULTISAMPLE);
}
}
else
{
// right eye
if (win->GetMultiSamples() && !ren->GetSelector())
{
ostate->vtkglEnable(GL_MULTISAMPLE);
}
}
ostate->vtkglViewport(0, 0, renSize[0], renSize[1]);
ostate->vtkglScissor(0, 0, renSize[0], renSize[1]);
if ((ren->GetRenderWindow())->GetErase() && ren->GetErase())
{
ren->Clear();
}
vtkOpenGLCheckErrorMacro("failed after Render");
}
VTK_ABI_NAMESPACE_END
|