| 1 | //
 | 
|---|
| 2 | // blockeddiag.cc
 | 
|---|
| 3 | //
 | 
|---|
| 4 | // Copyright (C) 1996 Limit Point Systems, Inc.
 | 
|---|
| 5 | //
 | 
|---|
| 6 | // Author: Curtis Janssen <cljanss@limitpt.com>
 | 
|---|
| 7 | // Maintainer: LPS
 | 
|---|
| 8 | //
 | 
|---|
| 9 | // This file is part of the SC Toolkit.
 | 
|---|
| 10 | //
 | 
|---|
| 11 | // The SC Toolkit is free software; you can redistribute it and/or modify
 | 
|---|
| 12 | // it under the terms of the GNU Library General Public License as published by
 | 
|---|
| 13 | // the Free Software Foundation; either version 2, or (at your option)
 | 
|---|
| 14 | // any later version.
 | 
|---|
| 15 | //
 | 
|---|
| 16 | // The SC Toolkit is distributed in the hope that it will be useful,
 | 
|---|
| 17 | // but WITHOUT ANY WARRANTY; without even the implied warranty of
 | 
|---|
| 18 | // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
 | 
|---|
| 19 | // GNU Library General Public License for more details.
 | 
|---|
| 20 | //
 | 
|---|
| 21 | // You should have received a copy of the GNU Library General Public License
 | 
|---|
| 22 | // along with the SC Toolkit; see the file COPYING.LIB.  If not, write to
 | 
|---|
| 23 | // the Free Software Foundation, 675 Mass Ave, Cambridge, MA 02139, USA.
 | 
|---|
| 24 | //
 | 
|---|
| 25 | // The U.S. Government is granted a limited license as per AL 91-7.
 | 
|---|
| 26 | //
 | 
|---|
| 27 | 
 | 
|---|
| 28 | #include <math.h>
 | 
|---|
| 29 | 
 | 
|---|
| 30 | #include <util/misc/formio.h>
 | 
|---|
| 31 | #include <util/keyval/keyval.h>
 | 
|---|
| 32 | #include <util/state/stateio.h>
 | 
|---|
| 33 | #include <math/scmat/blocked.h>
 | 
|---|
| 34 | #include <math/scmat/cmatrix.h>
 | 
|---|
| 35 | #include <math/scmat/elemop.h>
 | 
|---|
| 36 | 
 | 
|---|
| 37 | using namespace std;
 | 
|---|
| 38 | using namespace sc;
 | 
|---|
| 39 | 
 | 
|---|
| 40 | /////////////////////////////////////////////////////////////////////////////
 | 
|---|
| 41 | // BlockedDiagSCMatrix member functions
 | 
|---|
| 42 | 
 | 
|---|
| 43 | static ClassDesc BlockedDiagSCMatrix_cd(
 | 
|---|
| 44 |   typeid(BlockedDiagSCMatrix),"BlockedDiagSCMatrix",1,"public DiagSCMatrix",
 | 
|---|
| 45 |   0, 0, 0);
 | 
|---|
| 46 | 
 | 
|---|
| 47 | void
 | 
|---|
| 48 | BlockedDiagSCMatrix::resize(SCDimension *a)
 | 
|---|
| 49 | {
 | 
|---|
| 50 |   if (mats_) {
 | 
|---|
| 51 |     delete[] mats_;
 | 
|---|
| 52 |     mats_=0;
 | 
|---|
| 53 |   }
 | 
|---|
| 54 | 
 | 
|---|
| 55 |   d = a;
 | 
|---|
| 56 | 
 | 
|---|
| 57 |   mats_ = new RefDiagSCMatrix[d->blocks()->nblock()];
 | 
|---|
| 58 |   for (int i=0; i < d->blocks()->nblock(); i++)
 | 
|---|
| 59 |     if (d->blocks()->size(i))
 | 
|---|
| 60 |       mats_[i] = subkit->diagmatrix(d->blocks()->subdim(i));
 | 
|---|
| 61 | }
 | 
|---|
| 62 | 
 | 
|---|
| 63 | BlockedDiagSCMatrix::BlockedDiagSCMatrix(const RefSCDimension&a,
 | 
|---|
| 64 |                                          BlockedSCMatrixKit*k):
 | 
|---|
| 65 |   DiagSCMatrix(a,k),
 | 
|---|
| 66 |   subkit(k->subkit()),
 | 
|---|
| 67 |   mats_(0)
 | 
|---|
| 68 | {
 | 
|---|
| 69 |   resize(a);
 | 
|---|
| 70 | }
 | 
