| 1 | // This file is part of Eigen, a lightweight C++ template library |
| 2 | // for linear algebra. |
| 3 | // |
| 4 | // Copyright (C) 2008 Benoit Jacob <jacob.benoit.1@gmail.com> |
| 5 | // Copyright (C) 2008-2009 Gael Guennebaud <gael.guennebaud@inria.fr> |
| 6 | // |
| 7 | // This Source Code Form is subject to the terms of the Mozilla |
| 8 | // Public License v. 2.0. If a copy of the MPL was not distributed |
| 9 | // with this file, You can obtain one at http://mozilla.org/MPL/2.0/. |
| 10 | |
| 11 | #ifndef EIGEN_TRIANGULARMATRIX_H |
| 12 | #define EIGEN_TRIANGULARMATRIX_H |
| 13 | |
| 14 | namespace Eigen { |
| 15 | |
| 16 | namespace internal { |
| 17 | |
| 18 | template<int Side, typename TriangularType, typename Rhs> struct triangular_solve_retval; |
| 19 | |
| 20 | } |
| 21 | |
| 22 | /** \class TriangularBase |
| 23 | * \ingroup Core_Module |
| 24 | * |
| 25 | * \brief Base class for triangular part in a matrix |
| 26 | */ |
| 27 | template<typename Derived> class TriangularBase : public EigenBase<Derived> |
| 28 | { |
| 29 | public: |
| 30 | |
| 31 | enum { |
| 32 | Mode = internal::traits<Derived>::Mode, |
| 33 | RowsAtCompileTime = internal::traits<Derived>::RowsAtCompileTime, |
| 34 | ColsAtCompileTime = internal::traits<Derived>::ColsAtCompileTime, |
| 35 | MaxRowsAtCompileTime = internal::traits<Derived>::MaxRowsAtCompileTime, |
| 36 | MaxColsAtCompileTime = internal::traits<Derived>::MaxColsAtCompileTime, |
| 37 | |
| 38 | SizeAtCompileTime = (internal::size_at_compile_time<internal::traits<Derived>::RowsAtCompileTime, |
| 39 | internal::traits<Derived>::ColsAtCompileTime>::ret), |
| 40 | /**< This is equal to the number of coefficients, i.e. the number of |
| 41 | * rows times the number of columns, or to \a Dynamic if this is not |
| 42 | * known at compile-time. \sa RowsAtCompileTime, ColsAtCompileTime */ |
| 43 | |
| 44 | MaxSizeAtCompileTime = (internal::size_at_compile_time<internal::traits<Derived>::MaxRowsAtCompileTime, |
| 45 | internal::traits<Derived>::MaxColsAtCompileTime>::ret) |
| 46 | |
| 47 | }; |
| 48 | typedef typename internal::traits<Derived>::Scalar Scalar; |
| 49 | typedef typename internal::traits<Derived>::StorageKind StorageKind; |
| 50 | typedef typename internal::traits<Derived>::StorageIndex StorageIndex; |
| 51 | typedef typename internal::traits<Derived>::FullMatrixType DenseMatrixType; |
| 52 | typedef DenseMatrixType DenseType; |
| 53 | typedef Derived const& Nested; |
| 54 | |
| 55 | EIGEN_DEVICE_FUNC |
| 56 | inline TriangularBase() { eigen_assert(!((Mode&UnitDiag) && (Mode&ZeroDiag))); } |
| 57 | |
| 58 | EIGEN_DEVICE_FUNC |
| 59 | inline Index rows() const { return derived().rows(); } |
| 60 | EIGEN_DEVICE_FUNC |
| 61 | inline Index cols() const { return derived().cols(); } |
| 62 | EIGEN_DEVICE_FUNC |
| 63 | inline Index outerStride() const { return derived().outerStride(); } |
| 64 | EIGEN_DEVICE_FUNC |
| 65 | inline Index innerStride() const { return derived().innerStride(); } |
| 66 | |
| 67 | // dummy resize function |
| 68 | void resize(Index rows, Index cols) |
| 69 | { |
| 70 | EIGEN_UNUSED_VARIABLE(rows); |
| 71 | EIGEN_UNUSED_VARIABLE(cols); |
| 72 | eigen_assert(rows==this->rows() && cols==this->cols()); |
| 73 | } |
| 74 | |
| 75 | EIGEN_DEVICE_FUNC |
| 76 | inline Scalar coeff(Index row, Index col) const { return derived().coeff(row,col); } |
| 77 | EIGEN_DEVICE_FUNC |
| 78 | inline Scalar& coeffRef(Index row, Index col) { return derived().coeffRef(row,col); } |
| 79 | |
| 80 | /** \see MatrixBase::copyCoeff(row,col) |
| 81 | */ |
| 82 | template<typename Other> |
| 83 | EIGEN_DEVICE_FUNC |
| 84 | EIGEN_STRONG_INLINE void copyCoeff(Index row, Index col, Other& other) |
| 85 | { |
| 86 | derived().coeffRef(row, col) = other.coeff(row, col); |
| 87 | } |
| 88 | |
| 89 | EIGEN_DEVICE_FUNC |
| 90 | inline Scalar operator()(Index row, Index col) const |
| 91 | { |
| 92 | check_coordinates(row, col); |
| 93 | return coeff(row,col); |
| 94 | } |
| 95 | EIGEN_DEVICE_FUNC |
| 96 | inline Scalar& operator()(Index row, Index col) |
| 97 | { |
| 98 | check_coordinates(row, col); |
| 99 | return coeffRef(row,col); |
| 100 | } |
| 101 | |
| 102 | #ifndef EIGEN_PARSED_BY_DOXYGEN |
| 103 | EIGEN_DEVICE_FUNC |
| 104 | inline const Derived& derived() const { return *static_cast<const Derived*>(this); } |
| 105 | EIGEN_DEVICE_FUNC |
| 106 | inline Derived& derived() { return *static_cast<Derived*>(this); } |
| 107 | #endif // not EIGEN_PARSED_BY_DOXYGEN |
| 108 | |
| 109 | template<typename DenseDerived> |
| 110 | EIGEN_DEVICE_FUNC |
| 111 | void evalTo(MatrixBase<DenseDerived> &other) const; |
| 112 | template<typename DenseDerived> |
| 113 | EIGEN_DEVICE_FUNC |
| 114 | void evalToLazy(MatrixBase<DenseDerived> &other) const; |
| 115 | |
| 116 | EIGEN_DEVICE_FUNC |
| 117 | DenseMatrixType toDenseMatrix() const |
| 118 | { |
| 119 | DenseMatrixType res(rows(), cols()); |
| 120 | evalToLazy(res); |
| 121 | return res; |
| 122 | } |
| 123 | |
| 124 | protected: |
| 125 | |
| 126 | void check_coordinates(Index row, Index col) const |
| 127 | { |
| 128 | EIGEN_ONLY_USED_FOR_DEBUG(row); |
| 129 | EIGEN_ONLY_USED_FOR_DEBUG(col); |
| 130 | eigen_assert(col>=0 && col<cols() && row>=0 && row<rows()); |
| 131 | const int mode = int(Mode) & ~SelfAdjoint; |
| 132 | EIGEN_ONLY_USED_FOR_DEBUG(mode); |
| 133 | eigen_assert((mode==Upper && col>=row) |
| 134 | || (mode==Lower && col<=row) |
| 135 | || ((mode==StrictlyUpper || mode==UnitUpper) && col>row) |
| 136 | || ((mode==StrictlyLower || mode==UnitLower) && col<row)); |
| 137 | } |
| 138 | |
| 139 | #ifdef EIGEN_INTERNAL_DEBUGGING |
| 140 | void check_coordinates_internal(Index row, Index col) const |
| 141 | { |
| 142 | check_coordinates(row, col); |
| 143 | } |
| 144 | #else |
| 145 | void check_coordinates_internal(Index , Index ) const {} |
| 146 | #endif |
| 147 | |
| 148 | }; |
| 149 | |
| 150 | /** \class TriangularView |
| 151 | * \ingroup Core_Module |
| 152 | * |
| 153 | * \brief Expression of a triangular part in a matrix |
| 154 | * |
| 155 | * \param MatrixType the type of the object in which we are taking the triangular part |
| 156 | * \param Mode the kind of triangular matrix expression to construct. Can be #Upper, |
| 157 | * #Lower, #UnitUpper, #UnitLower, #StrictlyUpper, or #StrictlyLower. |
| 158 | * This is in fact a bit field; it must have either #Upper or #Lower, |
| 159 | * and additionally it may have #UnitDiag or #ZeroDiag or neither. |
| 160 | * |
| 161 | * This class represents a triangular part of a matrix, not necessarily square. Strictly speaking, for rectangular |
| 162 | * matrices one should speak of "trapezoid" parts. This class is the return type |
| 163 | * of MatrixBase::triangularView() and SparseMatrixBase::triangularView(), and most of the time this is the only way it is used. |
| 164 | * |
| 165 | * \sa MatrixBase::triangularView() |
| 166 | */ |
| 167 | namespace internal { |
| 168 | template<typename MatrixType, unsigned int _Mode> |
| 169 | struct traits<TriangularView<MatrixType, _Mode> > : traits<MatrixType> |
| 170 | { |
| 171 | typedef typename ref_selector<MatrixType>::non_const_type MatrixTypeNested; |
| 172 | typedef typename remove_reference<MatrixTypeNested>::type MatrixTypeNestedNonRef; |
| 173 | typedef typename remove_all<MatrixTypeNested>::type MatrixTypeNestedCleaned; |
| 174 | typedef typename MatrixType::PlainObject FullMatrixType; |
| 175 | typedef MatrixType ExpressionType; |
| 176 | enum { |
| 177 | Mode = _Mode, |
| 178 | FlagsLvalueBit = is_lvalue<MatrixType>::value ? LvalueBit : 0, |
| 179 | Flags = (MatrixTypeNestedCleaned::Flags & (HereditaryBits | FlagsLvalueBit) & (~(PacketAccessBit | DirectAccessBit | LinearAccessBit))) |
| 180 | }; |
| 181 | }; |
| 182 | } |
| 183 | |
| 184 | template<typename _MatrixType, unsigned int _Mode, typename StorageKind> class TriangularViewImpl; |
| 185 | |
| 186 | template<typename _MatrixType, unsigned int _Mode> class TriangularView |
| 187 | : public TriangularViewImpl<_MatrixType, _Mode, typename internal::traits<_MatrixType>::StorageKind > |
| 188 | { |
| 189 | public: |
| 190 | |
| 191 | typedef TriangularViewImpl<_MatrixType, _Mode, typename internal::traits<_MatrixType>::StorageKind > Base; |
| 192 | typedef typename internal::traits<TriangularView>::Scalar Scalar; |
| 193 | typedef _MatrixType MatrixType; |
| 194 | |
| 195 | protected: |
| 196 | typedef typename internal::traits<TriangularView>::MatrixTypeNested MatrixTypeNested; |
| 197 | typedef typename internal::traits<TriangularView>::MatrixTypeNestedNonRef MatrixTypeNestedNonRef; |
| 198 | |
| 199 | typedef typename internal::remove_all<typename MatrixType::ConjugateReturnType>::type MatrixConjugateReturnType; |
| 200 | |
| 201 | public: |
| 202 | |
| 203 | typedef typename internal::traits<TriangularView>::StorageKind StorageKind; |
| 204 | typedef typename internal::traits<TriangularView>::MatrixTypeNestedCleaned NestedExpression; |
| 205 | |
| 206 | enum { |
| 207 | Mode = _Mode, |
| 208 | Flags = internal::traits<TriangularView>::Flags, |
| 209 | TransposeMode = (Mode & Upper ? Lower : 0) |
| 210 | | (Mode & Lower ? Upper : 0) |
| 211 | | (Mode & (UnitDiag)) |
| 212 | | (Mode & (ZeroDiag)), |
| 213 | IsVectorAtCompileTime = false |
| 214 | }; |
| 215 | |
| 216 | EIGEN_DEVICE_FUNC |
| 217 | explicit inline TriangularView(MatrixType& matrix) : m_matrix(matrix) |
| 218 | {} |
| 219 | |
| 220 | using Base::operator=; |
| 221 | TriangularView& operator=(const TriangularView &other) |
| 222 | { return Base::operator=(other); } |
| 223 | |
| 224 | /** \copydoc EigenBase::rows() */ |
| 225 | EIGEN_DEVICE_FUNC |
| 226 | inline Index rows() const { return m_matrix.rows(); } |
| 227 | /** \copydoc EigenBase::cols() */ |
| 228 | EIGEN_DEVICE_FUNC |
| 229 | inline Index cols() const { return m_matrix.cols(); } |
| 230 | |
| 231 | /** \returns a const reference to the nested expression */ |
| 232 | EIGEN_DEVICE_FUNC |
| 233 | const NestedExpression& nestedExpression() const { return m_matrix; } |
| 234 | |
| 235 | /** \returns a reference to the nested expression */ |
| 236 | EIGEN_DEVICE_FUNC |
| 237 | NestedExpression& nestedExpression() { return m_matrix; } |
| 238 | |
| 239 | typedef TriangularView<const MatrixConjugateReturnType,Mode> ConjugateReturnType; |
| 240 | /** \sa MatrixBase::conjugate() const */ |
| 241 | EIGEN_DEVICE_FUNC |
| 242 | inline const ConjugateReturnType conjugate() const |
| 243 | { return ConjugateReturnType(m_matrix.conjugate()); } |
| 244 | |
| 245 | typedef TriangularView<const typename MatrixType::AdjointReturnType,TransposeMode> AdjointReturnType; |
| 246 | /** \sa MatrixBase::adjoint() const */ |
| 247 | EIGEN_DEVICE_FUNC |
| 248 | inline const AdjointReturnType adjoint() const |
| 249 | { return AdjointReturnType(m_matrix.adjoint()); } |
| 250 | |
| 251 | typedef TriangularView<typename MatrixType::TransposeReturnType,TransposeMode> TransposeReturnType; |
| 252 | /** \sa MatrixBase::transpose() */ |
| 253 | EIGEN_DEVICE_FUNC |
| 254 | inline TransposeReturnType transpose() |
| 255 | { |
| 256 | EIGEN_STATIC_ASSERT_LVALUE(MatrixType) |
| 257 | typename MatrixType::TransposeReturnType tmp(m_matrix); |
| 258 | return TransposeReturnType(tmp); |
| 259 | } |
| 260 | |
| 261 | typedef TriangularView<const typename MatrixType::ConstTransposeReturnType,TransposeMode> ConstTransposeReturnType; |
| 262 | /** \sa MatrixBase::transpose() const */ |
| 263 | EIGEN_DEVICE_FUNC |
| 264 | inline const ConstTransposeReturnType transpose() const |
| 265 | { |
| 266 | return ConstTransposeReturnType(m_matrix.transpose()); |
| 267 | } |
| 268 | |
| 269 | template<typename Other> |
| 270 | EIGEN_DEVICE_FUNC |
| 271 | inline const Solve<TriangularView, Other> |
| 272 | solve(const MatrixBase<Other>& other) const |
| 273 | { return Solve<TriangularView, Other>(*this, other.derived()); } |
| 274 | |
| 275 | // workaround MSVC ICE |
| 276 | #if EIGEN_COMP_MSVC |
| 277 | template<int Side, typename Other> |
| 278 | EIGEN_DEVICE_FUNC |
| 279 | inline const internal::triangular_solve_retval<Side,TriangularView, Other> |
| 280 | solve(const MatrixBase<Other>& other) const |
| 281 | { return Base::template solve<Side>(other); } |
| 282 | #else |
| 283 | using Base::solve; |
| 284 | #endif |
| 285 | |
| 286 | /** \returns a selfadjoint view of the referenced triangular part which must be either \c #Upper or \c #Lower. |
| 287 | * |
| 288 | * This is a shortcut for \code this->nestedExpression().selfadjointView<(*this)::Mode>() \endcode |
| 289 | * \sa MatrixBase::selfadjointView() */ |
| 290 | EIGEN_DEVICE_FUNC |
| 291 | SelfAdjointView<MatrixTypeNestedNonRef,Mode> selfadjointView() |
| 292 | { |
| 293 | EIGEN_STATIC_ASSERT((Mode&(UnitDiag|ZeroDiag))==0,PROGRAMMING_ERROR); |
| 294 | return SelfAdjointView<MatrixTypeNestedNonRef,Mode>(m_matrix); |
| 295 | } |
| 296 | |
| 297 | /** This is the const version of selfadjointView() */ |
| 298 | EIGEN_DEVICE_FUNC |
| 299 | const SelfAdjointView<MatrixTypeNestedNonRef,Mode> selfadjointView() const |
| 300 | { |
| 301 | EIGEN_STATIC_ASSERT((Mode&(UnitDiag|ZeroDiag))==0,PROGRAMMING_ERROR); |
| 302 | return SelfAdjointView<MatrixTypeNestedNonRef,Mode>(m_matrix); |
| 303 | } |
| 304 | |
| 305 | |
| 306 | /** \returns the determinant of the triangular matrix |
| 307 | * \sa MatrixBase::determinant() */ |
| 308 | EIGEN_DEVICE_FUNC |
| 309 | Scalar determinant() const |
| 310 | { |
| 311 | if (Mode & UnitDiag) |
| 312 | return 1; |
| 313 | else if (Mode & ZeroDiag) |
| 314 | return 0; |
| 315 | else |
| 316 | return m_matrix.diagonal().prod(); |
| 317 | } |
| 318 | |
| 319 | protected: |
| 320 | |
| 321 | MatrixTypeNested m_matrix; |
| 322 | }; |
| 323 | |
| 324 | /** \ingroup Core_Module |
| 325 | * |
| 326 | * \brief Base class for a triangular part in a \b dense matrix |
| 327 | * |
| 328 | * This class is an abstract base class of class TriangularView, and objects of type TriangularViewImpl cannot be instantiated. |
| 329 | * It extends class TriangularView with additional methods which available for dense expressions only. |
| 330 | * |
| 331 | * \sa class TriangularView, MatrixBase::triangularView() |
| 332 | */ |
| 333 | template<typename _MatrixType, unsigned int _Mode> class TriangularViewImpl<_MatrixType,_Mode,Dense> |
| 334 | : public TriangularBase<TriangularView<_MatrixType, _Mode> > |
| 335 | { |
| 336 | public: |
| 337 | |
| 338 | typedef TriangularView<_MatrixType, _Mode> TriangularViewType; |
| 339 | typedef TriangularBase<TriangularViewType> Base; |
| 340 | typedef typename internal::traits<TriangularViewType>::Scalar Scalar; |
| 341 | |
| 342 | typedef _MatrixType MatrixType; |
| 343 | typedef typename MatrixType::PlainObject DenseMatrixType; |
| 344 | typedef DenseMatrixType PlainObject; |
| 345 | |
| 346 | public: |
| 347 | using Base::evalToLazy; |
| 348 | using Base::derived; |
| 349 | |
| 350 | typedef typename internal::traits<TriangularViewType>::StorageKind StorageKind; |
| 351 | |
| 352 | enum { |
| 353 | Mode = _Mode, |
| 354 | Flags = internal::traits<TriangularViewType>::Flags |
| 355 | }; |
| 356 | |
| 357 | /** \returns the outer-stride of the underlying dense matrix |
| 358 | * \sa DenseCoeffsBase::outerStride() */ |
| 359 | EIGEN_DEVICE_FUNC |
| 360 | inline Index outerStride() const { return derived().nestedExpression().outerStride(); } |
| 361 | /** \returns the inner-stride of the underlying dense matrix |
| 362 | * \sa DenseCoeffsBase::innerStride() */ |
| 363 | EIGEN_DEVICE_FUNC |
| 364 | inline Index innerStride() const { return derived().nestedExpression().innerStride(); } |
| 365 | |
| 366 | /** \sa MatrixBase::operator+=() */ |
| 367 | template<typename Other> |
| 368 | EIGEN_DEVICE_FUNC |
| 369 | TriangularViewType& operator+=(const DenseBase<Other>& other) { |
| 370 | internal::call_assignment_no_alias(derived(), other.derived(), internal::add_assign_op<Scalar,typename Other::Scalar>()); |
| 371 | return derived(); |
| 372 | } |
| 373 | /** \sa MatrixBase::operator-=() */ |
| 374 | template<typename Other> |
| 375 | EIGEN_DEVICE_FUNC |
| 376 | TriangularViewType& operator-=(const DenseBase<Other>& other) { |
| 377 | internal::call_assignment_no_alias(derived(), other.derived(), internal::sub_assign_op<Scalar,typename Other::Scalar>()); |
| 378 | return derived(); |
| 379 | } |
| 380 | |
| 381 | /** \sa MatrixBase::operator*=() */ |
| 382 | EIGEN_DEVICE_FUNC |
| 383 | TriangularViewType& operator*=(const typename internal::traits<MatrixType>::Scalar& other) { return *this = derived().nestedExpression() * other; } |
| 384 | /** \sa DenseBase::operator/=() */ |
| 385 | EIGEN_DEVICE_FUNC |
| 386 | TriangularViewType& operator/=(const typename internal::traits<MatrixType>::Scalar& other) { return *this = derived().nestedExpression() / other; } |
| 387 | |
| 388 | /** \sa MatrixBase::fill() */ |
| 389 | EIGEN_DEVICE_FUNC |
| 390 | void fill(const Scalar& value) { setConstant(value); } |
| 391 | /** \sa MatrixBase::setConstant() */ |
| 392 | EIGEN_DEVICE_FUNC |
| 393 | TriangularViewType& setConstant(const Scalar& value) |
| 394 | { return *this = MatrixType::Constant(derived().rows(), derived().cols(), value); } |
| 395 | /** \sa MatrixBase::setZero() */ |
| 396 | EIGEN_DEVICE_FUNC |
| 397 | TriangularViewType& setZero() { return setConstant(Scalar(0)); } |
| 398 | /** \sa MatrixBase::setOnes() */ |
| 399 | EIGEN_DEVICE_FUNC |
| 400 | TriangularViewType& setOnes() { return setConstant(Scalar(1)); } |
| 401 | |
| 402 | /** \sa MatrixBase::coeff() |
| 403 | * \warning the coordinates must fit into the referenced triangular part |
| 404 | */ |
| 405 | EIGEN_DEVICE_FUNC |
| 406 | inline Scalar coeff(Index row, Index col) const |
| 407 | { |
| 408 | Base::check_coordinates_internal(row, col); |
| 409 | return derived().nestedExpression().coeff(row, col); |
| 410 | } |
| 411 | |
| 412 | /** \sa MatrixBase::coeffRef() |
| 413 | * \warning the coordinates must fit into the referenced triangular part |
| 414 | */ |
| 415 | EIGEN_DEVICE_FUNC |
| 416 | inline Scalar& coeffRef(Index row, Index col) |
| 417 | { |
| 418 | EIGEN_STATIC_ASSERT_LVALUE(TriangularViewType); |
| 419 | Base::check_coordinates_internal(row, col); |
| 420 | return derived().nestedExpression().coeffRef(row, col); |
| 421 | } |
| 422 | |
| 423 | /** Assigns a triangular matrix to a triangular part of a dense matrix */ |
| 424 | template<typename OtherDerived> |
| 425 | EIGEN_DEVICE_FUNC |
| 426 | TriangularViewType& operator=(const TriangularBase<OtherDerived>& other); |
| 427 | |
| 428 | /** Shortcut for\code *this = other.other.triangularView<(*this)::Mode>() \endcode */ |
| 429 | template<typename OtherDerived> |
| 430 | EIGEN_DEVICE_FUNC |
| 431 | TriangularViewType& operator=(const MatrixBase<OtherDerived>& other); |
| 432 | |
| 433 | #ifndef EIGEN_PARSED_BY_DOXYGEN |
| 434 | EIGEN_DEVICE_FUNC |
| 435 | TriangularViewType& operator=(const TriangularViewImpl& other) |
| 436 | { return *this = other.derived().nestedExpression(); } |
| 437 | |
| 438 | /** \deprecated */ |
| 439 | template<typename OtherDerived> |
| 440 | EIGEN_DEVICE_FUNC |
| 441 | void lazyAssign(const TriangularBase<OtherDerived>& other); |
| 442 | |
| 443 | /** \deprecated */ |
| 444 | template<typename OtherDerived> |
| 445 | EIGEN_DEVICE_FUNC |
| 446 | void lazyAssign(const MatrixBase<OtherDerived>& other); |
| 447 | #endif |
| 448 | |
| 449 | /** Efficient triangular matrix times vector/matrix product */ |
| 450 | template<typename OtherDerived> |
| 451 | EIGEN_DEVICE_FUNC |
| 452 | const Product<TriangularViewType,OtherDerived> |
| 453 | operator*(const MatrixBase<OtherDerived>& rhs) const |
| 454 | { |
| 455 | return Product<TriangularViewType,OtherDerived>(derived(), rhs.derived()); |
| 456 | } |
| 457 | |
| 458 | /** Efficient vector/matrix times triangular matrix product */ |
| 459 | template<typename OtherDerived> friend |
| 460 | EIGEN_DEVICE_FUNC |
| 461 | const Product<OtherDerived,TriangularViewType> |
| 462 | operator*(const MatrixBase<OtherDerived>& lhs, const TriangularViewImpl& rhs) |
| 463 | { |
| 464 | return Product<OtherDerived,TriangularViewType>(lhs.derived(),rhs.derived()); |
| 465 | } |
| 466 | |
| 467 | /** \returns the product of the inverse of \c *this with \a other, \a *this being triangular. |
| 468 | * |
| 469 | * This function computes the inverse-matrix matrix product inverse(\c *this) * \a other if |
| 470 | * \a Side==OnTheLeft (the default), or the right-inverse-multiply \a other * inverse(\c *this) if |
| 471 | * \a Side==OnTheRight. |
| 472 | * |
| 473 | * Note that the template parameter \c Side can be ommitted, in which case \c Side==OnTheLeft |
| 474 | * |
| 475 | * The matrix \c *this must be triangular and invertible (i.e., all the coefficients of the |
| 476 | * diagonal must be non zero). It works as a forward (resp. backward) substitution if \c *this |
| 477 | * is an upper (resp. lower) triangular matrix. |
| 478 | * |
| 479 | * Example: \include Triangular_solve.cpp |
| 480 | * Output: \verbinclude Triangular_solve.out |
| 481 | * |
| 482 | * This function returns an expression of the inverse-multiply and can works in-place if it is assigned |
| 483 | * to the same matrix or vector \a other. |
| 484 | * |
| 485 | * For users coming from BLAS, this function (and more specifically solveInPlace()) offer |
| 486 | * all the operations supported by the \c *TRSV and \c *TRSM BLAS routines. |
| 487 | * |
| 488 | * \sa TriangularView::solveInPlace() |
| 489 | */ |
| 490 | template<int Side, typename Other> |
| 491 | EIGEN_DEVICE_FUNC |
| 492 | inline const internal::triangular_solve_retval<Side,TriangularViewType, Other> |
| 493 | solve(const MatrixBase<Other>& other) const; |
| 494 | |
| 495 | /** "in-place" version of TriangularView::solve() where the result is written in \a other |
| 496 | * |
| 497 | * \warning The parameter is only marked 'const' to make the C++ compiler accept a temporary expression here. |
| 498 | * This function will const_cast it, so constness isn't honored here. |
| 499 | * |
| 500 | * Note that the template parameter \c Side can be ommitted, in which case \c Side==OnTheLeft |
| 501 | * |
| 502 | * See TriangularView:solve() for the details. |
| 503 | */ |
| 504 | template<int Side, typename OtherDerived> |
| 505 | EIGEN_DEVICE_FUNC |
| 506 | void solveInPlace(const MatrixBase<OtherDerived>& other) const; |
| 507 | |
| 508 | template<typename OtherDerived> |
| 509 | EIGEN_DEVICE_FUNC |
| 510 | void solveInPlace(const MatrixBase<OtherDerived>& other) const |
| 511 | { return solveInPlace<OnTheLeft>(other); } |
| 512 | |
| 513 | /** Swaps the coefficients of the common triangular parts of two matrices */ |
| 514 | template<typename OtherDerived> |
| 515 | EIGEN_DEVICE_FUNC |
| 516 | #ifdef EIGEN_PARSED_BY_DOXYGEN |
| 517 | void swap(TriangularBase<OtherDerived> &other) |
| 518 | #else |
| 519 | void swap(TriangularBase<OtherDerived> const & other) |
| 520 | #endif |
| 521 | { |
| 522 | EIGEN_STATIC_ASSERT_LVALUE(OtherDerived); |
| 523 | call_assignment(derived(), other.const_cast_derived(), internal::swap_assign_op<Scalar>()); |
| 524 | } |
| 525 | |
| 526 | /** \deprecated |
| 527 | * Shortcut for \code (*this).swap(other.triangularView<(*this)::Mode>()) \endcode */ |
| 528 | template<typename OtherDerived> |
| 529 | EIGEN_DEVICE_FUNC |
| 530 | void swap(MatrixBase<OtherDerived> const & other) |
| 531 | { |
| 532 | EIGEN_STATIC_ASSERT_LVALUE(OtherDerived); |
| 533 | call_assignment(derived(), other.const_cast_derived(), internal::swap_assign_op<Scalar>()); |
| 534 | } |
| 535 | |
| 536 | template<typename RhsType, typename DstType> |
| 537 | EIGEN_DEVICE_FUNC |
| 538 | EIGEN_STRONG_INLINE void _solve_impl(const RhsType &rhs, DstType &dst) const { |
| 539 | if(!internal::is_same_dense(dst,rhs)) |
| 540 | dst = rhs; |
| 541 | this->solveInPlace(dst); |
| 542 | } |
| 543 | |
| 544 | template<typename ProductType> |
| 545 | EIGEN_DEVICE_FUNC |
| 546 | EIGEN_STRONG_INLINE TriangularViewType& _assignProduct(const ProductType& prod, const Scalar& alpha, bool beta); |
| 547 | }; |
| 548 | |
| 549 | /*************************************************************************** |
| 550 | * Implementation of triangular evaluation/assignment |
| 551 | ***************************************************************************/ |
| 552 | |
| 553 | #ifndef EIGEN_PARSED_BY_DOXYGEN |
| 554 | // FIXME should we keep that possibility |
| 555 | template<typename MatrixType, unsigned int Mode> |
| 556 | template<typename OtherDerived> |
| 557 | inline TriangularView<MatrixType, Mode>& |
| 558 | TriangularViewImpl<MatrixType, Mode, Dense>::operator=(const MatrixBase<OtherDerived>& other) |
| 559 | { |
| 560 | internal::call_assignment_no_alias(derived(), other.derived(), internal::assign_op<Scalar,typename OtherDerived::Scalar>()); |
| 561 | return derived(); |
| 562 | } |
| 563 | |
| 564 | // FIXME should we keep that possibility |
| 565 | template<typename MatrixType, unsigned int Mode> |
| 566 | template<typename OtherDerived> |
| 567 | void TriangularViewImpl<MatrixType, Mode, Dense>::lazyAssign(const MatrixBase<OtherDerived>& other) |
| 568 | { |
| 569 | internal::call_assignment_no_alias(derived(), other.template triangularView<Mode>()); |
| 570 | } |
| 571 | |
| 572 | |
| 573 | |
| 574 | template<typename MatrixType, unsigned int Mode> |
| 575 | template<typename OtherDerived> |
| 576 | inline TriangularView<MatrixType, Mode>& |
| 577 | TriangularViewImpl<MatrixType, Mode, Dense>::operator=(const TriangularBase<OtherDerived>& other) |
| 578 | { |
| 579 | eigen_assert(Mode == int(OtherDerived::Mode)); |
| 580 | internal::call_assignment(derived(), other.derived()); |
| 581 | return derived(); |
| 582 | } |
| 583 | |
| 584 | template<typename MatrixType, unsigned int Mode> |
| 585 | template<typename OtherDerived> |
| 586 | void TriangularViewImpl<MatrixType, Mode, Dense>::lazyAssign(const TriangularBase<OtherDerived>& other) |
| 587 | { |
| 588 | eigen_assert(Mode == int(OtherDerived::Mode)); |
| 589 | internal::call_assignment_no_alias(derived(), other.derived()); |
| 590 | } |
| 591 | #endif |
| 592 | |
| 593 | /*************************************************************************** |
| 594 | * Implementation of TriangularBase methods |
| 595 | ***************************************************************************/ |
| 596 | |
| 597 | /** Assigns a triangular or selfadjoint matrix to a dense matrix. |
| 598 | * If the matrix is triangular, the opposite part is set to zero. */ |
| 599 | template<typename Derived> |
| 600 | template<typename DenseDerived> |
| 601 | void TriangularBase<Derived>::evalTo(MatrixBase<DenseDerived> &other) const |
| 602 | { |
| 603 | evalToLazy(other.derived()); |
| 604 | } |
| 605 | |
| 606 | /*************************************************************************** |
| 607 | * Implementation of TriangularView methods |
| 608 | ***************************************************************************/ |
| 609 | |
| 610 | /*************************************************************************** |
| 611 | * Implementation of MatrixBase methods |
| 612 | ***************************************************************************/ |
| 613 | |
| 614 | /** |
| 615 | * \returns an expression of a triangular view extracted from the current matrix |
| 616 | * |
| 617 | * The parameter \a Mode can have the following values: \c #Upper, \c #StrictlyUpper, \c #UnitUpper, |
| 618 | * \c #Lower, \c #StrictlyLower, \c #UnitLower. |
| 619 | * |
| 620 | * Example: \include MatrixBase_triangularView.cpp |
| 621 | * Output: \verbinclude MatrixBase_triangularView.out |
| 622 | * |
| 623 | * \sa class TriangularView |
| 624 | */ |
| 625 | template<typename Derived> |
| 626 | template<unsigned int Mode> |
| 627 | typename MatrixBase<Derived>::template TriangularViewReturnType<Mode>::Type |
| 628 | MatrixBase<Derived>::triangularView() |
| 629 | { |
| 630 | return typename TriangularViewReturnType<Mode>::Type(derived()); |
| 631 | } |
| 632 | |
| 633 | /** This is the const version of MatrixBase::triangularView() */ |
| 634 | template<typename Derived> |
| 635 | template<unsigned int Mode> |
| 636 | typename MatrixBase<Derived>::template ConstTriangularViewReturnType<Mode>::Type |
| 637 | MatrixBase<Derived>::triangularView() const |
| 638 | { |
| 639 | return typename ConstTriangularViewReturnType<Mode>::Type(derived()); |
| 640 | } |
| 641 | |
| 642 | /** \returns true if *this is approximately equal to an upper triangular matrix, |
| 643 | * within the precision given by \a prec. |
| 644 | * |
| 645 | * \sa isLowerTriangular() |
| 646 | */ |
| 647 | template<typename Derived> |
| 648 | bool MatrixBase<Derived>::isUpperTriangular(const RealScalar& prec) const |
| 649 | { |
| 650 | RealScalar maxAbsOnUpperPart = static_cast<RealScalar>(-1); |
| 651 | for(Index j = 0; j < cols(); ++j) |
| 652 | { |
| 653 | Index maxi = numext::mini(j, rows()-1); |
| 654 | for(Index i = 0; i <= maxi; ++i) |
| 655 | { |
| 656 | RealScalar absValue = numext::abs(coeff(i,j)); |
| 657 | if(absValue > maxAbsOnUpperPart) maxAbsOnUpperPart = absValue; |
| 658 | } |
| 659 | } |
| 660 | RealScalar threshold = maxAbsOnUpperPart * prec; |
| 661 | for(Index j = 0; j < cols(); ++j) |
| 662 | for(Index i = j+1; i < rows(); ++i) |
| 663 | if(numext::abs(coeff(i, j)) > threshold) return false; |
| 664 | return true; |
| 665 | } |
| 666 | |
| 667 | /** \returns true if *this is approximately equal to a lower triangular matrix, |
| 668 | * within the precision given by \a prec. |
| 669 | * |
| 670 | * \sa isUpperTriangular() |
| 671 | */ |
| 672 | template<typename Derived> |
| 673 | bool MatrixBase<Derived>::isLowerTriangular(const RealScalar& prec) const |
| 674 | { |
| 675 | RealScalar maxAbsOnLowerPart = static_cast<RealScalar>(-1); |
| 676 | for(Index j = 0; j < cols(); ++j) |
| 677 | for(Index i = j; i < rows(); ++i) |
| 678 | { |
| 679 | RealScalar absValue = numext::abs(coeff(i,j)); |
| 680 | if(absValue > maxAbsOnLowerPart) maxAbsOnLowerPart = absValue; |
| 681 | } |
| 682 | RealScalar threshold = maxAbsOnLowerPart * prec; |
| 683 | for(Index j = 1; j < cols(); ++j) |
| 684 | { |
| 685 | Index maxi = numext::mini(j, rows()-1); |
| 686 | for(Index i = 0; i < maxi; ++i) |
| 687 | if(numext::abs(coeff(i, j)) > threshold) return false; |
| 688 | } |
| 689 | return true; |
| 690 | } |
| 691 | |
| 692 | |
| 693 | /*************************************************************************** |
| 694 | **************************************************************************** |
| 695 | * Evaluators and Assignment of triangular expressions |
| 696 | *************************************************************************** |
| 697 | ***************************************************************************/ |
| 698 | |
| 699 | namespace internal { |
| 700 | |
| 701 | |
| 702 | // TODO currently a triangular expression has the form TriangularView<.,.> |
| 703 | // in the future triangular-ness should be defined by the expression traits |
| 704 | // such that Transpose<TriangularView<.,.> > is valid. (currently TriangularBase::transpose() is overloaded to make it work) |
| 705 | template<typename MatrixType, unsigned int Mode> |
| 706 | struct evaluator_traits<TriangularView<MatrixType,Mode> > |
| 707 | { |
| 708 | typedef typename storage_kind_to_evaluator_kind<typename MatrixType::StorageKind>::Kind Kind; |
| 709 | typedef typename glue_shapes<typename evaluator_traits<MatrixType>::Shape, TriangularShape>::type Shape; |
| 710 | }; |
| 711 | |
| 712 | template<typename MatrixType, unsigned int Mode> |
| 713 | struct unary_evaluator<TriangularView<MatrixType,Mode>, IndexBased> |
| 714 | : evaluator<typename internal::remove_all<MatrixType>::type> |
| 715 | { |
| 716 | typedef TriangularView<MatrixType,Mode> XprType; |
| 717 | typedef evaluator<typename internal::remove_all<MatrixType>::type> Base; |
| 718 | unary_evaluator(const XprType &xpr) : Base(xpr.nestedExpression()) {} |
| 719 | }; |
| 720 | |
| 721 | // Additional assignment kinds: |
| 722 | struct Triangular2Triangular {}; |
| 723 | struct Triangular2Dense {}; |
| 724 | struct Dense2Triangular {}; |
| 725 | |
| 726 | |
| 727 | template<typename Kernel, unsigned int Mode, int UnrollCount, bool ClearOpposite> struct triangular_assignment_loop; |
| 728 | |
| 729 | |
| 730 | /** \internal Specialization of the dense assignment kernel for triangular matrices. |
| 731 | * The main difference is that the triangular, diagonal, and opposite parts are processed through three different functions. |
| 732 | * \tparam UpLo must be either Lower or Upper |
| 733 | * \tparam Mode must be either 0, UnitDiag, ZeroDiag, or SelfAdjoint |
| 734 | */ |
| 735 | template<int UpLo, int Mode, int SetOpposite, typename DstEvaluatorTypeT, typename SrcEvaluatorTypeT, typename Functor, int Version = Specialized> |
| 736 | class triangular_dense_assignment_kernel : public generic_dense_assignment_kernel<DstEvaluatorTypeT, SrcEvaluatorTypeT, Functor, Version> |
| 737 | { |
| 738 | protected: |
| 739 | typedef generic_dense_assignment_kernel<DstEvaluatorTypeT, SrcEvaluatorTypeT, Functor, Version> Base; |
| 740 | typedef typename Base::DstXprType DstXprType; |
| 741 | typedef typename Base::SrcXprType SrcXprType; |
| 742 | using Base::m_dst; |
| 743 | using Base::m_src; |
| 744 | using Base::m_functor; |
| 745 | public: |
| 746 | |
| 747 | typedef typename Base::DstEvaluatorType DstEvaluatorType; |
| 748 | typedef typename Base::SrcEvaluatorType SrcEvaluatorType; |
| 749 | typedef typename Base::Scalar Scalar; |
| 750 | typedef typename Base::AssignmentTraits AssignmentTraits; |
| 751 | |
| 752 | |
| 753 | EIGEN_DEVICE_FUNC triangular_dense_assignment_kernel(DstEvaluatorType &dst, const SrcEvaluatorType &src, const Functor &func, DstXprType& dstExpr) |
| 754 | : Base(dst, src, func, dstExpr) |
| 755 | {} |
| 756 | |
| 757 | #ifdef EIGEN_INTERNAL_DEBUGGING |
| 758 | EIGEN_DEVICE_FUNC void assignCoeff(Index row, Index col) |
| 759 | { |
| 760 | eigen_internal_assert(row!=col); |
| 761 | Base::assignCoeff(row,col); |
| 762 | } |
| 763 | #else |
| 764 | using Base::assignCoeff; |
| 765 | #endif |
| 766 | |
| 767 | EIGEN_DEVICE_FUNC void assignDiagonalCoeff(Index id) |
| 768 | { |
| 769 | if(Mode==UnitDiag && SetOpposite) m_functor.assignCoeff(m_dst.coeffRef(id,id), Scalar(1)); |
| 770 | else if(Mode==ZeroDiag && SetOpposite) m_functor.assignCoeff(m_dst.coeffRef(id,id), Scalar(0)); |
| 771 | else if(Mode==0) Base::assignCoeff(id,id); |
| 772 | } |
| 773 | |
| 774 | EIGEN_DEVICE_FUNC void assignOppositeCoeff(Index row, Index col) |
| 775 | { |
| 776 | eigen_internal_assert(row!=col); |
| 777 | if(SetOpposite) |
| 778 | m_functor.assignCoeff(m_dst.coeffRef(row,col), Scalar(0)); |
| 779 | } |
| 780 | }; |
| 781 | |
| 782 | template<int Mode, bool SetOpposite, typename DstXprType, typename SrcXprType, typename Functor> |
| 783 | EIGEN_DEVICE_FUNC EIGEN_STRONG_INLINE |
| 784 | void call_triangular_assignment_loop(DstXprType& dst, const SrcXprType& src, const Functor &func) |
| 785 | { |
| 786 | typedef evaluator<DstXprType> DstEvaluatorType; |
| 787 | typedef evaluator<SrcXprType> SrcEvaluatorType; |
| 788 | |
| 789 | SrcEvaluatorType srcEvaluator(src); |
| 790 | |
| 791 | Index dstRows = src.rows(); |
| 792 | Index dstCols = src.cols(); |
| 793 | if((dst.rows()!=dstRows) || (dst.cols()!=dstCols)) |
| 794 | dst.resize(dstRows, dstCols); |
| 795 | DstEvaluatorType dstEvaluator(dst); |
| 796 | |
| 797 | typedef triangular_dense_assignment_kernel< Mode&(Lower|Upper),Mode&(UnitDiag|ZeroDiag|SelfAdjoint),SetOpposite, |
| 798 | DstEvaluatorType,SrcEvaluatorType,Functor> Kernel; |
| 799 | Kernel kernel(dstEvaluator, srcEvaluator, func, dst.const_cast_derived()); |
| 800 | |
| 801 | enum { |
| 802 | unroll = DstXprType::SizeAtCompileTime != Dynamic |
| 803 | && SrcEvaluatorType::CoeffReadCost < HugeCost |
| 804 | && DstXprType::SizeAtCompileTime * (DstEvaluatorType::CoeffReadCost+SrcEvaluatorType::CoeffReadCost) / 2 <= EIGEN_UNROLLING_LIMIT |
| 805 | }; |
| 806 | |
| 807 | triangular_assignment_loop<Kernel, Mode, unroll ? int(DstXprType::SizeAtCompileTime) : Dynamic, SetOpposite>::run(kernel); |
| 808 | } |
| 809 | |
| 810 | template<int Mode, bool SetOpposite, typename DstXprType, typename SrcXprType> |
| 811 | EIGEN_DEVICE_FUNC EIGEN_STRONG_INLINE |
| 812 | void call_triangular_assignment_loop(DstXprType& dst, const SrcXprType& src) |
| 813 | { |
| 814 | call_triangular_assignment_loop<Mode,SetOpposite>(dst, src, internal::assign_op<typename DstXprType::Scalar,typename SrcXprType::Scalar>()); |
| 815 | } |
| 816 | |
| 817 | template<> struct AssignmentKind<TriangularShape,TriangularShape> { typedef Triangular2Triangular Kind; }; |
| 818 | template<> struct AssignmentKind<DenseShape,TriangularShape> { typedef Triangular2Dense Kind; }; |
| 819 | template<> struct AssignmentKind<TriangularShape,DenseShape> { typedef Dense2Triangular Kind; }; |
| 820 | |
| 821 | |
| 822 | template< typename DstXprType, typename SrcXprType, typename Functor> |
| 823 | struct Assignment<DstXprType, SrcXprType, Functor, Triangular2Triangular> |
| 824 | { |
| 825 | EIGEN_DEVICE_FUNC static void run(DstXprType &dst, const SrcXprType &src, const Functor &func) |
| 826 | { |
| 827 | eigen_assert(int(DstXprType::Mode) == int(SrcXprType::Mode)); |
| 828 | |
| 829 | call_triangular_assignment_loop<DstXprType::Mode, false>(dst, src, func); |
| 830 | } |
| 831 | }; |
| 832 | |
| 833 | template< typename DstXprType, typename SrcXprType, typename Functor> |
| 834 | struct Assignment<DstXprType, SrcXprType, Functor, Triangular2Dense> |
| 835 | { |
| 836 | EIGEN_DEVICE_FUNC static void run(DstXprType &dst, const SrcXprType &src, const Functor &func) |
| 837 | { |
| 838 | call_triangular_assignment_loop<SrcXprType::Mode, (SrcXprType::Mode&SelfAdjoint)==0>(dst, src, func); |
| 839 | } |
| 840 | }; |
| 841 | |
| 842 | template< typename DstXprType, typename SrcXprType, typename Functor> |
| 843 | struct Assignment<DstXprType, SrcXprType, Functor, Dense2Triangular> |
| 844 | { |
| 845 | EIGEN_DEVICE_FUNC static void run(DstXprType &dst, const SrcXprType &src, const Functor &func) |
| 846 | { |
| 847 | call_triangular_assignment_loop<DstXprType::Mode, false>(dst, src, func); |
| 848 | } |
| 849 | }; |
| 850 | |
| 851 | |
| 852 | template<typename Kernel, unsigned int Mode, int UnrollCount, bool SetOpposite> |
| 853 | struct triangular_assignment_loop |
| 854 | { |
| 855 | // FIXME: this is not very clean, perhaps this information should be provided by the kernel? |
| 856 | typedef typename Kernel::DstEvaluatorType DstEvaluatorType; |
| 857 | typedef typename DstEvaluatorType::XprType DstXprType; |
| 858 | |
| 859 | enum { |
| 860 | col = (UnrollCount-1) / DstXprType::RowsAtCompileTime, |
| 861 | row = (UnrollCount-1) % DstXprType::RowsAtCompileTime |
| 862 | }; |
| 863 | |
| 864 | typedef typename Kernel::Scalar Scalar; |
| 865 | |
| 866 | EIGEN_DEVICE_FUNC |
| 867 | static inline void run(Kernel &kernel) |
| 868 | { |
| 869 | triangular_assignment_loop<Kernel, Mode, UnrollCount-1, SetOpposite>::run(kernel); |
| 870 | |
| 871 | if(row==col) |
| 872 | kernel.assignDiagonalCoeff(row); |
| 873 | else if( ((Mode&Lower) && row>col) || ((Mode&Upper) && row<col) ) |
| 874 | kernel.assignCoeff(row,col); |
| 875 | else if(SetOpposite) |
| 876 | kernel.assignOppositeCoeff(row,col); |
| 877 | } |
| 878 | }; |
| 879 | |
| 880 | // prevent buggy user code from causing an infinite recursion |
| 881 | template<typename Kernel, unsigned int Mode, bool SetOpposite> |
| 882 | struct triangular_assignment_loop<Kernel, Mode, 0, SetOpposite> |
| 883 | { |
| 884 | EIGEN_DEVICE_FUNC |
| 885 | static inline void run(Kernel &) {} |
| 886 | }; |
| 887 | |
| 888 | |
| 889 | |
| 890 | // TODO: experiment with a recursive assignment procedure splitting the current |
| 891 | // triangular part into one rectangular and two triangular parts. |
| 892 | |
| 893 | |
| 894 | template<typename Kernel, unsigned int Mode, bool SetOpposite> |
| 895 | struct triangular_assignment_loop<Kernel, Mode, Dynamic, SetOpposite> |
| 896 | { |
| 897 | typedef typename Kernel::Scalar Scalar; |
| 898 | EIGEN_DEVICE_FUNC |
| 899 | static inline void run(Kernel &kernel) |
| 900 | { |
| 901 | for(Index j = 0; j < kernel.cols(); ++j) |
| 902 | { |
| 903 | Index maxi = numext::mini(j, kernel.rows()); |
| 904 | Index i = 0; |
| 905 | if (((Mode&Lower) && SetOpposite) || (Mode&Upper)) |
| 906 | { |
| 907 | for(; i < maxi; ++i) |
| 908 | if(Mode&Upper) kernel.assignCoeff(i, j); |
| 909 | else kernel.assignOppositeCoeff(i, j); |
| 910 | } |
| 911 | else |
| 912 | i = maxi; |
| 913 | |
| 914 | if(i<kernel.rows()) // then i==j |
| 915 | kernel.assignDiagonalCoeff(i++); |
| 916 | |
| 917 | if (((Mode&Upper) && SetOpposite) || (Mode&Lower)) |
| 918 | { |
| 919 | for(; i < kernel.rows(); ++i) |
| 920 | if(Mode&Lower) kernel.assignCoeff(i, j); |
| 921 | else kernel.assignOppositeCoeff(i, j); |
| 922 | } |
| 923 | } |
| 924 | } |
| 925 | }; |
| 926 | |
| 927 | } // end namespace internal |
| 928 | |
| 929 | /** Assigns a triangular or selfadjoint matrix to a dense matrix. |
| 930 | * If the matrix is triangular, the opposite part is set to zero. */ |
| 931 | template<typename Derived> |
| 932 | template<typename DenseDerived> |
| 933 | void TriangularBase<Derived>::evalToLazy(MatrixBase<DenseDerived> &other) const |
| 934 | { |
| 935 | other.derived().resize(this->rows(), this->cols()); |
| 936 | internal::call_triangular_assignment_loop<Derived::Mode,(Derived::Mode&SelfAdjoint)==0 /* SetOpposite */>(other.derived(), derived().nestedExpression()); |
| 937 | } |
| 938 | |
| 939 | namespace internal { |
| 940 | |
| 941 | // Triangular = Product |
| 942 | template< typename DstXprType, typename Lhs, typename Rhs, typename Scalar> |
| 943 | struct Assignment<DstXprType, Product<Lhs,Rhs,DefaultProduct>, internal::assign_op<Scalar,typename Product<Lhs,Rhs,DefaultProduct>::Scalar>, Dense2Triangular> |
| 944 | { |
| 945 | typedef Product<Lhs,Rhs,DefaultProduct> SrcXprType; |
| 946 | static void run(DstXprType &dst, const SrcXprType &src, const internal::assign_op<Scalar,typename SrcXprType::Scalar> &) |
| 947 | { |
| 948 | Index dstRows = src.rows(); |
| 949 | Index dstCols = src.cols(); |
| 950 | if((dst.rows()!=dstRows) || (dst.cols()!=dstCols)) |
| 951 | dst.resize(dstRows, dstCols); |
| 952 | |
| 953 | dst._assignProduct(src, 1, 0); |
| 954 | } |
| 955 | }; |
| 956 | |
| 957 | // Triangular += Product |
| 958 | template< typename DstXprType, typename Lhs, typename Rhs, typename Scalar> |
| 959 | struct Assignment<DstXprType, Product<Lhs,Rhs,DefaultProduct>, internal::add_assign_op<Scalar,typename Product<Lhs,Rhs,DefaultProduct>::Scalar>, Dense2Triangular> |
| 960 | { |
| 961 | typedef Product<Lhs,Rhs,DefaultProduct> SrcXprType; |
| 962 | static void run(DstXprType &dst, const SrcXprType &src, const internal::add_assign_op<Scalar,typename SrcXprType::Scalar> &) |
| 963 | { |
| 964 | dst._assignProduct(src, 1, 1); |
| 965 | } |
| 966 | }; |
| 967 | |
| 968 | // Triangular -= Product |
| 969 | template< typename DstXprType, typename Lhs, typename Rhs, typename Scalar> |
| 970 | struct Assignment<DstXprType, Product<Lhs,Rhs,DefaultProduct>, internal::sub_assign_op<Scalar,typename Product<Lhs,Rhs,DefaultProduct>::Scalar>, Dense2Triangular> |
| 971 | { |
| 972 | typedef Product<Lhs,Rhs,DefaultProduct> SrcXprType; |
| 973 | static void run(DstXprType &dst, const SrcXprType &src, const internal::sub_assign_op<Scalar,typename SrcXprType::Scalar> &) |
| 974 | { |
| 975 | dst._assignProduct(src, -1, 1); |
| 976 | } |
| 977 | }; |
| 978 | |
| 979 | } // end namespace internal |
| 980 | |
| 981 | } // end namespace Eigen |
| 982 | |
| 983 | #endif // EIGEN_TRIANGULARMATRIX_H |
| 984 | |