mirror of https://github.com/mosra/magnum.git
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.
52 lines
1.6 KiB
52 lines
1.6 KiB
14 years ago
|
#ifndef Magnum_Math_Algorithms_GramSchmidt_h
|
||
|
|
#define Magnum_Math_Algorithms_GramSchmidt_h
|
||
|
|
/*
|
||
|
|
Copyright © 2010, 2011, 2012 Vladimír Vondruš <mosra@centrum.cz>
|
||
|
|
|
||
|
|
This file is part of Magnum.
|
||
|
|
|
||
|
|
Magnum is free software: you can redistribute it and/or modify
|
||
|
|
it under the terms of the GNU Lesser General Public License version 3
|
||
|
|
only, as published by the Free Software Foundation.
|
||
|
|
|
||
|
|
Magnum is distributed in the hope that it will be useful,
|
||
|
|
but WITHOUT ANY WARRANTY; without even the implied warranty of
|
||
|
|
MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
||
|
|
GNU Lesser General Public License version 3 for more details.
|
||
|
|
*/
|
||
|
|
|
||
|
|
/** @file
|
||
|
|
* @brief Function Magnum::Math::Algorithms::gramSchmidtInPlace(), Magnum::Math::Algorithms::gramSchmidt()
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "Math/Matrix.h"
|
||
|
|
|
||
|
|
namespace Magnum { namespace Math { namespace Algorithms {
|
||
|
|
|
||
|
|
/**
|
||
|
|
@brief Gram-schmidt matrix orthonormalization
|
||
|
|
@param[in,out] matrix Matrix to perform orthonormalization on
|
||
|
|
*/
|
||
|
|
template<std::size_t size, class T> void gramSchmidtInPlace(Matrix<size, T>& matrix) {
|
||
|
|
for(std::size_t i = 0; i != size; ++i) {
|
||
|
|
matrix[i] = matrix[i].normalized();
|
||
|
|
for(std::size_t j = i+1; j != size; ++j)
|
||
|
|
matrix[j] -= matrix[j].projected(matrix[i]);
|
||
|
|
}
|
||
|
|
}
|
||
|
|
|
||
|
|
/**
|
||
|
|
@brief Gram-schmidt matrix orthonormalization
|
||
|
|
|
||
|
|
Unlike gramSchmidtInPlace() returns the modified matrix instead of performing
|
||
|
|
the orthonormalization in-place.
|
||
|
|
*/
|
||
|
|
template<std::size_t size, class T> Matrix<size, T> gramSchmidt(Matrix<size, T> matrix) {
|
||
|
|
gramSchmidtInPlace(matrix);
|
||
|
|
return matrix;
|
||
|
|
}
|
||
|
|
|
||
|
|
}}}
|
||
|
|
|
||
|
|
#endif
|