|---|
| 71 | 
 | 
|---|
| 72 | BlockedDiagSCMatrix::~BlockedDiagSCMatrix()
 | 
|---|
| 73 | {
 | 
|---|
| 74 |   if (mats_) {
 | 
|---|
| 75 |     delete[] mats_;
 | 
|---|
| 76 |     mats_=0;
 | 
|---|
| 77 |   }
 | 
|---|
| 78 | }
 | 
|---|
| 79 | 
 | 
|---|
| 80 | double
 | 
|---|
| 81 | BlockedDiagSCMatrix::get_element(int i) const
 | 
|---|
| 82 | {
 | 
|---|
| 83 |   int bi, bo;
 | 
|---|
| 84 |   d->blocks()->elem_to_block(i,bi,bo);
 | 
|---|
| 85 |   return mats_[bi]->get_element(bo);
 | 
|---|
| 86 | }
 | 
|---|
| 87 | 
 | 
|---|
| 88 | void
 | 
|---|
| 89 | BlockedDiagSCMatrix::set_element(int i,double a)
 | 
|---|
| 90 | {
 | 
|---|
| 91 |   int bi, bo;
 | 
|---|
| 92 |   d->blocks()->elem_to_block(i,bi,bo);
 | 
|---|
| 93 |   mats_[bi]->set_element(bo,a);
 | 
|---|
| 94 | }
 | 
|---|
| 95 | 
 | 
|---|
| 96 | void
 | 
|---|
| 97 | BlockedDiagSCMatrix::accumulate_element(int i,double a)
 | 
|---|
| 98 | {
 | 
|---|
| 99 |   int bi, bo;
 | 
|---|
| 100 |   d->blocks()->elem_to_block(i,bi,bo);
 | 
|---|
| 101 |   mats_[bi]->accumulate_element(bo,a);
 | 
|---|
| 102 | }
 | 
|---|
| 103 | 
 | 
|---|
| 104 | void
 | 
|---|
| 105 | BlockedDiagSCMatrix::accumulate(const DiagSCMatrix*a)
 | 
|---|
| 106 | {
 | 
|---|
| 107 |   // make sure that the argument is of the correct type
 | 
|---|
| 108 |   const BlockedDiagSCMatrix* la = require_dynamic_cast<const BlockedDiagSCMatrix*>(a,
 | 
|---|
| 109 |                                "BlockedDiagSCMatrix::accumulate");
 | 
|---|
| 110 | 
 | 
|---|
| 111 |   // make sure that the dimensions match
 | 
|---|
| 112 |   if (!dim()->equiv(la->dim())) {
 | 
|---|
| 113 |     ExEnv::errn() << indent << "BlockedDiagSCMatrix:: accumulate(SCMatrix*a): "
 | 
|---|
| 114 |          << "dimensions don't match\n";
 | 
|---|
| 115 |     abort();
 | 
|---|
| 116 |   }
 | 
|---|
| 117 | 
 | 
|---|
| 118 |   for (int i=0; i < d->blocks()->nblock(); i++)
 | 
|---|
| 119 |     if (mats_[i].nonnull())
 | 
|---|
| 120 |       mats_[i]->accumulate(la->mats_[i].pointer());
 | 
|---|
| 121 | }
 | 
|---|
| 122 | 
 | 
|---|
| 123 | double
 | 
|---|
| 124 | BlockedDiagSCMatrix::invert_this()
 | 
|---|
| 125 | {
 | 
|---|
| 126 |   double det = 1.0;
 | 
|---|
| 127 | 
 | 
|---|
| 128 |   for (int i=0; i < d->blocks()->nblock(); i++)
 | 
|---|
| 129 |     if (mats_[i].nonnull())
 | 
|---|
| 130 |       det *= mats_[i]->invert_this();
 | 
|---|
| 131 |   
 | 
|---|
| 132 |   return det;
 | 
|---|
| 133 | }
 | 
|---|
| 134 | 
 | 
|---|
| 135 | double
 | 
|---|
| 136 | BlockedDiagSCMatrix::determ_this()
 | 
|---|
| 137 | {
 | 
|---|
| 138 |   double det = 1.0;
 | 
|---|
| 139 | 
 | 
|---|
| 140 |   for (int i=0; i < d->blocks()->nblock(); i++)
 | 
|---|
| 141 |     if (mats_[i].nonnull())
 | 
|---|
| 142 |       det *= mats_[i]->determ_this();
 | 
|---|
| 143 |   
 | 
|---|
| 144 |   return det;
 | 
|---|
| 145 | }
 | 
