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
|
/*
Copyright 2018 Google Inc. All Rights Reserved.
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 "base/spherical_angle.h"
#include <cmath>
#include "base/constants_and_types.h"
namespace vraudio {
SphericalAngle::SphericalAngle(float azimuth, float elevation)
: azimuth_(azimuth), elevation_(elevation) {}
SphericalAngle::SphericalAngle() : SphericalAngle(0.0f, 0.0f) {}
SphericalAngle::SphericalAngle(const SphericalAngle& other)
: azimuth_(other.azimuth_), elevation_(other.elevation_) {}
SphericalAngle& SphericalAngle::operator=(const SphericalAngle other) {
if (&other == this) {
return *this;
}
this->azimuth_ = other.azimuth_;
this->elevation_ = other.elevation_;
return *this;
}
SphericalAngle SphericalAngle::FromWorldPosition(
const WorldPosition& world_position) {
return SphericalAngle(
std::atan2(-world_position[0], -world_position[2]),
std::atan2(world_position[1],
std::sqrt(world_position[0] * world_position[0] +
world_position[2] * world_position[2])));
}
SphericalAngle SphericalAngle::FromDegrees(float azimuth_degrees,
float elevation_degrees) {
return SphericalAngle(azimuth_degrees * kRadiansFromDegrees,
elevation_degrees * kRadiansFromDegrees);
}
SphericalAngle SphericalAngle::FlipAzimuth() const {
return SphericalAngle(-azimuth_, elevation_);
}
WorldPosition SphericalAngle::GetWorldPositionOnUnitSphere() const {
return WorldPosition(-std::cos(elevation_) * std::sin(azimuth_),
std::sin(elevation_),
-std::cos(elevation_) * std::cos(azimuth_));
}
SphericalAngle SphericalAngle::Rotate(const WorldRotation& rotation) const {
const WorldPosition original_world_position = GetWorldPositionOnUnitSphere();
const WorldPosition rotated_world_position =
rotation * original_world_position;
return FromWorldPosition(rotated_world_position);
}
bool SphericalAngle::operator==(const SphericalAngle& other) const {
return (azimuth_ == other.azimuth_) && (elevation_ == other.elevation_);
}
} // namespace vraudio
|