Reimplemented sound effects.
Added chaperone proximity warnings. Other bugfixes and improvements.
This commit is contained in:
@@ -0,0 +1,81 @@
|
||||
|
||||
#include "ChaperoneUtils.h"
|
||||
#include <iostream>
|
||||
|
||||
namespace utils {
|
||||
|
||||
|
||||
float ChaperoneUtils::_getDistanceToChaperone(const vr::HmdVector3_t & x, vr::HmdVector3_t * projectedPoint) {
|
||||
float distance = NAN;
|
||||
vr::HmdVector3_t* _cornersPtr = _corners.get();
|
||||
for (uint32_t i = 0; i < _quadsCount; i++) {
|
||||
uint32_t i2 = (i + 1) % _quadsCount;
|
||||
vr::HmdVector3_t& r0 = _cornersPtr[i];
|
||||
vr::HmdVector3_t& r1 = _cornersPtr[i2];
|
||||
float u_x = r1.v[0] - r0.v[0];
|
||||
float u_z = r1.v[2] - r0.v[2];
|
||||
float r = ((x.v[0] - r0.v[0]) * u_x + (x.v[2] - r0.v[2]) * u_z) / (u_x*u_x + u_z*u_z);
|
||||
//int mode = 0; // 0 .. projected point on segment, 1 .. projected point outside of segment (r0 closer than r1), 2 .. projected point outside of segment (r1 closer than r0)
|
||||
float d;
|
||||
float x1_x;
|
||||
float x1_z;
|
||||
if (r < 0.0f || r > 1.0f) { // projected point outside of segment
|
||||
float d_x = r0.v[0] - x.v[0];
|
||||
float d_z = r0.v[2] - x.v[2];
|
||||
float d1 = sqrt(d_x*d_x + d_z*d_z);
|
||||
d_x = r1.v[0] - x.v[0];
|
||||
d_z = r1.v[2] - x.v[2];
|
||||
float d2 = sqrt(d_x*d_x + d_z*d_z);
|
||||
if (d1 < d2) {
|
||||
d = d1;
|
||||
x1_x = r0.v[0];
|
||||
x1_z = r0.v[2];
|
||||
} else {
|
||||
d = d2;
|
||||
x1_x = r1.v[0];
|
||||
x1_z = r1.v[2];
|
||||
}
|
||||
} else { // projected point on segment
|
||||
x1_x = r0.v[0] + r * u_x;
|
||||
x1_z = r0.v[2] + r * u_z;
|
||||
float d_x = x1_x - x.v[0];
|
||||
float d_z = x1_z - x.v[2];
|
||||
d = sqrt(d_x*d_x + d_z*d_z);
|
||||
}
|
||||
if (isnan(distance) || d < distance) {
|
||||
distance = d;
|
||||
if (projectedPoint) {
|
||||
projectedPoint->v[0] = x1_x;
|
||||
projectedPoint->v[1] = x.v[1];
|
||||
projectedPoint->v[2] = x1_z;
|
||||
}
|
||||
}
|
||||
}
|
||||
return distance;
|
||||
}
|
||||
|
||||
|
||||
void ChaperoneUtils::loadChaperoneData() {
|
||||
std::lock_guard<std::recursive_mutex> lock(_mutex);
|
||||
vr::VRChaperoneSetup()->GetLiveCollisionBoundsInfo(nullptr, &_quadsCount);
|
||||
if (_quadsCount > 0) {
|
||||
std::unique_ptr<vr::HmdQuad_t> quadsBuffer(new vr::HmdQuad_t[_quadsCount]);
|
||||
vr::HmdQuad_t* quadsBufferPtr = quadsBuffer.get();
|
||||
_corners.reset((vr::HmdVector3_t*)new vr::HmdQuad_t[_quadsCount]);
|
||||
vr::HmdVector3_t* _cornersPtr = _corners.get();
|
||||
vr::VRChaperoneSetup()->GetLiveCollisionBoundsInfo(quadsBufferPtr, &_quadsCount);
|
||||
for (uint32_t i = 0; i < _quadsCount; i++) {
|
||||
_cornersPtr[i] = quadsBufferPtr[i].vCorners[0];
|
||||
uint32_t i2 = (i + 1) % _quadsCount;
|
||||
if (quadsBufferPtr[i].vCorners[3].v[0] != quadsBufferPtr[i2].vCorners[0].v[0]
|
||||
|| quadsBufferPtr[i].vCorners[3].v[1] != quadsBufferPtr[i2].vCorners[0].v[1]
|
||||
|| quadsBufferPtr[i].vCorners[3].v[2] != quadsBufferPtr[i2].vCorners[0].v[2]
|
||||
|| quadsBufferPtr[i].vCorners[0].v[1] != 0.0f) {
|
||||
_chaperoneWellFormed = false;
|
||||
}
|
||||
}
|
||||
}
|
||||
}
|
||||
|
||||
|
||||
} // end namespace utils
|
||||
@@ -0,0 +1,38 @@
|
||||
#pragma once
|
||||
|
||||
#include <memory>
|
||||
#include <mutex>
|
||||
#include <openvr.h>
|
||||
|
||||
namespace utils {
|
||||
|
||||
class ChaperoneUtils {
|
||||
private:
|
||||
std::recursive_mutex _mutex;
|
||||
uint32_t _quadsCount = 0;
|
||||
std::unique_ptr<vr::HmdVector3_t> _corners;
|
||||
bool _chaperoneWellFormed = true;
|
||||
|
||||
float _getDistanceToChaperone(const vr::HmdVector3_t& point, vr::HmdVector3_t* projectedPoint);
|
||||
|
||||
public:
|
||||
uint32_t quadsCount() const noexcept { return _quadsCount; }
|
||||
bool isChaperoneWellFormed() const noexcept { return _chaperoneWellFormed; }
|
||||
|
||||
std::recursive_mutex& mutex() noexcept { return _mutex; }
|
||||
|
||||
void loadChaperoneData();
|
||||
|
||||
float getDistanceToChaperone(const vr::HmdVector3_t& point, vr::HmdVector3_t* projectedPoint = nullptr, bool doLock = false) {
|
||||
if (doLock) {
|
||||
std::lock_guard<std::recursive_mutex> lock(_mutex);
|
||||
return _getDistanceToChaperone(point, projectedPoint);
|
||||
} else {
|
||||
return _getDistanceToChaperone(point, projectedPoint);
|
||||
}
|
||||
}
|
||||
};
|
||||
|
||||
|
||||
} // end namespace utils
|
||||
|
||||
Reference in New Issue
Block a user