|---|
| 146 | 
 | 
|---|
| 147 | double
 | 
|---|
| 148 | BlockedDiagSCMatrix::trace()
 | 
|---|
| 149 | {
 | 
|---|
| 150 |   double det = 0;
 | 
|---|
| 151 | 
 | 
|---|
| 152 |   for (int i=0; i < d->blocks()->nblock(); i++)
 | 
|---|
| 153 |     if (mats_[i].nonnull())
 | 
|---|
| 154 |       det += mats_[i]->trace();
 | 
|---|
| 155 |   
 | 
|---|
| 156 |   return det;
 | 
|---|
| 157 | }
 | 
|---|
| 158 | 
 | 
|---|
| 159 | void
 | 
|---|
| 160 | BlockedDiagSCMatrix::gen_invert_this()
 | 
|---|
| 161 | {
 | 
|---|
| 162 |   for (int i=0; i < d->blocks()->nblock(); i++)
 | 
|---|
| 163 |     if (mats_[i].nonnull())
 | 
|---|
| 164 |       mats_[i]->gen_invert_this();
 | 
|---|
| 165 | }
 | 
|---|
| 166 | 
 | 
|---|
| 167 | void
 | 
|---|
| 168 | BlockedDiagSCMatrix::element_op(const Ref<SCElementOp>& op)
 | 
|---|
| 169 | {
 | 
|---|
| 170 |   BlockedSCElementOp *bop = dynamic_cast<BlockedSCElementOp*>(op.pointer());
 | 
|---|
| 171 | 
 | 
|---|
| 172 |   int nb = d->blocks()->nblock();
 | 
|---|
| 173 |   
 | 
|---|
| 174 |   op->defer_collect(1);
 | 
|---|
| 175 |   for (int i=0; i < nb; i++) {
 | 
|---|
| 176 |     if (bop)
 | 
|---|
| 177 |       bop->working_on(i);
 | 
|---|
| 178 |     if (mats_[i].nonnull())
 | 
|---|
| 179 |       mats_[i]->element_op(op);
 | 
|---|
| 180 |   }
 | 
|---|
| 181 |   op->defer_collect(0);
 | 
|---|
| 182 |   if (op->has_collect()) op->collect(messagegrp());
 | 
|---|
| 183 | }
 | 
|---|
| 184 | 
 | 
|---|
| 185 | void
 | 
|---|
| 186 | BlockedDiagSCMatrix::element_op(const Ref<SCElementOp2>& op,
 | 
|---|
| 187 |                               DiagSCMatrix* m)
 | 
|---|
| 188 | {
 | 
|---|
| 189 |   BlockedDiagSCMatrix *lm = require_dynamic_cast<BlockedDiagSCMatrix*>(m,
 | 
|---|
| 190 |                                     "BlockedDiagSCMatrix::element_op");
 | 
|---|
| 191 |   if (!dim()->equiv(lm->dim())) {
 | 
|---|
| 192 |     ExEnv::errn() << indent << "BlockedDiagSCMatrix: bad element_op\n";
 | 
|---|
| 193 |     abort();
 | 
|---|
| 194 |   }
 | 
|---|
| 195 | 
 | 
|---|
| 196 |   BlockedSCElementOp2 *bop = dynamic_cast<BlockedSCElementOp2*>(op.pointer());
 | 
|---|
| 197 | 
 | 
|---|
| 198 |   int nb = d->blocks()->nblock();
 | 
|---|
| 199 |   
 | 
|---|
| 200 |   op->defer_collect(1);
 | 
|---|
| 201 |   for (int i=0; i < nb; i++) {
 | 
|---|
| 202 |     if (bop)
 | 
|---|
| 203 |       bop->working_on(i);
 | 
|---|
| 204 |     if (mats_[i].nonnull())
 | 
|---|
| 205 |       mats_[i]->element_op(op,lm->mats_[i].pointer());
 | 
|---|
| 206 |   }
 | 
|---|
| 207 |   op->defer_collect(0);
 | 
|---|
| 208 |   if (op->has_collect()) op->collect(messagegrp());
 | 
|---|
| 209 | }
 | 
|---|
| 210 | 
 | 
|---|
| 211 | void
 | 
|---|
| 212 | BlockedDiagSCMatrix::element_op(const Ref<SCElementOp3>& op,
 | 
|---|
| 213 |                               DiagSCMatrix* m,DiagSCMatrix* n)
 | 
