You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
97 lines
2.9 KiB
97 lines
2.9 KiB
/*
|
|
* Copyright (C) 2021 The Android Open Source Project
|
|
*
|
|
* Licensed under the Apache License, Version 2.0 (the "License");
|
|
* you may not use this file except in compliance with the License.
|
|
* You may obtain a copy of the License at
|
|
*
|
|
* http://www.apache.org/licenses/LICENSE-2.0
|
|
*
|
|
* Unless required by applicable law or agreed to in writing, software
|
|
* distributed under the License is distributed on an "AS IS" BASIS,
|
|
* WITHOUT WARRANTIES OR CONDITIONS OF ANY KIND, either express or implied.
|
|
* See the License for the specific language governing permissions and
|
|
* limitations under the License.
|
|
*/
|
|
|
|
#include "ModeSelector.h"
|
|
|
|
namespace android {
|
|
namespace media {
|
|
|
|
ModeSelector::ModeSelector(const Options& options, HeadTrackingMode initialMode)
|
|
: mOptions(options), mDesiredMode(initialMode), mActualMode(initialMode) {}
|
|
|
|
void ModeSelector::setDesiredMode(HeadTrackingMode mode) {
|
|
mDesiredMode = mode;
|
|
}
|
|
|
|
void ModeSelector::setScreenToStagePose(const Pose3f& screenToStage) {
|
|
mScreenToStage = screenToStage;
|
|
}
|
|
|
|
void ModeSelector::setScreenToHeadPose(int64_t timestamp,
|
|
const std::optional<Pose3f>& screenToHead) {
|
|
mScreenToHead = screenToHead;
|
|
mScreenToHeadTimestamp = timestamp;
|
|
}
|
|
|
|
void ModeSelector::setWorldToHeadPose(int64_t timestamp, const Pose3f& worldToHead) {
|
|
mWorldToHead = worldToHead;
|
|
mWorldToHeadTimestamp = timestamp;
|
|
}
|
|
|
|
void ModeSelector::calculateActualMode(int64_t timestamp) {
|
|
bool isValidScreenToHead = mScreenToHead.has_value() &&
|
|
timestamp - mScreenToHeadTimestamp < mOptions.freshnessTimeout;
|
|
bool isValidWorldToHead = mWorldToHead.has_value() &&
|
|
timestamp - mWorldToHeadTimestamp < mOptions.freshnessTimeout;
|
|
|
|
HeadTrackingMode mode = mDesiredMode;
|
|
|
|
// Optional downgrade from screen-relative to world-relative.
|
|
if (mode == HeadTrackingMode::SCREEN_RELATIVE) {
|
|
if (!isValidScreenToHead) {
|
|
mode = HeadTrackingMode::WORLD_RELATIVE;
|
|
}
|
|
}
|
|
|
|
// Optional downgrade from world-relative to static.
|
|
if (mode == HeadTrackingMode::WORLD_RELATIVE) {
|
|
if (!isValidWorldToHead) {
|
|
mode = HeadTrackingMode::STATIC;
|
|
}
|
|
}
|
|
|
|
mActualMode = mode;
|
|
}
|
|
|
|
void ModeSelector::calculate(int64_t timestamp) {
|
|
calculateActualMode(timestamp);
|
|
|
|
switch (mActualMode) {
|
|
case HeadTrackingMode::STATIC:
|
|
mHeadToStage = mScreenToStage;
|
|
break;
|
|
|
|
case HeadTrackingMode::WORLD_RELATIVE:
|
|
mHeadToStage = mWorldToHead.value().inverse() * mScreenToStage;
|
|
break;
|
|
|
|
case HeadTrackingMode::SCREEN_RELATIVE:
|
|
mHeadToStage = mScreenToHead.value().inverse() * mScreenToStage;
|
|
break;
|
|
}
|
|
}
|
|
|
|
Pose3f ModeSelector::getHeadToStagePose() const {
|
|
return mHeadToStage;
|
|
}
|
|
|
|
HeadTrackingMode ModeSelector::getActualMode() const {
|
|
return mActualMode;
|
|
}
|
|
|
|
} // namespace media
|
|
} // namespace android
|