forked from mirrors/gecko-dev
126bd9e1a4
This patch was generated automatically by the "modeline.py" script, available here: https://github.com/amccreight/moz-source-tools/blob/master/modeline.py For every file that is modified in this patch, the changes are as follows: (1) The patch changes the file to use the exact C++ mode lines from the Mozilla coding style guide, available here: https://developer.mozilla.org/en-US/docs/Mozilla/Developer_guide/Coding_Style#Mode_Line (2) The patch deletes any blank lines between the mode line & the MPL boilerplate comment. (3) If the file previously had the mode lines and MPL boilerplate in a single contiguous C++ comment, then the patch splits them into separate C++ comments, to match the boilerplate in the coding style. MozReview-Commit-ID: 77D61xpSmIl --HG-- extra : rebase_source : c6162fa3cf539a07177a19838324bf368faa162b
58 lines
1.7 KiB
C++
58 lines
1.7 KiB
C++
/* -*- Mode: C++; tab-width: 8; indent-tabs-mode: nil; c-basic-offset: 2 -*- */
|
|
/* vim: set ts=8 sts=2 et sw=2 tw=80: */
|
|
/* This Source Code Form is subject to the terms of the Mozilla Public
|
|
* License, v. 2.0. If a copy of the MPL was not distributed with this
|
|
* file, You can obtain one at http://mozilla.org/MPL/2.0/. */
|
|
|
|
#include "Quaternion.h"
|
|
#include "Matrix.h"
|
|
#include "Tools.h"
|
|
#include <algorithm>
|
|
#include <ostream>
|
|
#include <math.h>
|
|
|
|
using namespace std;
|
|
|
|
namespace mozilla {
|
|
namespace gfx {
|
|
|
|
std::ostream&
|
|
operator<<(std::ostream& aStream, const Quaternion& aQuat)
|
|
{
|
|
return aStream << "< " << aQuat.x << " " << aQuat.y << " " << aQuat.z << " " << aQuat.w << ">";
|
|
}
|
|
|
|
void
|
|
Quaternion::SetFromRotationMatrix(const Matrix4x4& m)
|
|
{
|
|
// see http://www.euclideanspace.com/maths/geometry/rotations/conversions/matrixToQuaternion/index.htm
|
|
const Float trace = m._11 + m._22 + m._33;
|
|
if (trace > 0.0) {
|
|
const Float s = 0.5f / sqrt(trace + 1.0f);
|
|
w = 0.25f / s;
|
|
x = (m._32 - m._23) * s;
|
|
y = (m._13 - m._31) * s;
|
|
z = (m._21 - m._12) * s;
|
|
} else if (m._11 > m._22 && m._11 > m._33) {
|
|
const Float s = 2.0f * sqrt(1.0f + m._11 - m._22 - m._33);
|
|
w = (m._32 - m._23) / s;
|
|
x = 0.25f * s;
|
|
y = (m._12 + m._21) / s;
|
|
z = (m._13 + m._31) / s;
|
|
} else if (m._22 > m._33) {
|
|
const Float s = 2.0 * sqrt(1.0f + m._22 - m._11 - m._33);
|
|
w = (m._13 - m._31) / s;
|
|
x = (m._12 + m._21) / s;
|
|
y = 0.25f * s;
|
|
z = (m._23 + m._32) / s;
|
|
} else {
|
|
const Float s = 2.0 * sqrt(1.0f + m._33 - m._11 - m._22);
|
|
w = (m._21 - m._12) / s;
|
|
x = (m._13 + m._31) / s;
|
|
y = (m._23 + m._32) / s;
|
|
z = 0.25f * s;
|
|
}
|
|
}
|
|
|
|
} // namespace gfx
|
|
} // namespace mozilla
|