|---|
| 214 | {
 | 
|---|
| 215 |   BlockedDiagSCMatrix *lm = require_dynamic_cast<BlockedDiagSCMatrix*>(m,
 | 
|---|
| 216 |                                       "BlockedDiagSCMatrix::element_op");
 | 
|---|
| 217 |   BlockedDiagSCMatrix *ln = require_dynamic_cast<BlockedDiagSCMatrix*>(n,
 | 
|---|
| 218 |                                       "BlockedDiagSCMatrix::element_op");
 | 
|---|
| 219 | 
 | 
|---|
| 220 |   if (!dim()->equiv(lm->dim()) || !dim()->equiv(ln->dim())) {
 | 
|---|
| 221 |     ExEnv::errn() << indent << "BlockedDiagSCMatrix: bad element_op\n";
 | 
|---|
| 222 |     abort();
 | 
|---|
| 223 |   }
 | 
|---|
| 224 | 
 | 
|---|
| 225 |   BlockedSCElementOp3 *bop = dynamic_cast<BlockedSCElementOp3*>(op.pointer());
 | 
|---|
| 226 | 
 | 
|---|
| 227 |   int nb = d->blocks()->nblock();
 | 
|---|
| 228 |   
 | 
|---|
| 229 |   op->defer_collect(1);
 | 
|---|
| 230 |   for (int i=0; i < nb; i++) {
 | 
|---|
| 231 |     if (bop)
 | 
|---|
| 232 |       bop->working_on(i);
 | 
|---|
| 233 |     if (mats_[i].nonnull())
 | 
|---|
| 234 |       mats_[i]->element_op(op,lm->mats_[i].pointer(),ln->mats_[i].pointer());
 | 
|---|
| 235 |   }
 | 
|---|
| 236 |   op->defer_collect(0);
 | 
|---|
| 237 |   if (op->has_collect()) op->collect(messagegrp());
 | 
|---|
| 238 | }
 | 
|---|
| 239 | 
 | 
|---|
| 240 | void
 | 
|---|
| 241 | BlockedDiagSCMatrix::vprint(const char *title, ostream& os, int prec) const
 | 
|---|
| 242 | {
 | 
|---|
| 243 |   int len = (title) ? strlen(title) : 0;
 | 
|---|
| 244 |   char *newtitle = new char[len + 80];
 | 
|---|
| 245 | 
 | 
|---|
| 246 |   for (int i=0; i < d->blocks()->nblock(); i++) {
 | 
|---|
| 247 |     if (mats_[i].null())
 | 
|---|
| 248 |       continue;
 | 
|---|
| 249 |     
 | 
|---|
| 250 |     sprintf(newtitle,"%s:  block %d",title,i+1);
 | 
|---|
| 251 |     mats_[i]->print(newtitle, os, prec);
 | 
|---|
| 252 |   }
 | 
|---|
| 253 | 
 | 
|---|
| 254 |   delete[] newtitle;
 | 
|---|
| 255 | }
 | 
|---|
| 256 | 
 | 
|---|
| 257 | RefSCDimension
 | 
|---|
| 258 | BlockedDiagSCMatrix::dim(int i) const
 | 
|---|
| 259 | {
 | 
|---|
| 260 |   return d->blocks()->subdim(i);
 | 
|---|
| 261 | }
 | 
|---|
| 262 | 
 | 
|---|
| 263 | int
 | 
|---|
| 264 | BlockedDiagSCMatrix::nblocks() const
 | 
|---|
| 265 | {
 | 
|---|
| 266 |   return d->blocks()->nblock();
 | 
|---|
| 267 | }
 | 
|---|
| 268 | 
 | 
|---|
| 269 | RefDiagSCMatrix
 | 
|---|
| 270 | BlockedDiagSCMatrix::block(int i)
 | 
|---|
| 271 | {
 | 
|---|
| 272 |   return mats_[i];
 | 
|---|
| 273 | }
 | 
|---|
| 274 | 
 | 
|---|
| 275 | Ref<SCMatrixSubblockIter>
 | 
|---|
| 276 | BlockedDiagSCMatrix::local_blocks(SCMatrixSubblockIter::Access access)
 | 
|---|
| 277 | {
 | 
|---|
| 278 |   Ref<SCMatrixCompositeSubblockIter> iter
 | 
|---|
| 279 |       = new SCMatrixCompositeSubblockIter(access,nblocks());
 | 
|---|
| 280 |   for (int i=0; i<nblocks(); i++) {
 | 
|---|
| 281 |       if (block(i).null())
 | 
|---|
| 282 |           iter->set_iter(i, new SCMatrixNullSubblockIter(access));
 | 
|---|
| 283 |       else
 | 
|---|
| 284 |           iter->set_iter(i, block(i)->local_blocks(access));
 | 
|---|
| 285 |     }
 | 
|---|
| 286 |   Ref<SCMatrixSubblockIter> ret = iter.pointer();
 | 
|---|
| 287 |   return ret;
 | 
|---|
| 288 | }
 | 
