486 lines
12 KiB
C++
486 lines
12 KiB
C++
// SPDX-License-Identifier: Apache-2.0
|
|
//
|
|
// Copyright 2008-2016 Conrad Sanderson (http://conradsanderson.id.au)
|
|
// Copyright 2008-2016 National ICT Australia (NICTA)
|
|
//
|
|
// 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.
|
|
// ------------------------------------------------------------------------
|
|
|
|
|
|
//! \addtogroup sym_helper
|
|
//! @{
|
|
|
|
|
|
namespace sym_helper
|
|
{
|
|
|
|
// computationally inexpensive algorithm to guess whether a matrix is positive definite:
|
|
// (1) ensure the matrix is symmetric/hermitian (within a tolerance)
|
|
// (2) ensure the diagonal entries are real and greater than zero
|
|
// (3) ensure that the value with largest modulus is on the main diagonal
|
|
// (4) ensure rudimentary diagonal dominance: (real(A_ii) + real(A_jj)) > 2*abs(real(A_ij))
|
|
// the above conditions are necessary, but not sufficient;
|
|
// doing it properly would be too computationally expensive for our purposes
|
|
// more info:
|
|
// http://mathworld.wolfram.com/PositiveDefiniteMatrix.html
|
|
// http://mathworld.wolfram.com/DiagonallyDominantMatrix.html
|
|
|
|
template<typename eT>
|
|
inline
|
|
typename enable_if2<is_cx<eT>::no, bool>::result
|
|
guess_sympd_worker(const Mat<eT>& A)
|
|
{
|
|
arma_extra_debug_sigprint();
|
|
|
|
// NOTE: assuming A is square-sized
|
|
|
|
const eT tol = eT(100) * std::numeric_limits<eT>::epsilon(); // allow some leeway
|
|
|
|
const uword N = A.n_rows;
|
|
|
|
const eT* A_mem = A.memptr();
|
|
const eT* A_col = A_mem;
|
|
|
|
eT max_diag = eT(0);
|
|
|
|
for(uword j=0; j < N; ++j)
|
|
{
|
|
const eT A_jj = A_col[j];
|
|
|
|
if(A_jj <= eT(0)) { return false; }
|
|
|
|
max_diag = (A_jj > max_diag) ? A_jj : max_diag;
|
|
|
|
A_col += N;
|
|
}
|
|
|
|
A_col = A_mem;
|
|
|
|
const uword Nm1 = N-1;
|
|
const uword Np1 = N+1;
|
|
|
|
for(uword j=0; j < Nm1; ++j)
|
|
{
|
|
const eT A_jj = A_col[j];
|
|
|
|
const uword jp1 = j+1;
|
|
const eT* A_ji_ptr = &(A_mem[j + jp1*N]); // &(A.at(j,jp1));
|
|
const eT* A_ii_ptr = &(A_mem[jp1 + jp1*N]);
|
|
|
|
for(uword i=jp1; i < N; ++i)
|
|
{
|
|
const eT A_ij = A_col[i];
|
|
const eT A_ji = (*A_ji_ptr);
|
|
|
|
const eT A_ij_abs = (std::abs)(A_ij);
|
|
const eT A_ji_abs = (std::abs)(A_ji);
|
|
|
|
// if( (A_ij_abs >= max_diag) || (A_ji_abs >= max_diag) ) { return false; }
|
|
if(A_ij_abs >= max_diag) { return false; }
|
|
|
|
const eT A_delta = (std::abs)(A_ij - A_ji);
|
|
const eT A_abs_max = (std::max)(A_ij_abs, A_ji_abs);
|
|
|
|
if( (A_delta > tol) && (A_delta > (A_abs_max*tol)) ) { return false; }
|
|
|
|
const eT A_ii = (*A_ii_ptr);
|
|
|
|
if( (A_ij_abs + A_ij_abs) >= (A_ii + A_jj) ) { return false; }
|
|
|
|
A_ji_ptr += N;
|
|
A_ii_ptr += Np1;
|
|
}
|
|
|
|
A_col += N;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
|
|
|
|
template<typename eT>
|
|
inline
|
|
typename enable_if2<is_cx<eT>::yes, bool>::result
|
|
guess_sympd_worker(const Mat<eT>& A)
|
|
{
|
|
arma_extra_debug_sigprint();
|
|
|
|
// NOTE: assuming A is square-sized
|
|
|
|
typedef typename get_pod_type<eT>::result T;
|
|
|
|
const T tol = T(100) * std::numeric_limits<T>::epsilon(); // allow some leeway
|
|
|
|
const uword N = A.n_rows;
|
|
|
|
const eT* A_mem = A.memptr();
|
|
const eT* A_col = A_mem;
|
|
|
|
T max_diag = T(0);
|
|
|
|
for(uword j=0; j < N; ++j)
|
|
{
|
|
const eT& A_jj = A_col[j];
|
|
const T A_jj_real = std::real(A_jj);
|
|
const T A_jj_imag = std::imag(A_jj);
|
|
|
|
if( (A_jj_real <= T(0)) || (std::abs(A_jj_imag) > tol) ) { return false; }
|
|
|
|
max_diag = (A_jj_real > max_diag) ? A_jj_real : max_diag;
|
|
|
|
A_col += N;
|
|
}
|
|
|
|
const T square_max_diag = max_diag * max_diag;
|
|
|
|
if(arma_isfinite(square_max_diag) == false) { return false; }
|
|
|
|
A_col = A_mem;
|
|
|
|
const uword Nm1 = N-1;
|
|
const uword Np1 = N+1;
|
|
|
|
for(uword j=0; j < Nm1; ++j)
|
|
{
|
|
const uword jp1 = j+1;
|
|
const eT* A_ji_ptr = &(A_mem[j + jp1*N]); // &(A.at(j,jp1));
|
|
const eT* A_ii_ptr = &(A_mem[jp1 + jp1*N]);
|
|
|
|
const T A_jj_real = std::real(A_col[j]);
|
|
|
|
for(uword i=jp1; i < N; ++i)
|
|
{
|
|
const eT& A_ij = A_col[i];
|
|
const T A_ij_real = std::real(A_ij);
|
|
const T A_ij_imag = std::imag(A_ij);
|
|
|
|
// avoid using std::abs(), as that is time consuming due to division and std::sqrt()
|
|
const T square_A_ij_abs = (A_ij_real * A_ij_real) + (A_ij_imag * A_ij_imag);
|
|
|
|
if(arma_isfinite(square_A_ij_abs) == false) { return false; }
|
|
|
|
if(square_A_ij_abs >= square_max_diag) { return false; }
|
|
|
|
const T A_ij_real_abs = (std::abs)(A_ij_real);
|
|
const T A_ij_imag_abs = (std::abs)(A_ij_imag);
|
|
|
|
|
|
const eT& A_ji = (*A_ji_ptr);
|
|
const T A_ji_real = std::real(A_ji);
|
|
const T A_ji_imag = std::imag(A_ji);
|
|
|
|
const T A_ji_real_abs = (std::abs)(A_ji_real);
|
|
const T A_ji_imag_abs = (std::abs)(A_ji_imag);
|
|
|
|
const T A_real_delta = (std::abs)(A_ij_real - A_ji_real);
|
|
const T A_real_abs_max = (std::max)(A_ij_real_abs, A_ji_real_abs);
|
|
|
|
if( (A_real_delta > tol) && (A_real_delta > (A_real_abs_max*tol)) ) { return false; }
|
|
|
|
|
|
const T A_imag_delta = (std::abs)(A_ij_imag + A_ji_imag); // take into account complex conjugate
|
|
const T A_imag_abs_max = (std::max)(A_ij_imag_abs, A_ji_imag_abs);
|
|
|
|
if( (A_imag_delta > tol) && (A_imag_delta > (A_imag_abs_max*tol)) ) { return false; }
|
|
|
|
|
|
const T A_ii_real = std::real(*A_ii_ptr);
|
|
|
|
if( (A_ij_real_abs + A_ij_real_abs) >= (A_ii_real + A_jj_real) ) { return false; }
|
|
|
|
A_ji_ptr += N;
|
|
A_ii_ptr += Np1;
|
|
}
|
|
|
|
A_col += N;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
|
|
|
|
template<typename eT>
|
|
inline
|
|
bool
|
|
guess_sympd(const Mat<eT>& A)
|
|
{
|
|
arma_extra_debug_sigprint();
|
|
|
|
// analyse matrices with size >= 4x4
|
|
|
|
if((A.n_rows != A.n_cols) || (A.n_rows < uword(4))) { return false; }
|
|
|
|
return guess_sympd_worker(A);
|
|
}
|
|
|
|
|
|
|
|
template<typename eT>
|
|
inline
|
|
bool
|
|
guess_sympd(const Mat<eT>& A, const uword min_n_rows)
|
|
{
|
|
arma_extra_debug_sigprint();
|
|
|
|
if((A.n_rows != A.n_cols) || (A.n_rows < min_n_rows)) { return false; }
|
|
|
|
return guess_sympd_worker(A);
|
|
}
|
|
|
|
|
|
|
|
//
|
|
|
|
|
|
|
|
template<typename eT>
|
|
inline
|
|
typename enable_if2<is_cx<eT>::no, void>::result
|
|
analyse_matrix_worker(bool& is_approx_sym, bool& is_approx_sympd, const Mat<eT>& A)
|
|
{
|
|
arma_extra_debug_sigprint();
|
|
|
|
is_approx_sym = true;
|
|
is_approx_sympd = true;
|
|
|
|
const eT tol = eT(100) * std::numeric_limits<eT>::epsilon(); // allow some leeway
|
|
|
|
const uword N = A.n_rows;
|
|
|
|
const eT* A_mem = A.memptr();
|
|
const eT* A_col = A_mem;
|
|
|
|
eT max_diag = eT(0);
|
|
|
|
for(uword j=0; j < N; ++j)
|
|
{
|
|
const eT A_jj = A_col[j];
|
|
|
|
if(A_jj <= eT(0)) { is_approx_sympd = false; }
|
|
|
|
max_diag = (A_jj > max_diag) ? A_jj : max_diag;
|
|
|
|
A_col += N;
|
|
}
|
|
|
|
A_col = A_mem;
|
|
|
|
const uword Nm1 = N-1;
|
|
const uword Np1 = N+1;
|
|
|
|
for(uword j=0; j < Nm1; ++j)
|
|
{
|
|
const eT A_jj = A_col[j];
|
|
|
|
const uword jp1 = j+1;
|
|
const eT* A_ji_ptr = &(A_mem[j + jp1*N]); // &(A.at(j,jp1));
|
|
const eT* A_ii_ptr = &(A_mem[jp1 + jp1*N]);
|
|
|
|
for(uword i=jp1; i < N; ++i)
|
|
{
|
|
const eT A_ij = A_col[i];
|
|
const eT A_ji = (*A_ji_ptr);
|
|
|
|
const eT A_ij_abs = (std::abs)(A_ij);
|
|
const eT A_ji_abs = (std::abs)(A_ji);
|
|
|
|
const eT A_delta = (std::abs)(A_ij - A_ji);
|
|
const eT A_abs_max = (std::max)(A_ij_abs, A_ji_abs);
|
|
|
|
if( (A_delta > tol) && (A_delta > (A_abs_max*tol)) ) { is_approx_sym = false; return; }
|
|
|
|
if(is_approx_sympd)
|
|
{
|
|
// if( (A_ij_abs >= max_diag) || (A_ji_abs >= max_diag) ) { is_approx_sympd = false; }
|
|
if(A_ij_abs >= max_diag) { is_approx_sympd = false; }
|
|
|
|
const eT A_ii = (*A_ii_ptr);
|
|
|
|
if( (A_ij_abs + A_ij_abs) >= (A_ii + A_jj) ) { is_approx_sympd = false; }
|
|
}
|
|
|
|
A_ji_ptr += N;
|
|
A_ii_ptr += Np1;
|
|
}
|
|
|
|
A_col += N;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
template<typename eT>
|
|
inline
|
|
typename enable_if2<is_cx<eT>::yes, void>::result
|
|
analyse_matrix_worker(bool& is_approx_sym, bool& is_approx_sympd, const Mat<eT>& A)
|
|
{
|
|
arma_extra_debug_sigprint();
|
|
|
|
typedef typename get_pod_type<eT>::result T;
|
|
|
|
is_approx_sym = true;
|
|
is_approx_sympd = true;
|
|
|
|
const T tol = T(100) * std::numeric_limits<T>::epsilon(); // allow some leeway
|
|
|
|
const uword N = A.n_rows;
|
|
|
|
const eT* A_mem = A.memptr();
|
|
const eT* A_col = A_mem;
|
|
|
|
T max_diag = T(0);
|
|
|
|
for(uword j=0; j < N; ++j)
|
|
{
|
|
const eT& A_jj = A_col[j];
|
|
const T A_jj_real = std::real(A_jj);
|
|
const T A_jj_imag = std::imag(A_jj);
|
|
|
|
if( (A_jj_real <= T(0)) || (std::abs(A_jj_imag) > tol) ) { is_approx_sympd = false; }
|
|
|
|
max_diag = (A_jj_real > max_diag) ? A_jj_real : max_diag;
|
|
|
|
A_col += N;
|
|
}
|
|
|
|
const T square_max_diag = max_diag * max_diag;
|
|
|
|
if(arma_isfinite(square_max_diag) == false) { is_approx_sympd = false; }
|
|
|
|
A_col = A_mem;
|
|
|
|
const uword Nm1 = N-1;
|
|
const uword Np1 = N+1;
|
|
|
|
for(uword j=0; j < Nm1; ++j)
|
|
{
|
|
const uword jp1 = j+1;
|
|
const eT* A_ji_ptr = &(A_mem[j + jp1*N]); // &(A.at(j,jp1));
|
|
const eT* A_ii_ptr = &(A_mem[jp1 + jp1*N]);
|
|
|
|
const T A_jj_real = std::real(A_col[j]);
|
|
|
|
for(uword i=jp1; i < N; ++i)
|
|
{
|
|
const eT& A_ij = A_col[i];
|
|
const T A_ij_real = std::real(A_ij);
|
|
const T A_ij_imag = std::imag(A_ij);
|
|
|
|
const T A_ij_real_abs = (std::abs)(A_ij_real);
|
|
const T A_ij_imag_abs = (std::abs)(A_ij_imag);
|
|
|
|
const eT& A_ji = (*A_ji_ptr);
|
|
const T A_ji_real = std::real(A_ji);
|
|
const T A_ji_imag = std::imag(A_ji);
|
|
|
|
const T A_ji_real_abs = (std::abs)(A_ji_real);
|
|
const T A_ji_imag_abs = (std::abs)(A_ji_imag);
|
|
|
|
const T A_real_delta = (std::abs)(A_ij_real - A_ji_real);
|
|
const T A_real_abs_max = (std::max)(A_ij_real_abs, A_ji_real_abs);
|
|
|
|
if( (A_real_delta > tol) && (A_real_delta > (A_real_abs_max*tol)) ) { is_approx_sym = false; return; }
|
|
|
|
const T A_imag_delta = (std::abs)(A_ij_imag + A_ji_imag); // take into account complex conjugate
|
|
const T A_imag_abs_max = (std::max)(A_ij_imag_abs, A_ji_imag_abs);
|
|
|
|
if( (A_imag_delta > tol) && (A_imag_delta > (A_imag_abs_max*tol)) ) { is_approx_sym = false; return; }
|
|
|
|
if(is_approx_sympd)
|
|
{
|
|
// avoid using std::abs(), as that is time consuming due to division and std::sqrt()
|
|
const T square_A_ij_abs = (A_ij_real * A_ij_real) + (A_ij_imag * A_ij_imag);
|
|
|
|
if(arma_isfinite(square_A_ij_abs) == false)
|
|
{
|
|
is_approx_sympd = false;
|
|
}
|
|
else
|
|
{
|
|
const T A_ii_real = std::real(*A_ii_ptr);
|
|
|
|
if( (A_ij_real_abs + A_ij_real_abs) >= (A_ii_real + A_jj_real) ) { is_approx_sympd = false; }
|
|
|
|
if(square_A_ij_abs >= square_max_diag) { is_approx_sympd = false; }
|
|
}
|
|
}
|
|
|
|
A_ji_ptr += N;
|
|
A_ii_ptr += Np1;
|
|
}
|
|
|
|
A_col += N;
|
|
}
|
|
}
|
|
|
|
|
|
|
|
template<typename eT>
|
|
inline
|
|
void
|
|
analyse_matrix(bool& is_approx_sym, bool& is_approx_sympd, const Mat<eT>& A)
|
|
{
|
|
arma_extra_debug_sigprint();
|
|
|
|
if((A.n_rows != A.n_cols) || (A.n_rows < uword(4)))
|
|
{
|
|
is_approx_sym = false;
|
|
is_approx_sympd = false;
|
|
return;
|
|
}
|
|
|
|
analyse_matrix_worker(is_approx_sym, is_approx_sympd, A);
|
|
|
|
if(is_approx_sym == false) { is_approx_sympd = false; }
|
|
}
|
|
|
|
|
|
|
|
template<typename eT>
|
|
inline
|
|
bool
|
|
check_diag_imag(const Mat<eT>& A)
|
|
{
|
|
arma_extra_debug_sigprint();
|
|
|
|
// NOTE: assuming matrix A is square-sized
|
|
|
|
typedef typename get_pod_type<eT>::result T;
|
|
|
|
const T tol = T(10000) * std::numeric_limits<T>::epsilon(); // allow some leeway
|
|
|
|
const eT* colmem = A.memptr();
|
|
|
|
const uword N = A.n_rows;
|
|
|
|
for(uword i=0; i<N; ++i)
|
|
{
|
|
const eT& A_ii = colmem[i];
|
|
const T A_ii_imag = access::tmp_imag(A_ii);
|
|
|
|
if(std::abs(A_ii_imag) > tol) { return false; }
|
|
|
|
colmem += N;
|
|
}
|
|
|
|
return true;
|
|
}
|
|
|
|
|
|
|
|
} // end of namespace sym_helper
|
|
|
|
|
|
//! @}
|