|---|
| 289 | 
 | 
|---|
| 290 | Ref<SCMatrixSubblockIter>
 | 
|---|
| 291 | BlockedDiagSCMatrix::all_blocks(SCMatrixSubblockIter::Access access)
 | 
|---|
| 292 | {
 | 
|---|
| 293 |   Ref<SCMatrixCompositeSubblockIter> iter
 | 
|---|
| 294 |       = new SCMatrixCompositeSubblockIter(access,nblocks());
 | 
|---|
| 295 |   for (int i=0; i<nblocks(); i++) {
 | 
|---|
| 296 |       if (block(i).null())
 | 
|---|
| 297 |           iter->set_iter(i, new SCMatrixNullSubblockIter(access));
 | 
|---|
| 298 |       else
 | 
|---|
| 299 |           iter->set_iter(i, block(i)->all_blocks(access));
 | 
|---|
| 300 |     }
 | 
|---|
| 301 |   Ref<SCMatrixSubblockIter> ret = iter.pointer();
 | 
|---|
| 302 |   return ret;
 | 
|---|
| 303 | }
 | 
|---|
| 304 | 
 | 
|---|
| 305 | void
 | 
|---|
| 306 | BlockedDiagSCMatrix::save(StateOut&s)
 | 
|---|
| 307 | {
 | 
|---|
| 308 |   int ndim = n();
 | 
|---|
| 309 |   s.put(ndim);
 | 
|---|
| 310 |   int has_subblocks = 1;
 | 
|---|
| 311 |   s.put(has_subblocks);
 | 
|---|
| 312 |   s.put(nblocks());
 | 
|---|
| 313 |   for (int i=0; i<nblocks(); i++) {
 | 
|---|
| 314 |       block(i).save(s);
 | 
|---|
| 315 |     }
 | 
|---|
| 316 | }
 | 
|---|
| 317 | 
 | 
|---|
| 318 | void
 | 
|---|
| 319 | BlockedDiagSCMatrix::restore(StateIn& s)
 | 
|---|
| 320 | {
 | 
|---|
| 321 |   int ndimt, ndim = n();
 | 
|---|
| 322 |   s.get(ndimt);
 | 
|---|
| 323 |   if (ndimt != ndim) {
 | 
|---|
| 324 |       ExEnv::errn() << indent
 | 
|---|
| 325 |            << "BlockedDiagSCMatrix::restore(): bad dimension" << endl;
 | 
|---|
| 326 |       abort();
 | 
|---|
| 327 |     }
 | 
|---|
| 328 |   int has_subblocks;
 | 
|---|
| 329 |   s.get(has_subblocks);
 | 
|---|
| 330 |   if (has_subblocks) {
 | 
|---|
| 331 |       int nblock;
 | 
|---|
| 332 |       s.get(nblock);
 | 
|---|
| 333 |       if (nblock != nblocks()) {
 | 
|---|
| 334 |           ExEnv::errn() << indent
 | 
|---|
| 335 |                << "BlockedDiagSCMatrix::restore(): nblock differs\n" << endl;
 | 
|---|
| 336 |           abort();
 | 
|---|
| 337 |         }
 | 
|---|
| 338 |       for (int i=0; i<nblocks(); i++) {
 | 
|---|
| 339 |           block(i).restore(s);
 | 
|---|
| 340 |         }
 | 
|---|
| 341 |     }
 | 
|---|
| 342 |   else {
 | 
|---|
| 343 |       ExEnv::errn() << indent
 | 
|---|
| 344 |            << "BlockedDiagSCMatrix::restore(): no subblocks--cannot restore"
 | 
|---|
| 345 |            << endl;
 | 
|---|
| 346 |       abort();
 | 
|---|
| 347 |     }
 | 
|---|
| 348 | }
 | 
|---|
| 349 | 
 | 
|---|
| 350 | /////////////////////////////////////////////////////////////////////////////
 | 
|---|
| 351 | 
 | 
|---|
| 352 | // Local Variables:
 | 
|---|
| 353 | // mode: c++
 | 
|---|
| 354 | // c-file-style: "CLJ"
 | 
|---|
| 355 | // End:
 | 
|---|