1 /*$Id: sbaij.c,v 1.62 2001/08/07 03:03:01 balay Exp $*/ 2 3 /* 4 Defines the basic matrix operations for the SBAIJ (compressed row) 5 matrix storage format. 6 */ 7 #include "src/mat/impls/baij/seq/baij.h" /*I "petscmat.h" I*/ 8 #include "src/inline/spops.h" 9 #include "src/mat/impls/sbaij/seq/sbaij.h" 10 11 #define CHUNKSIZE 10 12 13 /* 14 Checks for missing diagonals 15 */ 16 #undef __FUNCT__ 17 #define __FUNCT__ "MatMissingDiagonal_SeqSBAIJ" 18 int MatMissingDiagonal_SeqSBAIJ(Mat A) 19 { 20 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 21 int *diag,*jj = a->j,i,ierr; 22 23 PetscFunctionBegin; 24 ierr = MatMarkDiagonal_SeqSBAIJ(A);CHKERRQ(ierr); 25 diag = a->diag; 26 for (i=0; i<a->mbs; i++) { 27 if (jj[diag[i]] != i) SETERRQ1(1,"Matrix is missing diagonal number %d",i); 28 } 29 PetscFunctionReturn(0); 30 } 31 32 #undef __FUNCT__ 33 #define __FUNCT__ "MatMarkDiagonal_SeqSBAIJ" 34 int MatMarkDiagonal_SeqSBAIJ(Mat A) 35 { 36 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 37 int i,mbs = a->mbs,ierr; 38 39 PetscFunctionBegin; 40 if (a->diag) PetscFunctionReturn(0); 41 42 ierr = PetscMalloc((mbs+1)*sizeof(int),&a->diag);CHKERRQ(ierr); 43 PetscLogObjectMemory(A,(mbs+1)*sizeof(int)); 44 for (i=0; i<mbs; i++) a->diag[i] = a->i[i]; 45 PetscFunctionReturn(0); 46 } 47 48 #undef __FUNCT__ 49 #define __FUNCT__ "MatGetRowIJ_SeqSBAIJ" 50 static int MatGetRowIJ_SeqSBAIJ(Mat A,int oshift,PetscTruth symmetric,int *nn,int *ia[],int *ja[],PetscTruth *done) 51 { 52 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 53 int n = a->mbs,i; 54 55 PetscFunctionBegin; 56 *nn = n; 57 if (!ia) PetscFunctionReturn(0); 58 59 if (oshift == 1) { 60 /* temporarily add 1 to i and j indices */ 61 int nz = a->i[n]; 62 for (i=0; i<nz; i++) a->j[i]++; 63 for (i=0; i<n+1; i++) a->i[i]++; 64 *ia = a->i; *ja = a->j; 65 } else { 66 *ia = a->i; *ja = a->j; 67 } 68 PetscFunctionReturn(0); 69 } 70 71 #undef __FUNCT__ 72 #define __FUNCT__ "MatRestoreRowIJ_SeqSBAIJ" 73 static int MatRestoreRowIJ_SeqSBAIJ(Mat A,int oshift,PetscTruth symmetric,int *nn,int *ia[],int *ja[],PetscTruth *done) 74 { 75 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 76 int i,n = a->mbs; 77 78 PetscFunctionBegin; 79 if (!ia) PetscFunctionReturn(0); 80 81 if (oshift == 1) { 82 int nz = a->i[n]-1; 83 for (i=0; i<nz; i++) a->j[i]--; 84 for (i=0; i<n+1; i++) a->i[i]--; 85 } 86 PetscFunctionReturn(0); 87 } 88 89 #undef __FUNCT__ 90 #define __FUNCT__ "MatGetBlockSize_SeqSBAIJ" 91 int MatGetBlockSize_SeqSBAIJ(Mat mat,int *bs) 92 { 93 Mat_SeqSBAIJ *sbaij = (Mat_SeqSBAIJ*)mat->data; 94 95 PetscFunctionBegin; 96 *bs = sbaij->bs; 97 PetscFunctionReturn(0); 98 } 99 100 #undef __FUNCT__ 101 #define __FUNCT__ "MatDestroy_SeqSBAIJ" 102 int MatDestroy_SeqSBAIJ(Mat A) 103 { 104 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 105 int ierr; 106 107 PetscFunctionBegin; 108 #if defined(PETSC_USE_LOG) 109 PetscLogObjectState((PetscObject)A,"Rows=%d, NZ=%d",A->m,a->nz); 110 #endif 111 ierr = PetscFree(a->a);CHKERRQ(ierr); 112 if (!a->singlemalloc) { 113 ierr = PetscFree(a->i);CHKERRQ(ierr); 114 ierr = PetscFree(a->j);CHKERRQ(ierr); 115 } 116 if (a->row) { 117 ierr = ISDestroy(a->row);CHKERRQ(ierr); 118 } 119 if (a->diag) {ierr = PetscFree(a->diag);CHKERRQ(ierr);} 120 if (a->ilen) {ierr = PetscFree(a->ilen);CHKERRQ(ierr);} 121 if (a->imax) {ierr = PetscFree(a->imax);CHKERRQ(ierr);} 122 if (a->icol) {ierr = ISDestroy(a->icol);CHKERRQ(ierr);} 123 if (a->solve_work) {ierr = PetscFree(a->solve_work);CHKERRQ(ierr);} 124 if (a->solves_work) {ierr = PetscFree(a->solves_work);CHKERRQ(ierr);} 125 if (a->mult_work) {ierr = PetscFree(a->mult_work);CHKERRQ(ierr);} 126 if (a->saved_values) {ierr = PetscFree(a->saved_values);CHKERRQ(ierr);} 127 if (a->xtoy) {ierr = PetscFree(a->xtoy);CHKERRQ(ierr);} 128 129 if (a->inew){ 130 ierr = PetscFree(a->inew);CHKERRQ(ierr); 131 a->inew = 0; 132 } 133 ierr = PetscFree(a);CHKERRQ(ierr); 134 PetscFunctionReturn(0); 135 } 136 137 #undef __FUNCT__ 138 #define __FUNCT__ "MatSetOption_SeqSBAIJ" 139 int MatSetOption_SeqSBAIJ(Mat A,MatOption op) 140 { 141 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 142 143 PetscFunctionBegin; 144 switch (op) { 145 case MAT_ROW_ORIENTED: 146 a->roworiented = PETSC_TRUE; 147 break; 148 case MAT_COLUMN_ORIENTED: 149 a->roworiented = PETSC_FALSE; 150 break; 151 case MAT_COLUMNS_SORTED: 152 a->sorted = PETSC_TRUE; 153 break; 154 case MAT_COLUMNS_UNSORTED: 155 a->sorted = PETSC_FALSE; 156 break; 157 case MAT_KEEP_ZEROED_ROWS: 158 a->keepzeroedrows = PETSC_TRUE; 159 break; 160 case MAT_NO_NEW_NONZERO_LOCATIONS: 161 a->nonew = 1; 162 break; 163 case MAT_NEW_NONZERO_LOCATION_ERR: 164 a->nonew = -1; 165 break; 166 case MAT_NEW_NONZERO_ALLOCATION_ERR: 167 a->nonew = -2; 168 break; 169 case MAT_YES_NEW_NONZERO_LOCATIONS: 170 a->nonew = 0; 171 break; 172 case MAT_ROWS_SORTED: 173 case MAT_ROWS_UNSORTED: 174 case MAT_YES_NEW_DIAGONALS: 175 case MAT_IGNORE_OFF_PROC_ENTRIES: 176 case MAT_USE_HASH_TABLE: 177 PetscLogInfo(A,"MatSetOption_SeqSBAIJ:Option ignored\n"); 178 break; 179 case MAT_NO_NEW_DIAGONALS: 180 SETERRQ(PETSC_ERR_SUP,"MAT_NO_NEW_DIAGONALS"); 181 case MAT_NOT_SYMMETRIC: 182 case MAT_NOT_STRUCTURALLY_SYMMETRIC: 183 case MAT_HERMITIAN: 184 SETERRQ(PETSC_ERR_SUP,"Matrix must be symmetric"); 185 case MAT_SYMMETRIC: 186 case MAT_STRUCTURALLY_SYMMETRIC: 187 case MAT_NOT_HERMITIAN: 188 case MAT_SYMMETRY_ETERNAL: 189 case MAT_NOT_SYMMETRY_ETERNAL: 190 break; 191 default: 192 SETERRQ(PETSC_ERR_SUP,"unknown option"); 193 } 194 PetscFunctionReturn(0); 195 } 196 197 #undef __FUNCT__ 198 #define __FUNCT__ "MatGetRow_SeqSBAIJ" 199 int MatGetRow_SeqSBAIJ(Mat A,int row,int *ncols,int **cols,PetscScalar **v) 200 { 201 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 202 int itmp,i,j,k,M,*ai,*aj,bs,bn,bp,*cols_i,bs2,ierr; 203 MatScalar *aa,*aa_i; 204 PetscScalar *v_i; 205 206 PetscFunctionBegin; 207 bs = a->bs; 208 ai = a->i; 209 aj = a->j; 210 aa = a->a; 211 bs2 = a->bs2; 212 213 if (row < 0 || row >= A->m) SETERRQ1(PETSC_ERR_ARG_OUTOFRANGE, "Row %d out of range", row); 214 215 bn = row/bs; /* Block number */ 216 bp = row % bs; /* Block position */ 217 M = ai[bn+1] - ai[bn]; 218 *ncols = bs*M; 219 220 if (v) { 221 *v = 0; 222 if (*ncols) { 223 ierr = PetscMalloc((*ncols+row)*sizeof(PetscScalar),v);CHKERRQ(ierr); 224 for (i=0; i<M; i++) { /* for each block in the block row */ 225 v_i = *v + i*bs; 226 aa_i = aa + bs2*(ai[bn] + i); 227 for (j=bp,k=0; j<bs2; j+=bs,k++) {v_i[k] = aa_i[j];} 228 } 229 } 230 } 231 232 if (cols) { 233 *cols = 0; 234 if (*ncols) { 235 ierr = PetscMalloc((*ncols+row)*sizeof(int),cols);CHKERRQ(ierr); 236 for (i=0; i<M; i++) { /* for each block in the block row */ 237 cols_i = *cols + i*bs; 238 itmp = bs*aj[ai[bn] + i]; 239 for (j=0; j<bs; j++) {cols_i[j] = itmp++;} 240 } 241 } 242 } 243 244 /*search column A(0:row-1,row) (=A(row,0:row-1)). Could be expensive! */ 245 /* this segment is currently removed, so only entries in the upper triangle are obtained */ 246 #ifdef column_search 247 v_i = *v + M*bs; 248 cols_i = *cols + M*bs; 249 for (i=0; i<bn; i++){ /* for each block row */ 250 M = ai[i+1] - ai[i]; 251 for (j=0; j<M; j++){ 252 itmp = aj[ai[i] + j]; /* block column value */ 253 if (itmp == bn){ 254 aa_i = aa + bs2*(ai[i] + j) + bs*bp; 255 for (k=0; k<bs; k++) { 256 *cols_i++ = i*bs+k; 257 *v_i++ = aa_i[k]; 258 } 259 *ncols += bs; 260 break; 261 } 262 } 263 } 264 #endif 265 266 PetscFunctionReturn(0); 267 } 268 269 #undef __FUNCT__ 270 #define __FUNCT__ "MatRestoreRow_SeqSBAIJ" 271 int MatRestoreRow_SeqSBAIJ(Mat A,int row,int *nz,int **idx,PetscScalar **v) 272 { 273 int ierr; 274 275 PetscFunctionBegin; 276 if (idx) {if (*idx) {ierr = PetscFree(*idx);CHKERRQ(ierr);}} 277 if (v) {if (*v) {ierr = PetscFree(*v);CHKERRQ(ierr);}} 278 PetscFunctionReturn(0); 279 } 280 281 #undef __FUNCT__ 282 #define __FUNCT__ "MatTranspose_SeqSBAIJ" 283 int MatTranspose_SeqSBAIJ(Mat A,Mat *B) 284 { 285 int ierr; 286 PetscFunctionBegin; 287 ierr = MatDuplicate(A,MAT_COPY_VALUES,B);CHKERRQ(ierr); 288 PetscFunctionReturn(0); 289 } 290 291 #undef __FUNCT__ 292 #define __FUNCT__ "MatView_SeqSBAIJ_ASCII" 293 static int MatView_SeqSBAIJ_ASCII(Mat A,PetscViewer viewer) 294 { 295 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 296 int ierr,i,j,bs = a->bs,k,l,bs2=a->bs2; 297 char *name; 298 PetscViewerFormat format; 299 300 PetscFunctionBegin; 301 ierr = PetscObjectGetName((PetscObject)A,&name);CHKERRQ(ierr); 302 ierr = PetscViewerGetFormat(viewer,&format);CHKERRQ(ierr); 303 if (format == PETSC_VIEWER_ASCII_INFO || format == PETSC_VIEWER_ASCII_INFO_DETAIL) { 304 ierr = PetscViewerASCIIPrintf(viewer," block size is %d\n",bs);CHKERRQ(ierr); 305 } else if (format == PETSC_VIEWER_ASCII_MATLAB) { 306 SETERRQ(PETSC_ERR_SUP,"Matlab format not supported"); 307 } else if (format == PETSC_VIEWER_ASCII_COMMON) { 308 ierr = PetscViewerASCIIUseTabs(viewer,PETSC_NO);CHKERRQ(ierr); 309 for (i=0; i<a->mbs; i++) { 310 for (j=0; j<bs; j++) { 311 ierr = PetscViewerASCIIPrintf(viewer,"row %d:",i*bs+j);CHKERRQ(ierr); 312 for (k=a->i[i]; k<a->i[i+1]; k++) { 313 for (l=0; l<bs; l++) { 314 #if defined(PETSC_USE_COMPLEX) 315 if (PetscImaginaryPart(a->a[bs2*k + l*bs + j]) > 0.0 && PetscRealPart(a->a[bs2*k + l*bs + j]) != 0.0) { 316 ierr = PetscViewerASCIIPrintf(viewer," (%d, %g + %g i) ",bs*a->j[k]+l, 317 PetscRealPart(a->a[bs2*k + l*bs + j]),PetscImaginaryPart(a->a[bs2*k + l*bs + j]));CHKERRQ(ierr); 318 } else if (PetscImaginaryPart(a->a[bs2*k + l*bs + j]) < 0.0 && PetscRealPart(a->a[bs2*k + l*bs + j]) != 0.0) { 319 ierr = PetscViewerASCIIPrintf(viewer," (%d, %g - %g i) ",bs*a->j[k]+l, 320 PetscRealPart(a->a[bs2*k + l*bs + j]),-PetscImaginaryPart(a->a[bs2*k + l*bs + j]));CHKERRQ(ierr); 321 } else if (PetscRealPart(a->a[bs2*k + l*bs + j]) != 0.0) { 322 ierr = PetscViewerASCIIPrintf(viewer," (%d, %g) ",bs*a->j[k]+l,PetscRealPart(a->a[bs2*k + l*bs + j]));CHKERRQ(ierr); 323 } 324 #else 325 if (a->a[bs2*k + l*bs + j] != 0.0) { 326 ierr = PetscViewerASCIIPrintf(viewer," (%d, %g) ",bs*a->j[k]+l,a->a[bs2*k + l*bs + j]);CHKERRQ(ierr); 327 } 328 #endif 329 } 330 } 331 ierr = PetscViewerASCIIPrintf(viewer,"\n");CHKERRQ(ierr); 332 } 333 } 334 ierr = PetscViewerASCIIUseTabs(viewer,PETSC_YES);CHKERRQ(ierr); 335 } else { 336 ierr = PetscViewerASCIIUseTabs(viewer,PETSC_NO);CHKERRQ(ierr); 337 for (i=0; i<a->mbs; i++) { 338 for (j=0; j<bs; j++) { 339 ierr = PetscViewerASCIIPrintf(viewer,"row %d:",i*bs+j);CHKERRQ(ierr); 340 for (k=a->i[i]; k<a->i[i+1]; k++) { 341 for (l=0; l<bs; l++) { 342 #if defined(PETSC_USE_COMPLEX) 343 if (PetscImaginaryPart(a->a[bs2*k + l*bs + j]) > 0.0) { 344 ierr = PetscViewerASCIIPrintf(viewer," (%d, %g + %g i) ",bs*a->j[k]+l, 345 PetscRealPart(a->a[bs2*k + l*bs + j]),PetscImaginaryPart(a->a[bs2*k + l*bs + j]));CHKERRQ(ierr); 346 } else if (PetscImaginaryPart(a->a[bs2*k + l*bs + j]) < 0.0) { 347 ierr = PetscViewerASCIIPrintf(viewer," (%d, %g - %g i) ",bs*a->j[k]+l, 348 PetscRealPart(a->a[bs2*k + l*bs + j]),-PetscImaginaryPart(a->a[bs2*k + l*bs + j]));CHKERRQ(ierr); 349 } else { 350 ierr = PetscViewerASCIIPrintf(viewer," (%d, %g) ",bs*a->j[k]+l,PetscRealPart(a->a[bs2*k + l*bs + j]));CHKERRQ(ierr); 351 } 352 #else 353 ierr = PetscViewerASCIIPrintf(viewer," %d %g ",bs*a->j[k]+l,a->a[bs2*k + l*bs + j]);CHKERRQ(ierr); 354 #endif 355 } 356 } 357 ierr = PetscViewerASCIIPrintf(viewer,"\n");CHKERRQ(ierr); 358 } 359 } 360 ierr = PetscViewerASCIIUseTabs(viewer,PETSC_YES);CHKERRQ(ierr); 361 } 362 ierr = PetscViewerFlush(viewer);CHKERRQ(ierr); 363 PetscFunctionReturn(0); 364 } 365 366 #undef __FUNCT__ 367 #define __FUNCT__ "MatView_SeqSBAIJ_Draw_Zoom" 368 static int MatView_SeqSBAIJ_Draw_Zoom(PetscDraw draw,void *Aa) 369 { 370 Mat A = (Mat) Aa; 371 Mat_SeqSBAIJ *a=(Mat_SeqSBAIJ*)A->data; 372 int row,ierr,i,j,k,l,mbs=a->mbs,color,bs=a->bs,bs2=a->bs2,rank; 373 PetscReal xl,yl,xr,yr,x_l,x_r,y_l,y_r; 374 MatScalar *aa; 375 MPI_Comm comm; 376 PetscViewer viewer; 377 378 PetscFunctionBegin; 379 /* 380 This is nasty. If this is called from an originally parallel matrix 381 then all processes call this,but only the first has the matrix so the 382 rest should return immediately. 383 */ 384 ierr = PetscObjectGetComm((PetscObject)draw,&comm);CHKERRQ(ierr); 385 ierr = MPI_Comm_rank(comm,&rank);CHKERRQ(ierr); 386 if (rank) PetscFunctionReturn(0); 387 388 ierr = PetscObjectQuery((PetscObject)A,"Zoomviewer",(PetscObject*)&viewer);CHKERRQ(ierr); 389 390 ierr = PetscDrawGetCoordinates(draw,&xl,&yl,&xr,&yr);CHKERRQ(ierr); 391 PetscDrawString(draw, .3*(xl+xr), .3*(yl+yr), PETSC_DRAW_BLACK, "symmetric"); 392 393 /* loop over matrix elements drawing boxes */ 394 color = PETSC_DRAW_BLUE; 395 for (i=0,row=0; i<mbs; i++,row+=bs) { 396 for (j=a->i[i]; j<a->i[i+1]; j++) { 397 y_l = A->m - row - 1.0; y_r = y_l + 1.0; 398 x_l = a->j[j]*bs; x_r = x_l + 1.0; 399 aa = a->a + j*bs2; 400 for (k=0; k<bs; k++) { 401 for (l=0; l<bs; l++) { 402 if (PetscRealPart(*aa++) >= 0.) continue; 403 ierr = PetscDrawRectangle(draw,x_l+k,y_l-l,x_r+k,y_r-l,color,color,color,color);CHKERRQ(ierr); 404 } 405 } 406 } 407 } 408 color = PETSC_DRAW_CYAN; 409 for (i=0,row=0; i<mbs; i++,row+=bs) { 410 for (j=a->i[i]; j<a->i[i+1]; j++) { 411 y_l = A->m - row - 1.0; y_r = y_l + 1.0; 412 x_l = a->j[j]*bs; x_r = x_l + 1.0; 413 aa = a->a + j*bs2; 414 for (k=0; k<bs; k++) { 415 for (l=0; l<bs; l++) { 416 if (PetscRealPart(*aa++) != 0.) continue; 417 ierr = PetscDrawRectangle(draw,x_l+k,y_l-l,x_r+k,y_r-l,color,color,color,color);CHKERRQ(ierr); 418 } 419 } 420 } 421 } 422 423 color = PETSC_DRAW_RED; 424 for (i=0,row=0; i<mbs; i++,row+=bs) { 425 for (j=a->i[i]; j<a->i[i+1]; j++) { 426 y_l = A->m - row - 1.0; y_r = y_l + 1.0; 427 x_l = a->j[j]*bs; x_r = x_l + 1.0; 428 aa = a->a + j*bs2; 429 for (k=0; k<bs; k++) { 430 for (l=0; l<bs; l++) { 431 if (PetscRealPart(*aa++) <= 0.) continue; 432 ierr = PetscDrawRectangle(draw,x_l+k,y_l-l,x_r+k,y_r-l,color,color,color,color);CHKERRQ(ierr); 433 } 434 } 435 } 436 } 437 PetscFunctionReturn(0); 438 } 439 440 #undef __FUNCT__ 441 #define __FUNCT__ "MatView_SeqSBAIJ_Draw" 442 static int MatView_SeqSBAIJ_Draw(Mat A,PetscViewer viewer) 443 { 444 int ierr; 445 PetscReal xl,yl,xr,yr,w,h; 446 PetscDraw draw; 447 PetscTruth isnull; 448 449 PetscFunctionBegin; 450 451 ierr = PetscViewerDrawGetDraw(viewer,0,&draw);CHKERRQ(ierr); 452 ierr = PetscDrawIsNull(draw,&isnull);CHKERRQ(ierr); if (isnull) PetscFunctionReturn(0); 453 454 ierr = PetscObjectCompose((PetscObject)A,"Zoomviewer",(PetscObject)viewer);CHKERRQ(ierr); 455 xr = A->m; yr = A->m; h = yr/10.0; w = xr/10.0; 456 xr += w; yr += h; xl = -w; yl = -h; 457 ierr = PetscDrawSetCoordinates(draw,xl,yl,xr,yr);CHKERRQ(ierr); 458 ierr = PetscDrawZoom(draw,MatView_SeqSBAIJ_Draw_Zoom,A);CHKERRQ(ierr); 459 ierr = PetscObjectCompose((PetscObject)A,"Zoomviewer",PETSC_NULL);CHKERRQ(ierr); 460 PetscFunctionReturn(0); 461 } 462 463 #undef __FUNCT__ 464 #define __FUNCT__ "MatView_SeqSBAIJ" 465 int MatView_SeqSBAIJ(Mat A,PetscViewer viewer) 466 { 467 int ierr; 468 PetscTruth isascii,isdraw; 469 470 PetscFunctionBegin; 471 ierr = PetscTypeCompare((PetscObject)viewer,PETSC_VIEWER_ASCII,&isascii);CHKERRQ(ierr); 472 ierr = PetscTypeCompare((PetscObject)viewer,PETSC_VIEWER_DRAW,&isdraw);CHKERRQ(ierr); 473 if (isascii){ 474 ierr = MatView_SeqSBAIJ_ASCII(A,viewer);CHKERRQ(ierr); 475 } else if (isdraw) { 476 ierr = MatView_SeqSBAIJ_Draw(A,viewer);CHKERRQ(ierr); 477 } else { 478 Mat B; 479 ierr = MatConvert(A,MATSEQAIJ,&B);CHKERRQ(ierr); 480 ierr = MatView(B,viewer);CHKERRQ(ierr); 481 ierr = MatDestroy(B);CHKERRQ(ierr); 482 } 483 PetscFunctionReturn(0); 484 } 485 486 487 #undef __FUNCT__ 488 #define __FUNCT__ "MatGetValues_SeqSBAIJ" 489 int MatGetValues_SeqSBAIJ(Mat A,int m,const int im[],int n,const int in[],PetscScalar v[]) 490 { 491 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 492 int *rp,k,low,high,t,row,nrow,i,col,l,*aj = a->j; 493 int *ai = a->i,*ailen = a->ilen; 494 int brow,bcol,ridx,cidx,bs=a->bs,bs2=a->bs2; 495 MatScalar *ap,*aa = a->a,zero = 0.0; 496 497 PetscFunctionBegin; 498 for (k=0; k<m; k++) { /* loop over rows */ 499 row = im[k]; brow = row/bs; 500 if (row < 0) SETERRQ1(PETSC_ERR_ARG_OUTOFRANGE,"Negative row: %d",row); 501 if (row >= A->m) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Row too large: row %d max %d",row,A->m-1); 502 rp = aj + ai[brow] ; ap = aa + bs2*ai[brow] ; 503 nrow = ailen[brow]; 504 for (l=0; l<n; l++) { /* loop over columns */ 505 if (in[l] < 0) SETERRQ1(PETSC_ERR_ARG_OUTOFRANGE,"Negative column: %d",in[l]); 506 if (in[l] >= A->n) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Column too large: col %d max %d",in[l],A->n-1); 507 col = in[l] ; 508 bcol = col/bs; 509 cidx = col%bs; 510 ridx = row%bs; 511 high = nrow; 512 low = 0; /* assume unsorted */ 513 while (high-low > 5) { 514 t = (low+high)/2; 515 if (rp[t] > bcol) high = t; 516 else low = t; 517 } 518 for (i=low; i<high; i++) { 519 if (rp[i] > bcol) break; 520 if (rp[i] == bcol) { 521 *v++ = ap[bs2*i+bs*cidx+ridx]; 522 goto finished; 523 } 524 } 525 *v++ = zero; 526 finished:; 527 } 528 } 529 PetscFunctionReturn(0); 530 } 531 532 533 #undef __FUNCT__ 534 #define __FUNCT__ "MatSetValuesBlocked_SeqSBAIJ" 535 int MatSetValuesBlocked_SeqSBAIJ(Mat A,int m,const int im[],int n,const int in[],const PetscScalar v[],InsertMode is) 536 { 537 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 538 int *rp,k,low,high,t,ii,jj,row,nrow,i,col,l,rmax,N,sorted=a->sorted; 539 int *imax=a->imax,*ai=a->i,*ailen=a->ilen; 540 int *aj=a->j,nonew=a->nonew,bs2=a->bs2,bs=a->bs,stepval,ierr; 541 PetscTruth roworiented=a->roworiented; 542 const MatScalar *value = v; 543 MatScalar *ap,*aa = a->a,*bap; 544 545 PetscFunctionBegin; 546 if (roworiented) { 547 stepval = (n-1)*bs; 548 } else { 549 stepval = (m-1)*bs; 550 } 551 for (k=0; k<m; k++) { /* loop over added rows */ 552 row = im[k]; 553 if (row < 0) continue; 554 #if defined(PETSC_USE_BOPT_g) 555 if (row >= a->mbs) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Row too large: row %d max %d",row,a->mbs-1); 556 #endif 557 rp = aj + ai[row]; 558 ap = aa + bs2*ai[row]; 559 rmax = imax[row]; 560 nrow = ailen[row]; 561 low = 0; 562 for (l=0; l<n; l++) { /* loop over added columns */ 563 if (in[l] < 0) continue; 564 col = in[l]; 565 #if defined(PETSC_USE_BOPT_g) 566 if (col >= a->nbs) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Column too large: col %d max %d",col,a->nbs-1); 567 #endif 568 if (col < row) continue; /* ignore lower triangular block */ 569 if (roworiented) { 570 value = v + k*(stepval+bs)*bs + l*bs; 571 } else { 572 value = v + l*(stepval+bs)*bs + k*bs; 573 } 574 if (!sorted) low = 0; high = nrow; 575 while (high-low > 7) { 576 t = (low+high)/2; 577 if (rp[t] > col) high = t; 578 else low = t; 579 } 580 for (i=low; i<high; i++) { 581 if (rp[i] > col) break; 582 if (rp[i] == col) { 583 bap = ap + bs2*i; 584 if (roworiented) { 585 if (is == ADD_VALUES) { 586 for (ii=0; ii<bs; ii++,value+=stepval) { 587 for (jj=ii; jj<bs2; jj+=bs) { 588 bap[jj] += *value++; 589 } 590 } 591 } else { 592 for (ii=0; ii<bs; ii++,value+=stepval) { 593 for (jj=ii; jj<bs2; jj+=bs) { 594 bap[jj] = *value++; 595 } 596 } 597 } 598 } else { 599 if (is == ADD_VALUES) { 600 for (ii=0; ii<bs; ii++,value+=stepval) { 601 for (jj=0; jj<bs; jj++) { 602 *bap++ += *value++; 603 } 604 } 605 } else { 606 for (ii=0; ii<bs; ii++,value+=stepval) { 607 for (jj=0; jj<bs; jj++) { 608 *bap++ = *value++; 609 } 610 } 611 } 612 } 613 goto noinsert2; 614 } 615 } 616 if (nonew == 1) goto noinsert2; 617 else if (nonew == -1) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Inserting a new nonzero (%d, %d) in the matrix", row, col); 618 if (nrow >= rmax) { 619 /* there is no extra room in row, therefore enlarge */ 620 int new_nz = ai[a->mbs] + CHUNKSIZE,len,*new_i,*new_j; 621 MatScalar *new_a; 622 623 if (nonew == -2) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Inserting a new nonzero (%d, %d) in the matrix", row, col); 624 625 /* malloc new storage space */ 626 len = new_nz*(sizeof(int)+bs2*sizeof(MatScalar))+(a->mbs+1)*sizeof(int); 627 ierr = PetscMalloc(len,&new_a);CHKERRQ(ierr); 628 new_j = (int*)(new_a + bs2*new_nz); 629 new_i = new_j + new_nz; 630 631 /* copy over old data into new slots */ 632 for (ii=0; ii<row+1; ii++) {new_i[ii] = ai[ii];} 633 for (ii=row+1; ii<a->mbs+1; ii++) {new_i[ii] = ai[ii]+CHUNKSIZE;} 634 ierr = PetscMemcpy(new_j,aj,(ai[row]+nrow)*sizeof(int));CHKERRQ(ierr); 635 len = (new_nz - CHUNKSIZE - ai[row] - nrow); 636 ierr = PetscMemcpy(new_j+ai[row]+nrow+CHUNKSIZE,aj+ai[row]+nrow,len*sizeof(int));CHKERRQ(ierr); 637 ierr = PetscMemcpy(new_a,aa,(ai[row]+nrow)*bs2*sizeof(MatScalar));CHKERRQ(ierr); 638 ierr = PetscMemzero(new_a+bs2*(ai[row]+nrow),bs2*CHUNKSIZE*sizeof(MatScalar));CHKERRQ(ierr); 639 ierr = PetscMemcpy(new_a+bs2*(ai[row]+nrow+CHUNKSIZE),aa+bs2*(ai[row]+nrow),bs2*len*sizeof(MatScalar));CHKERRQ(ierr); 640 /* free up old matrix storage */ 641 ierr = PetscFree(a->a);CHKERRQ(ierr); 642 if (!a->singlemalloc) { 643 ierr = PetscFree(a->i);CHKERRQ(ierr); 644 ierr = PetscFree(a->j);CHKERRQ(ierr); 645 } 646 aa = a->a = new_a; ai = a->i = new_i; aj = a->j = new_j; 647 a->singlemalloc = PETSC_TRUE; 648 649 rp = aj + ai[row]; ap = aa + bs2*ai[row]; 650 rmax = imax[row] = imax[row] + CHUNKSIZE; 651 PetscLogObjectMemory(A,CHUNKSIZE*(sizeof(int) + bs2*sizeof(MatScalar))); 652 a->maxnz += bs2*CHUNKSIZE; 653 a->reallocs++; 654 a->nz++; 655 } 656 N = nrow++ - 1; 657 /* shift up all the later entries in this row */ 658 for (ii=N; ii>=i; ii--) { 659 rp[ii+1] = rp[ii]; 660 ierr = PetscMemcpy(ap+bs2*(ii+1),ap+bs2*(ii),bs2*sizeof(MatScalar));CHKERRQ(ierr); 661 } 662 if (N >= i) { 663 ierr = PetscMemzero(ap+bs2*i,bs2*sizeof(MatScalar));CHKERRQ(ierr); 664 } 665 rp[i] = col; 666 bap = ap + bs2*i; 667 if (roworiented) { 668 for (ii=0; ii<bs; ii++,value+=stepval) { 669 for (jj=ii; jj<bs2; jj+=bs) { 670 bap[jj] = *value++; 671 } 672 } 673 } else { 674 for (ii=0; ii<bs; ii++,value+=stepval) { 675 for (jj=0; jj<bs; jj++) { 676 *bap++ = *value++; 677 } 678 } 679 } 680 noinsert2:; 681 low = i; 682 } 683 ailen[row] = nrow; 684 } 685 PetscFunctionReturn(0); 686 } 687 688 #undef __FUNCT__ 689 #define __FUNCT__ "MatAssemblyEnd_SeqSBAIJ" 690 int MatAssemblyEnd_SeqSBAIJ(Mat A,MatAssemblyType mode) 691 { 692 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 693 int fshift = 0,i,j,*ai = a->i,*aj = a->j,*imax = a->imax; 694 int m = A->m,*ip,N,*ailen = a->ilen; 695 int mbs = a->mbs,bs2 = a->bs2,rmax = 0,ierr; 696 MatScalar *aa = a->a,*ap; 697 698 PetscFunctionBegin; 699 if (mode == MAT_FLUSH_ASSEMBLY) PetscFunctionReturn(0); 700 701 if (m) rmax = ailen[0]; 702 for (i=1; i<mbs; i++) { 703 /* move each row back by the amount of empty slots (fshift) before it*/ 704 fshift += imax[i-1] - ailen[i-1]; 705 rmax = PetscMax(rmax,ailen[i]); 706 if (fshift) { 707 ip = aj + ai[i]; ap = aa + bs2*ai[i]; 708 N = ailen[i]; 709 for (j=0; j<N; j++) { 710 ip[j-fshift] = ip[j]; 711 ierr = PetscMemcpy(ap+(j-fshift)*bs2,ap+j*bs2,bs2*sizeof(MatScalar));CHKERRQ(ierr); 712 } 713 } 714 ai[i] = ai[i-1] + ailen[i-1]; 715 } 716 if (mbs) { 717 fshift += imax[mbs-1] - ailen[mbs-1]; 718 ai[mbs] = ai[mbs-1] + ailen[mbs-1]; 719 } 720 /* reset ilen and imax for each row */ 721 for (i=0; i<mbs; i++) { 722 ailen[i] = imax[i] = ai[i+1] - ai[i]; 723 } 724 a->nz = ai[mbs]; 725 726 /* diagonals may have moved, reset it */ 727 if (a->diag) { 728 ierr = PetscMemcpy(a->diag,ai,(mbs+1)*sizeof(int));CHKERRQ(ierr); 729 } 730 PetscLogInfo(A,"MatAssemblyEnd_SeqSBAIJ:Matrix size: %d X %d, block size %d; storage space: %d unneeded, %d used\n", 731 m,A->m,a->bs,fshift*bs2,a->nz*bs2); 732 PetscLogInfo(A,"MatAssemblyEnd_SeqSBAIJ:Number of mallocs during MatSetValues is %d\n", 733 a->reallocs); 734 PetscLogInfo(A,"MatAssemblyEnd_SeqSBAIJ:Most nonzeros blocks in any row is %d\n",rmax); 735 a->reallocs = 0; 736 A->info.nz_unneeded = (PetscReal)fshift*bs2; 737 738 PetscFunctionReturn(0); 739 } 740 741 /* 742 This function returns an array of flags which indicate the locations of contiguous 743 blocks that should be zeroed. for eg: if bs = 3 and is = [0,1,2,3,5,6,7,8,9] 744 then the resulting sizes = [3,1,1,3,1] correspondig to sets [(0,1,2),(3),(5),(6,7,8),(9)] 745 Assume: sizes should be long enough to hold all the values. 746 */ 747 #undef __FUNCT__ 748 #define __FUNCT__ "MatZeroRows_SeqSBAIJ_Check_Blocks" 749 int MatZeroRows_SeqSBAIJ_Check_Blocks(int idx[],int n,int bs,int sizes[], int *bs_max) 750 { 751 int i,j,k,row; 752 PetscTruth flg; 753 754 PetscFunctionBegin; 755 for (i=0,j=0; i<n; j++) { 756 row = idx[i]; 757 if (row%bs!=0) { /* Not the begining of a block */ 758 sizes[j] = 1; 759 i++; 760 } else if (i+bs > n) { /* Beginning of a block, but complete block doesn't exist (at idx end) */ 761 sizes[j] = 1; /* Also makes sure atleast 'bs' values exist for next else */ 762 i++; 763 } else { /* Begining of the block, so check if the complete block exists */ 764 flg = PETSC_TRUE; 765 for (k=1; k<bs; k++) { 766 if (row+k != idx[i+k]) { /* break in the block */ 767 flg = PETSC_FALSE; 768 break; 769 } 770 } 771 if (flg == PETSC_TRUE) { /* No break in the bs */ 772 sizes[j] = bs; 773 i+= bs; 774 } else { 775 sizes[j] = 1; 776 i++; 777 } 778 } 779 } 780 *bs_max = j; 781 PetscFunctionReturn(0); 782 } 783 784 #undef __FUNCT__ 785 #define __FUNCT__ "MatZeroRows_SeqSBAIJ" 786 int MatZeroRows_SeqSBAIJ(Mat A,IS is,const PetscScalar *diag) 787 { 788 PetscFunctionBegin; 789 SETERRQ(PETSC_ERR_SUP,"No support for this function yet"); 790 } 791 792 /* Only add/insert a(i,j) with i<=j (blocks). 793 Any a(i,j) with i>j input by user is ingored. 794 */ 795 796 #undef __FUNCT__ 797 #define __FUNCT__ "MatSetValues_SeqSBAIJ" 798 int MatSetValues_SeqSBAIJ(Mat A,int m,const int im[],int n,const int in[],const PetscScalar v[],InsertMode is) 799 { 800 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 801 int *rp,k,low,high,t,ii,row,nrow,i,col,l,rmax,N,sorted=a->sorted; 802 int *imax=a->imax,*ai=a->i,*ailen=a->ilen,roworiented=a->roworiented; 803 int *aj=a->j,nonew=a->nonew,bs=a->bs,brow,bcol; 804 int ridx,cidx,bs2=a->bs2,ierr; 805 MatScalar *ap,value,*aa=a->a,*bap; 806 807 PetscFunctionBegin; 808 809 for (k=0; k<m; k++) { /* loop over added rows */ 810 row = im[k]; /* row number */ 811 brow = row/bs; /* block row number */ 812 if (row < 0) continue; 813 #if defined(PETSC_USE_BOPT_g) 814 if (row >= A->m) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Row too large: row %d max %d",row,A->m-1); 815 #endif 816 rp = aj + ai[brow]; /*ptr to beginning of column value of the row block*/ 817 ap = aa + bs2*ai[brow]; /*ptr to beginning of element value of the row block*/ 818 rmax = imax[brow]; /* maximum space allocated for this row */ 819 nrow = ailen[brow]; /* actual length of this row */ 820 low = 0; 821 822 for (l=0; l<n; l++) { /* loop over added columns */ 823 if (in[l] < 0) continue; 824 #if defined(PETSC_USE_BOPT_g) 825 if (in[l] >= A->m) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Column too large: col %d max %d",in[l],A->m-1); 826 #endif 827 col = in[l]; 828 bcol = col/bs; /* block col number */ 829 830 if (brow <= bcol){ 831 ridx = row % bs; cidx = col % bs; /*row and col index inside the block */ 832 if ((brow==bcol && ridx<=cidx) || (brow<bcol)){ 833 /* element value a(k,l) */ 834 if (roworiented) { 835 value = v[l + k*n]; 836 } else { 837 value = v[k + l*m]; 838 } 839 840 /* move pointer bap to a(k,l) quickly and add/insert value */ 841 if (!sorted) low = 0; high = nrow; 842 while (high-low > 7) { 843 t = (low+high)/2; 844 if (rp[t] > bcol) high = t; 845 else low = t; 846 } 847 for (i=low; i<high; i++) { 848 /* printf("The loop of i=low.., rp[%d]=%d\n",i,rp[i]); */ 849 if (rp[i] > bcol) break; 850 if (rp[i] == bcol) { 851 bap = ap + bs2*i + bs*cidx + ridx; 852 if (is == ADD_VALUES) *bap += value; 853 else *bap = value; 854 /* for diag block, add/insert its symmetric element a(cidx,ridx) */ 855 if (brow == bcol && ridx < cidx){ 856 bap = ap + bs2*i + bs*ridx + cidx; 857 if (is == ADD_VALUES) *bap += value; 858 else *bap = value; 859 } 860 goto noinsert1; 861 } 862 } 863 864 if (nonew == 1) goto noinsert1; 865 else if (nonew == -1) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Inserting a new nonzero (%d, %d) in the matrix", row, col); 866 if (nrow >= rmax) { 867 /* there is no extra room in row, therefore enlarge */ 868 int new_nz = ai[a->mbs] + CHUNKSIZE,len,*new_i,*new_j; 869 MatScalar *new_a; 870 871 if (nonew == -2) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"Inserting a new nonzero (%d, %d) in the matrix", row, col); 872 873 /* Malloc new storage space */ 874 len = new_nz*(sizeof(int)+bs2*sizeof(MatScalar))+(a->mbs+1)*sizeof(int); 875 ierr = PetscMalloc(len,&new_a);CHKERRQ(ierr); 876 new_j = (int*)(new_a + bs2*new_nz); 877 new_i = new_j + new_nz; 878 879 /* copy over old data into new slots */ 880 for (ii=0; ii<brow+1; ii++) {new_i[ii] = ai[ii];} 881 for (ii=brow+1; ii<a->mbs+1; ii++) {new_i[ii] = ai[ii]+CHUNKSIZE;} 882 ierr = PetscMemcpy(new_j,aj,(ai[brow]+nrow)*sizeof(int));CHKERRQ(ierr); 883 len = (new_nz - CHUNKSIZE - ai[brow] - nrow); 884 ierr = PetscMemcpy(new_j+ai[brow]+nrow+CHUNKSIZE,aj+ai[brow]+nrow,len*sizeof(int));CHKERRQ(ierr); 885 ierr = PetscMemcpy(new_a,aa,(ai[brow]+nrow)*bs2*sizeof(MatScalar));CHKERRQ(ierr); 886 ierr = PetscMemzero(new_a+bs2*(ai[brow]+nrow),bs2*CHUNKSIZE*sizeof(MatScalar));CHKERRQ(ierr); 887 ierr = PetscMemcpy(new_a+bs2*(ai[brow]+nrow+CHUNKSIZE),aa+bs2*(ai[brow]+nrow),bs2*len*sizeof(MatScalar));CHKERRQ(ierr); 888 /* free up old matrix storage */ 889 ierr = PetscFree(a->a);CHKERRQ(ierr); 890 if (!a->singlemalloc) { 891 ierr = PetscFree(a->i);CHKERRQ(ierr); 892 ierr = PetscFree(a->j);CHKERRQ(ierr); 893 } 894 aa = a->a = new_a; ai = a->i = new_i; aj = a->j = new_j; 895 a->singlemalloc = PETSC_TRUE; 896 897 rp = aj + ai[brow]; ap = aa + bs2*ai[brow]; 898 rmax = imax[brow] = imax[brow] + CHUNKSIZE; 899 PetscLogObjectMemory(A,CHUNKSIZE*(sizeof(int) + bs2*sizeof(MatScalar))); 900 a->maxnz += bs2*CHUNKSIZE; 901 a->reallocs++; 902 a->nz++; 903 } 904 905 N = nrow++ - 1; 906 /* shift up all the later entries in this row */ 907 for (ii=N; ii>=i; ii--) { 908 rp[ii+1] = rp[ii]; 909 ierr = PetscMemcpy(ap+bs2*(ii+1),ap+bs2*(ii),bs2*sizeof(MatScalar));CHKERRQ(ierr); 910 } 911 if (N>=i) { 912 ierr = PetscMemzero(ap+bs2*i,bs2*sizeof(MatScalar));CHKERRQ(ierr); 913 } 914 rp[i] = bcol; 915 ap[bs2*i + bs*cidx + ridx] = value; 916 noinsert1:; 917 low = i; 918 /* } */ 919 } 920 } /* end of if .. if.. */ 921 } /* end of loop over added columns */ 922 ailen[brow] = nrow; 923 } /* end of loop over added rows */ 924 925 PetscFunctionReturn(0); 926 } 927 928 extern int MatCholeskyFactorSymbolic_SeqSBAIJ(Mat,IS,MatFactorInfo*,Mat*); 929 extern int MatCholeskyFactor_SeqSBAIJ(Mat,IS,MatFactorInfo*); 930 extern int MatIncreaseOverlap_SeqSBAIJ(Mat,int,IS[],int); 931 extern int MatGetSubMatrix_SeqSBAIJ(Mat,IS,IS,int,MatReuse,Mat*); 932 extern int MatGetSubMatrices_SeqSBAIJ(Mat,int,const IS[],const IS[],MatReuse,Mat*[]); 933 extern int MatMultTranspose_SeqSBAIJ(Mat,Vec,Vec); 934 extern int MatMultTransposeAdd_SeqSBAIJ(Mat,Vec,Vec,Vec); 935 extern int MatScale_SeqSBAIJ(const PetscScalar*,Mat); 936 extern int MatNorm_SeqSBAIJ(Mat,NormType,PetscReal *); 937 extern int MatEqual_SeqSBAIJ(Mat,Mat,PetscTruth*); 938 extern int MatGetDiagonal_SeqSBAIJ(Mat,Vec); 939 extern int MatDiagonalScale_SeqSBAIJ(Mat,Vec,Vec); 940 extern int MatGetInfo_SeqSBAIJ(Mat,MatInfoType,MatInfo *); 941 extern int MatZeroEntries_SeqSBAIJ(Mat); 942 extern int MatGetRowMax_SeqSBAIJ(Mat,Vec); 943 944 extern int MatSolve_SeqSBAIJ_N(Mat,Vec,Vec); 945 extern int MatSolve_SeqSBAIJ_1(Mat,Vec,Vec); 946 extern int MatSolve_SeqSBAIJ_2(Mat,Vec,Vec); 947 extern int MatSolve_SeqSBAIJ_3(Mat,Vec,Vec); 948 extern int MatSolve_SeqSBAIJ_4(Mat,Vec,Vec); 949 extern int MatSolve_SeqSBAIJ_5(Mat,Vec,Vec); 950 extern int MatSolve_SeqSBAIJ_6(Mat,Vec,Vec); 951 extern int MatSolve_SeqSBAIJ_7(Mat,Vec,Vec); 952 extern int MatSolveTranspose_SeqSBAIJ_7(Mat,Vec,Vec); 953 extern int MatSolveTranspose_SeqSBAIJ_6(Mat,Vec,Vec); 954 extern int MatSolveTranspose_SeqSBAIJ_5(Mat,Vec,Vec); 955 extern int MatSolveTranspose_SeqSBAIJ_4(Mat,Vec,Vec); 956 extern int MatSolveTranspose_SeqSBAIJ_3(Mat,Vec,Vec); 957 extern int MatSolveTranspose_SeqSBAIJ_2(Mat,Vec,Vec); 958 extern int MatSolveTranspose_SeqSBAIJ_1(Mat,Vec,Vec); 959 960 extern int MatSolves_SeqSBAIJ_1(Mat,Vecs,Vecs); 961 962 extern int MatSolve_SeqSBAIJ_1_NaturalOrdering(Mat,Vec,Vec); 963 extern int MatSolve_SeqSBAIJ_2_NaturalOrdering(Mat,Vec,Vec); 964 extern int MatSolve_SeqSBAIJ_3_NaturalOrdering(Mat,Vec,Vec); 965 extern int MatSolve_SeqSBAIJ_4_NaturalOrdering(Mat,Vec,Vec); 966 extern int MatSolve_SeqSBAIJ_5_NaturalOrdering(Mat,Vec,Vec); 967 extern int MatSolve_SeqSBAIJ_6_NaturalOrdering(Mat,Vec,Vec); 968 extern int MatSolve_SeqSBAIJ_7_NaturalOrdering(Mat,Vec,Vec); 969 extern int MatSolve_SeqSBAIJ_N_NaturalOrdering(Mat,Vec,Vec); 970 971 extern int MatCholeskyFactorNumeric_SeqSBAIJ_N(Mat,Mat*); 972 extern int MatCholeskyFactorNumeric_SeqSBAIJ_1(Mat,Mat*); 973 extern int MatCholeskyFactorNumeric_SeqSBAIJ_2(Mat,Mat*); 974 extern int MatCholeskyFactorNumeric_SeqSBAIJ_3(Mat,Mat*); 975 extern int MatCholeskyFactorNumeric_SeqSBAIJ_4(Mat,Mat*); 976 extern int MatCholeskyFactorNumeric_SeqSBAIJ_5(Mat,Mat*); 977 extern int MatCholeskyFactorNumeric_SeqSBAIJ_6(Mat,Mat*); 978 extern int MatCholeskyFactorNumeric_SeqSBAIJ_7(Mat,Mat*); 979 extern int MatGetInertia_SeqSBAIJ(Mat,int*,int*,int*); 980 981 extern int MatMult_SeqSBAIJ_1(Mat,Vec,Vec); 982 extern int MatMult_SeqSBAIJ_2(Mat,Vec,Vec); 983 extern int MatMult_SeqSBAIJ_3(Mat,Vec,Vec); 984 extern int MatMult_SeqSBAIJ_4(Mat,Vec,Vec); 985 extern int MatMult_SeqSBAIJ_5(Mat,Vec,Vec); 986 extern int MatMult_SeqSBAIJ_6(Mat,Vec,Vec); 987 extern int MatMult_SeqSBAIJ_7(Mat,Vec,Vec); 988 extern int MatMult_SeqSBAIJ_N(Mat,Vec,Vec); 989 990 extern int MatMultAdd_SeqSBAIJ_1(Mat,Vec,Vec,Vec); 991 extern int MatMultAdd_SeqSBAIJ_2(Mat,Vec,Vec,Vec); 992 extern int MatMultAdd_SeqSBAIJ_3(Mat,Vec,Vec,Vec); 993 extern int MatMultAdd_SeqSBAIJ_4(Mat,Vec,Vec,Vec); 994 extern int MatMultAdd_SeqSBAIJ_5(Mat,Vec,Vec,Vec); 995 extern int MatMultAdd_SeqSBAIJ_6(Mat,Vec,Vec,Vec); 996 extern int MatMultAdd_SeqSBAIJ_7(Mat,Vec,Vec,Vec); 997 extern int MatMultAdd_SeqSBAIJ_N(Mat,Vec,Vec,Vec); 998 999 #ifdef HAVE_MatICCFactor 1000 /* modefied from MatILUFactor_SeqSBAIJ, needs further work! */ 1001 #undef __FUNCT__ 1002 #define __FUNCT__ "MatICCFactor_SeqSBAIJ" 1003 int MatICCFactor_SeqSBAIJ(Mat inA,IS row,MatFactorInfo *info) 1004 { 1005 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)inA->data; 1006 Mat outA; 1007 int ierr; 1008 PetscTruth row_identity,col_identity; 1009 1010 PetscFunctionBegin; 1011 /* 1012 if (level != 0) SETERRQ(PETSC_ERR_SUP,"Only levels = 0 supported for in-place ILU"); 1013 ierr = ISIdentity(row,&row_identity);CHKERRQ(ierr); 1014 ierr = ISIdentity(col,&col_identity);CHKERRQ(ierr); 1015 if (!row_identity || !col_identity) { 1016 SETERRQ(1,"Row and column permutations must be identity for in-place ICC"); 1017 } 1018 */ 1019 1020 outA = inA; 1021 inA->factor = FACTOR_CHOLESKY; 1022 1023 if (!a->diag) { 1024 ierr = MatMarkDiagonal_SeqSBAIJ(inA);CHKERRQ(ierr); 1025 } 1026 /* 1027 Blocksize 2, 3, 4, 5, 6 and 7 have a special faster factorization/solver 1028 for ILU(0) factorization with natural ordering 1029 */ 1030 switch (a->bs) { 1031 case 1: 1032 inA->ops->solve = MatSolve_SeqSBAIJ_1_NaturalOrdering; 1033 inA->ops->solvetranspose = MatSolve_SeqSBAIJ_1_NaturalOrdering; 1034 inA->ops->solves = MatSolves_SeqSBAIJ_1; 1035 PetscLoginfo(inA,"MatICCFactor_SeqSBAIJ:Using special in-place natural ordering solvetrans BS=1\n"); 1036 case 2: 1037 inA->ops->lufactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_2_NaturalOrdering; 1038 inA->ops->solve = MatSolve_SeqSBAIJ_2_NaturalOrdering; 1039 inA->ops->solvetranspose = MatSolve_SeqSBAIJ_2_NaturalOrdering; 1040 PetscLogInfo(inA,"MatICCFactor_SeqSBAIJ:Using special in-place natural ordering factor and solve BS=2\n"); 1041 break; 1042 case 3: 1043 inA->ops->lufactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_3_NaturalOrdering; 1044 inA->ops->solve = MatSolve_SeqSBAIJ_3_NaturalOrdering; 1045 inA->ops->solvetranspose = MatSolve_SeqSBAIJ_3_NaturalOrdering; 1046 PetscLogInfo(inA,"MatICCFactor_SeqSBAIJ:Using special in-place natural ordering factor and solve BS=3\n"); 1047 break; 1048 case 4: 1049 inA->ops->lufactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_4_NaturalOrdering; 1050 inA->ops->solve = MatSolve_SeqSBAIJ_4_NaturalOrdering; 1051 inA->ops->solvetranspose = MatSolve_SeqSBAIJ_4_NaturalOrdering; 1052 PetscLogInfo(inA,"MatICCFactor_SeqSBAIJ:Using special in-place natural ordering factor and solve BS=4\n"); 1053 break; 1054 case 5: 1055 inA->ops->lufactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_5_NaturalOrdering; 1056 inA->ops->solve = MatSolve_SeqSBAIJ_5_NaturalOrdering; 1057 inA->ops->solvetranspose = MatSolve_SeqSBAIJ_5_NaturalOrdering; 1058 PetscLogInfo(inA,"MatICCFactor_SeqSBAIJ:Using special in-place natural ordering factor and solve BS=5\n"); 1059 break; 1060 case 6: 1061 inA->ops->lufactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_6_NaturalOrdering; 1062 inA->ops->solve = MatSolve_SeqSBAIJ_6_NaturalOrdering; 1063 inA->ops->solvetranspose = MatSolve_SeqSBAIJ_6_NaturalOrdering; 1064 PetscLogInfo(inA,"MatICCFactor_SeqSBAIJ:Using special in-place natural ordering factor and solve BS=6\n"); 1065 break; 1066 case 7: 1067 inA->ops->lufactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_7_NaturalOrdering; 1068 inA->ops->solvetranspose = MatSolve_SeqSBAIJ_7_NaturalOrdering; 1069 inA->ops->solve = MatSolve_SeqSBAIJ_7_NaturalOrdering; 1070 PetscLogInfo(inA,"MatICCFactor_SeqSBAIJ:Using special in-place natural ordering factor and solve BS=7\n"); 1071 break; 1072 default: 1073 a->row = row; 1074 a->icol = col; 1075 ierr = PetscObjectReference((PetscObject)row);CHKERRQ(ierr); 1076 ierr = PetscObjectReference((PetscObject)col);CHKERRQ(ierr); 1077 1078 /* Create the invert permutation so that it can be used in MatLUFactorNumeric() */ 1079 ierr = ISInvertPermutation(col,PETSC_DECIDE, &(a->icol));CHKERRQ(ierr); 1080 PetscLogObjectParent(inA,a->icol); 1081 1082 if (!a->solve_work) { 1083 ierr = PetscMalloc((A->m+a->bs)*sizeof(PetscScalar),&a->solve_work);CHKERRQ(ierr); 1084 PetscLogObjectMemory(inA,(A->m+a->bs)*sizeof(PetscScalar)); 1085 } 1086 } 1087 1088 ierr = MatCholeskyFactorNumeric(inA,&outA);CHKERRQ(ierr); 1089 1090 PetscFunctionReturn(0); 1091 } 1092 #endif 1093 1094 #undef __FUNCT__ 1095 #define __FUNCT__ "MatPrintHelp_SeqSBAIJ" 1096 int MatPrintHelp_SeqSBAIJ(Mat A) 1097 { 1098 static PetscTruth called = PETSC_FALSE; 1099 MPI_Comm comm = A->comm; 1100 int ierr; 1101 1102 PetscFunctionBegin; 1103 if (called) {PetscFunctionReturn(0);} else called = PETSC_TRUE; 1104 ierr = (*PetscHelpPrintf)(comm," Options for MATSEQSBAIJ and MATMPISBAIJ matrix formats (the defaults):\n");CHKERRQ(ierr); 1105 ierr = (*PetscHelpPrintf)(comm," -mat_block_size <block_size>\n");CHKERRQ(ierr); 1106 PetscFunctionReturn(0); 1107 } 1108 1109 EXTERN_C_BEGIN 1110 #undef __FUNCT__ 1111 #define __FUNCT__ "MatSeqSBAIJSetColumnIndices_SeqSBAIJ" 1112 int MatSeqSBAIJSetColumnIndices_SeqSBAIJ(Mat mat,int *indices) 1113 { 1114 Mat_SeqSBAIJ *baij = (Mat_SeqSBAIJ *)mat->data; 1115 int i,nz,n; 1116 1117 PetscFunctionBegin; 1118 nz = baij->maxnz; 1119 n = mat->n; 1120 for (i=0; i<nz; i++) { 1121 baij->j[i] = indices[i]; 1122 } 1123 baij->nz = nz; 1124 for (i=0; i<n; i++) { 1125 baij->ilen[i] = baij->imax[i]; 1126 } 1127 1128 PetscFunctionReturn(0); 1129 } 1130 EXTERN_C_END 1131 1132 #undef __FUNCT__ 1133 #define __FUNCT__ "MatSeqSBAIJSetColumnIndices" 1134 /*@ 1135 MatSeqSBAIJSetColumnIndices - Set the column indices for all the rows 1136 in the matrix. 1137 1138 Input Parameters: 1139 + mat - the SeqSBAIJ matrix 1140 - indices - the column indices 1141 1142 Level: advanced 1143 1144 Notes: 1145 This can be called if you have precomputed the nonzero structure of the 1146 matrix and want to provide it to the matrix object to improve the performance 1147 of the MatSetValues() operation. 1148 1149 You MUST have set the correct numbers of nonzeros per row in the call to 1150 MatCreateSeqSBAIJ(). 1151 1152 MUST be called before any calls to MatSetValues() 1153 1154 .seealso: MatCreateSeqSBAIJ 1155 @*/ 1156 int MatSeqSBAIJSetColumnIndices(Mat mat,int *indices) 1157 { 1158 int ierr,(*f)(Mat,int *); 1159 1160 PetscFunctionBegin; 1161 PetscValidHeaderSpecific(mat,MAT_COOKIE,1); 1162 PetscValidPointer(indices,2); 1163 ierr = PetscObjectQueryFunction((PetscObject)mat,"MatSeqSBAIJSetColumnIndices_C",(void (**)(void))&f);CHKERRQ(ierr); 1164 if (f) { 1165 ierr = (*f)(mat,indices);CHKERRQ(ierr); 1166 } else { 1167 SETERRQ(1,"Wrong type of matrix to set column indices"); 1168 } 1169 PetscFunctionReturn(0); 1170 } 1171 1172 #undef __FUNCT__ 1173 #define __FUNCT__ "MatSetUpPreallocation_SeqSBAIJ" 1174 int MatSetUpPreallocation_SeqSBAIJ(Mat A) 1175 { 1176 int ierr; 1177 1178 PetscFunctionBegin; 1179 ierr = MatSeqSBAIJSetPreallocation(A,1,PETSC_DEFAULT,0);CHKERRQ(ierr); 1180 PetscFunctionReturn(0); 1181 } 1182 1183 #undef __FUNCT__ 1184 #define __FUNCT__ "MatGetArray_SeqSBAIJ" 1185 int MatGetArray_SeqSBAIJ(Mat A,PetscScalar *array[]) 1186 { 1187 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 1188 PetscFunctionBegin; 1189 *array = a->a; 1190 PetscFunctionReturn(0); 1191 } 1192 1193 #undef __FUNCT__ 1194 #define __FUNCT__ "MatRestoreArray_SeqSBAIJ" 1195 int MatRestoreArray_SeqSBAIJ(Mat A,PetscScalar *array[]) 1196 { 1197 PetscFunctionBegin; 1198 PetscFunctionReturn(0); 1199 } 1200 1201 #include "petscblaslapack.h" 1202 #undef __FUNCT__ 1203 #define __FUNCT__ "MatAXPY_SeqSBAIJ" 1204 int MatAXPY_SeqSBAIJ(const PetscScalar *a,Mat X,Mat Y,MatStructure str) 1205 { 1206 Mat_SeqSBAIJ *x=(Mat_SeqSBAIJ *)X->data, *y=(Mat_SeqSBAIJ *)Y->data; 1207 int ierr,one=1,i,bs=y->bs,bs2,j; 1208 1209 PetscFunctionBegin; 1210 if (str == SAME_NONZERO_PATTERN) { 1211 BLaxpy_(&x->nz,(PetscScalar*)a,x->a,&one,y->a,&one); 1212 } else if (str == SUBSET_NONZERO_PATTERN) { /* nonzeros of X is a subset of Y's */ 1213 if (y->xtoy && y->XtoY != X) { 1214 ierr = PetscFree(y->xtoy);CHKERRQ(ierr); 1215 ierr = MatDestroy(y->XtoY);CHKERRQ(ierr); 1216 } 1217 if (!y->xtoy) { /* get xtoy */ 1218 ierr = MatAXPYGetxtoy_Private(x->mbs,x->i,x->j,PETSC_NULL, y->i,y->j,PETSC_NULL, &y->xtoy);CHKERRQ(ierr); 1219 y->XtoY = X; 1220 } 1221 bs2 = bs*bs; 1222 for (i=0; i<x->nz; i++) { 1223 j = 0; 1224 while (j < bs2){ 1225 y->a[bs2*y->xtoy[i]+j] += (*a)*(x->a[bs2*i+j]); 1226 j++; 1227 } 1228 } 1229 PetscLogInfo(0,"MatAXPY_SeqSBAIJ: ratio of nnz_s(X)/nnz_s(Y): %d/%d = %g\n",bs2*x->nz,bs2*y->nz,(PetscReal)(bs2*x->nz)/(bs2*y->nz)); 1230 } else { 1231 ierr = MatAXPY_Basic(a,X,Y,str);CHKERRQ(ierr); 1232 } 1233 PetscFunctionReturn(0); 1234 } 1235 1236 #undef __FUNCT__ 1237 #define __FUNCT__ "MatIsSymmetric_SeqSBAIJ" 1238 int MatIsSymmetric_SeqSBAIJ(Mat A,PetscTruth *flg) 1239 { 1240 PetscFunctionBegin; 1241 *flg = PETSC_TRUE; 1242 PetscFunctionReturn(0); 1243 } 1244 1245 #undef __FUNCT__ 1246 #define __FUNCT__ "MatIsStructurallySymmetric_SeqSBAIJ" 1247 int MatIsStructurallySymmetric_SeqSBAIJ(Mat A,PetscTruth *flg) 1248 { 1249 PetscFunctionBegin; 1250 *flg = PETSC_TRUE; 1251 PetscFunctionReturn(0); 1252 } 1253 1254 #undef __FUNCT__ 1255 #define __FUNCT__ "MatIsHermitian_SeqSBAIJ" 1256 int MatIsHermitian_SeqSBAIJ(Mat A,PetscTruth *flg) 1257 { 1258 PetscFunctionBegin; 1259 *flg = PETSC_FALSE; 1260 PetscFunctionReturn(0); 1261 } 1262 1263 /* -------------------------------------------------------------------*/ 1264 static struct _MatOps MatOps_Values = {MatSetValues_SeqSBAIJ, 1265 MatGetRow_SeqSBAIJ, 1266 MatRestoreRow_SeqSBAIJ, 1267 MatMult_SeqSBAIJ_N, 1268 /* 4*/ MatMultAdd_SeqSBAIJ_N, 1269 MatMultTranspose_SeqSBAIJ, 1270 MatMultTransposeAdd_SeqSBAIJ, 1271 MatSolve_SeqSBAIJ_N, 1272 0, 1273 0, 1274 /*10*/ 0, 1275 0, 1276 MatCholeskyFactor_SeqSBAIJ, 1277 MatRelax_SeqSBAIJ, 1278 MatTranspose_SeqSBAIJ, 1279 /*15*/ MatGetInfo_SeqSBAIJ, 1280 MatEqual_SeqSBAIJ, 1281 MatGetDiagonal_SeqSBAIJ, 1282 MatDiagonalScale_SeqSBAIJ, 1283 MatNorm_SeqSBAIJ, 1284 /*20*/ 0, 1285 MatAssemblyEnd_SeqSBAIJ, 1286 0, 1287 MatSetOption_SeqSBAIJ, 1288 MatZeroEntries_SeqSBAIJ, 1289 /*25*/ MatZeroRows_SeqSBAIJ, 1290 0, 1291 0, 1292 MatCholeskyFactorSymbolic_SeqSBAIJ, 1293 MatCholeskyFactorNumeric_SeqSBAIJ_N, 1294 /*30*/ MatSetUpPreallocation_SeqSBAIJ, 1295 0, 1296 MatICCFactorSymbolic_SeqSBAIJ, 1297 MatGetArray_SeqSBAIJ, 1298 MatRestoreArray_SeqSBAIJ, 1299 /*35*/ MatDuplicate_SeqSBAIJ, 1300 0, 1301 0, 1302 0, 1303 0, 1304 /*40*/ MatAXPY_SeqSBAIJ, 1305 MatGetSubMatrices_SeqSBAIJ, 1306 MatIncreaseOverlap_SeqSBAIJ, 1307 MatGetValues_SeqSBAIJ, 1308 0, 1309 /*45*/ MatPrintHelp_SeqSBAIJ, 1310 MatScale_SeqSBAIJ, 1311 0, 1312 0, 1313 0, 1314 /*50*/ MatGetBlockSize_SeqSBAIJ, 1315 MatGetRowIJ_SeqSBAIJ, 1316 MatRestoreRowIJ_SeqSBAIJ, 1317 0, 1318 0, 1319 /*55*/ 0, 1320 0, 1321 0, 1322 0, 1323 MatSetValuesBlocked_SeqSBAIJ, 1324 /*60*/ MatGetSubMatrix_SeqSBAIJ, 1325 0, 1326 0, 1327 MatGetPetscMaps_Petsc, 1328 0, 1329 /*65*/ 0, 1330 0, 1331 0, 1332 0, 1333 0, 1334 /*70*/ MatGetRowMax_SeqSBAIJ, 1335 0, 1336 0, 1337 0, 1338 0, 1339 /*75*/ 0, 1340 0, 1341 0, 1342 0, 1343 0, 1344 /*80*/ 0, 1345 0, 1346 0, 1347 #if !defined(PETSC_USE_COMPLEX) 1348 MatGetInertia_SeqSBAIJ, 1349 #else 1350 0, 1351 #endif 1352 /*85*/ MatLoad_SeqSBAIJ, 1353 MatIsSymmetric_SeqSBAIJ, 1354 MatIsStructurallySymmetric_SeqSBAIJ, 1355 MatIsHermitian_SeqSBAIJ 1356 }; 1357 1358 EXTERN_C_BEGIN 1359 #undef __FUNCT__ 1360 #define __FUNCT__ "MatStoreValues_SeqSBAIJ" 1361 int MatStoreValues_SeqSBAIJ(Mat mat) 1362 { 1363 Mat_SeqSBAIJ *aij = (Mat_SeqSBAIJ *)mat->data; 1364 int nz = aij->i[mat->m]*aij->bs*aij->bs2; 1365 int ierr; 1366 1367 PetscFunctionBegin; 1368 if (aij->nonew != 1) { 1369 SETERRQ(1,"Must call MatSetOption(A,MAT_NO_NEW_NONZERO_LOCATIONS);first"); 1370 } 1371 1372 /* allocate space for values if not already there */ 1373 if (!aij->saved_values) { 1374 ierr = PetscMalloc((nz+1)*sizeof(PetscScalar),&aij->saved_values);CHKERRQ(ierr); 1375 } 1376 1377 /* copy values over */ 1378 ierr = PetscMemcpy(aij->saved_values,aij->a,nz*sizeof(PetscScalar));CHKERRQ(ierr); 1379 PetscFunctionReturn(0); 1380 } 1381 EXTERN_C_END 1382 1383 EXTERN_C_BEGIN 1384 #undef __FUNCT__ 1385 #define __FUNCT__ "MatRetrieveValues_SeqSBAIJ" 1386 int MatRetrieveValues_SeqSBAIJ(Mat mat) 1387 { 1388 Mat_SeqSBAIJ *aij = (Mat_SeqSBAIJ *)mat->data; 1389 int nz = aij->i[mat->m]*aij->bs*aij->bs2,ierr; 1390 1391 PetscFunctionBegin; 1392 if (aij->nonew != 1) { 1393 SETERRQ(1,"Must call MatSetOption(A,MAT_NO_NEW_NONZERO_LOCATIONS);first"); 1394 } 1395 if (!aij->saved_values) { 1396 SETERRQ(1,"Must call MatStoreValues(A);first"); 1397 } 1398 1399 /* copy values over */ 1400 ierr = PetscMemcpy(aij->a,aij->saved_values,nz*sizeof(PetscScalar));CHKERRQ(ierr); 1401 PetscFunctionReturn(0); 1402 } 1403 EXTERN_C_END 1404 1405 EXTERN_C_BEGIN 1406 #undef __FUNCT__ 1407 #define __FUNCT__ "MatSeqSBAIJSetPreallocation_SeqSBAIJ" 1408 int MatSeqSBAIJSetPreallocation_SeqSBAIJ(Mat B,int bs,int nz,int *nnz) 1409 { 1410 Mat_SeqSBAIJ *b = (Mat_SeqSBAIJ*)B->data; 1411 int i,len,ierr,mbs,bs2; 1412 PetscTruth flg; 1413 1414 PetscFunctionBegin; 1415 B->preallocated = PETSC_TRUE; 1416 ierr = PetscOptionsGetInt(B->prefix,"-mat_block_size",&bs,PETSC_NULL);CHKERRQ(ierr); 1417 mbs = B->m/bs; 1418 bs2 = bs*bs; 1419 1420 if (mbs*bs != B->m) { 1421 SETERRQ(PETSC_ERR_ARG_SIZ,"Number rows, cols must be divisible by blocksize"); 1422 } 1423 1424 if (nz == PETSC_DEFAULT || nz == PETSC_DECIDE) nz = 3; 1425 if (nz < 0) SETERRQ1(PETSC_ERR_ARG_OUTOFRANGE,"nz cannot be less than 0: value %d",nz); 1426 if (nnz) { 1427 for (i=0; i<mbs; i++) { 1428 if (nnz[i] < 0) SETERRQ2(PETSC_ERR_ARG_OUTOFRANGE,"nnz cannot be less than 0: local row %d value %d",i,nnz[i]); 1429 if (nnz[i] > mbs) SETERRQ3(PETSC_ERR_ARG_OUTOFRANGE,"nnz cannot be greater than block row length: local row %d value %d rowlength %d",i,nnz[i],mbs); 1430 } 1431 } 1432 1433 ierr = PetscOptionsHasName(B->prefix,"-mat_no_unroll",&flg);CHKERRQ(ierr); 1434 if (!flg) { 1435 switch (bs) { 1436 case 1: 1437 B->ops->choleskyfactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_1; 1438 B->ops->solve = MatSolve_SeqSBAIJ_1; 1439 B->ops->solves = MatSolves_SeqSBAIJ_1; 1440 B->ops->solvetranspose = MatSolveTranspose_SeqSBAIJ_1; 1441 B->ops->mult = MatMult_SeqSBAIJ_1; 1442 B->ops->multadd = MatMultAdd_SeqSBAIJ_1; 1443 break; 1444 case 2: 1445 B->ops->choleskyfactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_2; 1446 B->ops->solve = MatSolve_SeqSBAIJ_2; 1447 B->ops->solvetranspose = MatSolveTranspose_SeqSBAIJ_2; 1448 B->ops->mult = MatMult_SeqSBAIJ_2; 1449 B->ops->multadd = MatMultAdd_SeqSBAIJ_2; 1450 break; 1451 case 3: 1452 B->ops->choleskyfactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_3; 1453 B->ops->solve = MatSolve_SeqSBAIJ_3; 1454 B->ops->solvetranspose = MatSolveTranspose_SeqSBAIJ_3; 1455 B->ops->mult = MatMult_SeqSBAIJ_3; 1456 B->ops->multadd = MatMultAdd_SeqSBAIJ_3; 1457 break; 1458 case 4: 1459 B->ops->choleskyfactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_4; 1460 B->ops->solve = MatSolve_SeqSBAIJ_4; 1461 B->ops->solvetranspose = MatSolveTranspose_SeqSBAIJ_4; 1462 B->ops->mult = MatMult_SeqSBAIJ_4; 1463 B->ops->multadd = MatMultAdd_SeqSBAIJ_4; 1464 break; 1465 case 5: 1466 B->ops->choleskyfactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_5; 1467 B->ops->solve = MatSolve_SeqSBAIJ_5; 1468 B->ops->solvetranspose = MatSolveTranspose_SeqSBAIJ_5; 1469 B->ops->mult = MatMult_SeqSBAIJ_5; 1470 B->ops->multadd = MatMultAdd_SeqSBAIJ_5; 1471 break; 1472 case 6: 1473 B->ops->choleskyfactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_6; 1474 B->ops->solve = MatSolve_SeqSBAIJ_6; 1475 B->ops->solvetranspose = MatSolveTranspose_SeqSBAIJ_6; 1476 B->ops->mult = MatMult_SeqSBAIJ_6; 1477 B->ops->multadd = MatMultAdd_SeqSBAIJ_6; 1478 break; 1479 case 7: 1480 B->ops->choleskyfactornumeric = MatCholeskyFactorNumeric_SeqSBAIJ_7; 1481 B->ops->solve = MatSolve_SeqSBAIJ_7; 1482 B->ops->solvetranspose = MatSolveTranspose_SeqSBAIJ_7; 1483 B->ops->mult = MatMult_SeqSBAIJ_7; 1484 B->ops->multadd = MatMultAdd_SeqSBAIJ_7; 1485 break; 1486 } 1487 } 1488 1489 b->mbs = mbs; 1490 b->nbs = mbs; 1491 ierr = PetscMalloc((mbs+1)*sizeof(int),&b->imax);CHKERRQ(ierr); 1492 if (!nnz) { 1493 if (nz == PETSC_DEFAULT || nz == PETSC_DECIDE) nz = 5; 1494 else if (nz <= 0) nz = 1; 1495 for (i=0; i<mbs; i++) { 1496 b->imax[i] = nz; 1497 } 1498 nz = nz*mbs; /* total nz */ 1499 } else { 1500 nz = 0; 1501 for (i=0; i<mbs; i++) {b->imax[i] = nnz[i]; nz += nnz[i];} 1502 } 1503 /* nz=(nz+mbs)/2; */ /* total diagonal and superdiagonal nonzero blocks */ 1504 1505 /* allocate the matrix space */ 1506 len = nz*sizeof(int) + nz*bs2*sizeof(MatScalar) + (B->m+1)*sizeof(int); 1507 ierr = PetscMalloc(len,&b->a);CHKERRQ(ierr); 1508 ierr = PetscMemzero(b->a,nz*bs2*sizeof(MatScalar));CHKERRQ(ierr); 1509 b->j = (int*)(b->a + nz*bs2); 1510 ierr = PetscMemzero(b->j,nz*sizeof(int));CHKERRQ(ierr); 1511 b->i = b->j + nz; 1512 b->singlemalloc = PETSC_TRUE; 1513 1514 /* pointer to beginning of each row */ 1515 b->i[0] = 0; 1516 for (i=1; i<mbs+1; i++) { 1517 b->i[i] = b->i[i-1] + b->imax[i-1]; 1518 } 1519 1520 /* b->ilen will count nonzeros in each block row so far. */ 1521 ierr = PetscMalloc((mbs+1)*sizeof(int),&b->ilen);CHKERRQ(ierr); 1522 PetscLogObjectMemory(B,len+2*(mbs+1)*sizeof(int)+sizeof(struct _p_Mat)+sizeof(Mat_SeqSBAIJ)); 1523 for (i=0; i<mbs; i++) { b->ilen[i] = 0;} 1524 1525 b->bs = bs; 1526 b->bs2 = bs2; 1527 b->nz = 0; 1528 b->maxnz = nz*bs2; 1529 1530 b->inew = 0; 1531 b->jnew = 0; 1532 b->anew = 0; 1533 b->a2anew = 0; 1534 b->permute = PETSC_FALSE; 1535 PetscFunctionReturn(0); 1536 } 1537 EXTERN_C_END 1538 1539 EXTERN_C_BEGIN 1540 EXTERN int MatConvert_SeqSBAIJ_SeqAIJ(Mat,const MatType,Mat*); 1541 EXTERN int MatConvert_SeqSBAIJ_SeqBAIJ(Mat,const MatType,Mat*); 1542 EXTERN_C_END 1543 1544 /*MC 1545 MATSEQSBAIJ - MATSEQSBAIJ = "seqsbaij" - A matrix type to be used for sequential symmetric block sparse matrices, 1546 based on block compressed sparse row format. Only the upper triangular portion of the matrix is stored. 1547 1548 Options Database Keys: 1549 . -mat_type seqsbaij - sets the matrix type to "seqsbaij" during a call to MatSetFromOptions() 1550 1551 Level: beginner 1552 1553 .seealso: MatCreateSeqSBAIJ 1554 M*/ 1555 1556 EXTERN_C_BEGIN 1557 #undef __FUNCT__ 1558 #define __FUNCT__ "MatCreate_SeqSBAIJ" 1559 int MatCreate_SeqSBAIJ(Mat B) 1560 { 1561 Mat_SeqSBAIJ *b; 1562 int ierr,size; 1563 1564 PetscFunctionBegin; 1565 ierr = MPI_Comm_size(B->comm,&size);CHKERRQ(ierr); 1566 if (size > 1) SETERRQ(PETSC_ERR_ARG_WRONG,"Comm must be of size 1"); 1567 B->m = B->M = PetscMax(B->m,B->M); 1568 B->n = B->N = PetscMax(B->n,B->N); 1569 1570 ierr = PetscNew(Mat_SeqSBAIJ,&b);CHKERRQ(ierr); 1571 B->data = (void*)b; 1572 ierr = PetscMemzero(b,sizeof(Mat_SeqSBAIJ));CHKERRQ(ierr); 1573 ierr = PetscMemcpy(B->ops,&MatOps_Values,sizeof(struct _MatOps));CHKERRQ(ierr); 1574 B->ops->destroy = MatDestroy_SeqSBAIJ; 1575 B->ops->view = MatView_SeqSBAIJ; 1576 B->factor = 0; 1577 B->lupivotthreshold = 1.0; 1578 B->mapping = 0; 1579 b->row = 0; 1580 b->icol = 0; 1581 b->reallocs = 0; 1582 b->saved_values = 0; 1583 1584 ierr = PetscMapCreateMPI(B->comm,B->m,B->M,&B->rmap);CHKERRQ(ierr); 1585 ierr = PetscMapCreateMPI(B->comm,B->n,B->N,&B->cmap);CHKERRQ(ierr); 1586 1587 b->sorted = PETSC_FALSE; 1588 b->roworiented = PETSC_TRUE; 1589 b->nonew = 0; 1590 b->diag = 0; 1591 b->solve_work = 0; 1592 b->mult_work = 0; 1593 B->spptr = 0; 1594 b->keepzeroedrows = PETSC_FALSE; 1595 b->xtoy = 0; 1596 b->XtoY = 0; 1597 1598 b->inew = 0; 1599 b->jnew = 0; 1600 b->anew = 0; 1601 b->a2anew = 0; 1602 b->permute = PETSC_FALSE; 1603 1604 ierr = PetscObjectComposeFunctionDynamic((PetscObject)B,"MatStoreValues_C", 1605 "MatStoreValues_SeqSBAIJ", 1606 MatStoreValues_SeqSBAIJ);CHKERRQ(ierr); 1607 ierr = PetscObjectComposeFunctionDynamic((PetscObject)B,"MatRetrieveValues_C", 1608 "MatRetrieveValues_SeqSBAIJ", 1609 (void*)MatRetrieveValues_SeqSBAIJ);CHKERRQ(ierr); 1610 ierr = PetscObjectComposeFunctionDynamic((PetscObject)B,"MatSeqSBAIJSetColumnIndices_C", 1611 "MatSeqSBAIJSetColumnIndices_SeqSBAIJ", 1612 MatSeqSBAIJSetColumnIndices_SeqSBAIJ);CHKERRQ(ierr); 1613 ierr = PetscObjectComposeFunctionDynamic((PetscObject)B,"MatConvert_seqsbaij_seqaij_C", 1614 "MatConvert_SeqSBAIJ_SeqAIJ", 1615 MatConvert_SeqSBAIJ_SeqAIJ);CHKERRQ(ierr); 1616 ierr = PetscObjectComposeFunctionDynamic((PetscObject)B,"MatConvert_seqsbaij_seqbaij_C", 1617 "MatConvert_SeqSBAIJ_SeqBAIJ", 1618 MatConvert_SeqSBAIJ_SeqBAIJ);CHKERRQ(ierr); 1619 ierr = PetscObjectComposeFunctionDynamic((PetscObject)B,"MatSeqSBAIJSetPreallocation_C", 1620 "MatSeqSBAIJSetPreallocation_SeqSBAIJ", 1621 MatSeqSBAIJSetPreallocation_SeqSBAIJ);CHKERRQ(ierr); 1622 1623 B->symmetric = PETSC_TRUE; 1624 B->structurally_symmetric = PETSC_TRUE; 1625 B->symmetric_set = PETSC_TRUE; 1626 B->structurally_symmetric_set = PETSC_TRUE; 1627 PetscFunctionReturn(0); 1628 } 1629 EXTERN_C_END 1630 1631 #undef __FUNCT__ 1632 #define __FUNCT__ "MatSeqSBAIJSetPreallocation" 1633 /*@C 1634 MatSeqSBAIJSetPreallocation - Creates a sparse symmetric matrix in block AIJ (block 1635 compressed row) format. For good matrix assembly performance the 1636 user should preallocate the matrix storage by setting the parameter nz 1637 (or the array nnz). By setting these parameters accurately, performance 1638 during matrix assembly can be increased by more than a factor of 50. 1639 1640 Collective on Mat 1641 1642 Input Parameters: 1643 + A - the symmetric matrix 1644 . bs - size of block 1645 . nz - number of block nonzeros per block row (same for all rows) 1646 - nnz - array containing the number of block nonzeros in the upper triangular plus 1647 diagonal portion of each block (possibly different for each block row) or PETSC_NULL 1648 1649 Options Database Keys: 1650 . -mat_no_unroll - uses code that does not unroll the loops in the 1651 block calculations (much slower) 1652 . -mat_block_size - size of the blocks to use 1653 1654 Level: intermediate 1655 1656 Notes: 1657 Specify the preallocated storage with either nz or nnz (not both). 1658 Set nz=PETSC_DEFAULT and nnz=PETSC_NULL for PETSc to control dynamic memory 1659 allocation. For additional details, see the users manual chapter on 1660 matrices. 1661 1662 .seealso: MatCreate(), MatCreateSeqAIJ(), MatSetValues(), MatCreateMPISBAIJ() 1663 @*/ 1664 int MatSeqSBAIJSetPreallocation(Mat B,int bs,int nz,const int nnz[]) { 1665 int ierr,(*f)(Mat,int,int,const int[]); 1666 1667 PetscFunctionBegin; 1668 ierr = PetscObjectQueryFunction((PetscObject)B,"MatSeqSBAIJSetPreallocation_C",(void (**)(void))&f);CHKERRQ(ierr); 1669 if (f) { 1670 ierr = (*f)(B,bs,nz,nnz);CHKERRQ(ierr); 1671 } 1672 PetscFunctionReturn(0); 1673 } 1674 1675 #undef __FUNCT__ 1676 #define __FUNCT__ "MatCreateSeqSBAIJ" 1677 /*@C 1678 MatCreateSeqSBAIJ - Creates a sparse symmetric matrix in block AIJ (block 1679 compressed row) format. For good matrix assembly performance the 1680 user should preallocate the matrix storage by setting the parameter nz 1681 (or the array nnz). By setting these parameters accurately, performance 1682 during matrix assembly can be increased by more than a factor of 50. 1683 1684 Collective on MPI_Comm 1685 1686 Input Parameters: 1687 + comm - MPI communicator, set to PETSC_COMM_SELF 1688 . bs - size of block 1689 . m - number of rows, or number of columns 1690 . nz - number of block nonzeros per block row (same for all rows) 1691 - nnz - array containing the number of block nonzeros in the upper triangular plus 1692 diagonal portion of each block (possibly different for each block row) or PETSC_NULL 1693 1694 Output Parameter: 1695 . A - the symmetric matrix 1696 1697 Options Database Keys: 1698 . -mat_no_unroll - uses code that does not unroll the loops in the 1699 block calculations (much slower) 1700 . -mat_block_size - size of the blocks to use 1701 1702 Level: intermediate 1703 1704 Notes: 1705 1706 Specify the preallocated storage with either nz or nnz (not both). 1707 Set nz=PETSC_DEFAULT and nnz=PETSC_NULL for PETSc to control dynamic memory 1708 allocation. For additional details, see the users manual chapter on 1709 matrices. 1710 1711 .seealso: MatCreate(), MatCreateSeqAIJ(), MatSetValues(), MatCreateMPISBAIJ() 1712 @*/ 1713 int MatCreateSeqSBAIJ(MPI_Comm comm,int bs,int m,int n,int nz,const int nnz[],Mat *A) 1714 { 1715 int ierr; 1716 1717 PetscFunctionBegin; 1718 ierr = MatCreate(comm,m,n,m,n,A);CHKERRQ(ierr); 1719 ierr = MatSetType(*A,MATSEQSBAIJ);CHKERRQ(ierr); 1720 ierr = MatSeqSBAIJSetPreallocation(*A,bs,nz,nnz);CHKERRQ(ierr); 1721 PetscFunctionReturn(0); 1722 } 1723 1724 #undef __FUNCT__ 1725 #define __FUNCT__ "MatDuplicate_SeqSBAIJ" 1726 int MatDuplicate_SeqSBAIJ(Mat A,MatDuplicateOption cpvalues,Mat *B) 1727 { 1728 Mat C; 1729 Mat_SeqSBAIJ *c,*a = (Mat_SeqSBAIJ*)A->data; 1730 int i,len,mbs = a->mbs,nz = a->nz,bs2 =a->bs2,ierr; 1731 1732 PetscFunctionBegin; 1733 if (a->i[mbs] != nz) SETERRQ(PETSC_ERR_PLIB,"Corrupt matrix"); 1734 1735 *B = 0; 1736 ierr = MatCreate(A->comm,A->m,A->n,A->m,A->n,&C);CHKERRQ(ierr); 1737 ierr = MatSetType(C,A->type_name);CHKERRQ(ierr); 1738 c = (Mat_SeqSBAIJ*)C->data; 1739 1740 C->preallocated = PETSC_TRUE; 1741 C->factor = A->factor; 1742 c->row = 0; 1743 c->icol = 0; 1744 c->saved_values = 0; 1745 c->keepzeroedrows = a->keepzeroedrows; 1746 C->assembled = PETSC_TRUE; 1747 1748 C->M = A->M; 1749 C->N = A->N; 1750 c->bs = a->bs; 1751 c->bs2 = a->bs2; 1752 c->mbs = a->mbs; 1753 c->nbs = a->nbs; 1754 1755 ierr = PetscMalloc((mbs+1)*sizeof(int),&c->imax);CHKERRQ(ierr); 1756 ierr = PetscMalloc((mbs+1)*sizeof(int),&c->ilen);CHKERRQ(ierr); 1757 for (i=0; i<mbs; i++) { 1758 c->imax[i] = a->imax[i]; 1759 c->ilen[i] = a->ilen[i]; 1760 } 1761 1762 /* allocate the matrix space */ 1763 c->singlemalloc = PETSC_TRUE; 1764 len = (mbs+1)*sizeof(int) + nz*(bs2*sizeof(MatScalar) + sizeof(int)); 1765 ierr = PetscMalloc(len,&c->a);CHKERRQ(ierr); 1766 c->j = (int*)(c->a + nz*bs2); 1767 c->i = c->j + nz; 1768 ierr = PetscMemcpy(c->i,a->i,(mbs+1)*sizeof(int));CHKERRQ(ierr); 1769 if (mbs > 0) { 1770 ierr = PetscMemcpy(c->j,a->j,nz*sizeof(int));CHKERRQ(ierr); 1771 if (cpvalues == MAT_COPY_VALUES) { 1772 ierr = PetscMemcpy(c->a,a->a,bs2*nz*sizeof(MatScalar));CHKERRQ(ierr); 1773 } else { 1774 ierr = PetscMemzero(c->a,bs2*nz*sizeof(MatScalar));CHKERRQ(ierr); 1775 } 1776 } 1777 1778 PetscLogObjectMemory(C,len+2*(mbs+1)*sizeof(int)+sizeof(struct _p_Mat)+sizeof(Mat_SeqSBAIJ)); 1779 c->sorted = a->sorted; 1780 c->roworiented = a->roworiented; 1781 c->nonew = a->nonew; 1782 1783 if (a->diag) { 1784 ierr = PetscMalloc((mbs+1)*sizeof(int),&c->diag);CHKERRQ(ierr); 1785 PetscLogObjectMemory(C,(mbs+1)*sizeof(int)); 1786 for (i=0; i<mbs; i++) { 1787 c->diag[i] = a->diag[i]; 1788 } 1789 } else c->diag = 0; 1790 c->nz = a->nz; 1791 c->maxnz = a->maxnz; 1792 c->solve_work = 0; 1793 c->mult_work = 0; 1794 *B = C; 1795 ierr = PetscFListDuplicate(A->qlist,&C->qlist);CHKERRQ(ierr); 1796 PetscFunctionReturn(0); 1797 } 1798 1799 #undef __FUNCT__ 1800 #define __FUNCT__ "MatLoad_SeqSBAIJ" 1801 int MatLoad_SeqSBAIJ(PetscViewer viewer,const MatType type,Mat *A) 1802 { 1803 Mat_SeqSBAIJ *a; 1804 Mat B; 1805 int i,nz,ierr,fd,header[4],size,*rowlengths=0,M,N,bs=1; 1806 int *mask,mbs,*jj,j,rowcount,nzcount,k,*s_browlengths,maskcount; 1807 int kmax,jcount,block,idx,point,nzcountb,extra_rows; 1808 int *masked,nmask,tmp,bs2,ishift; 1809 PetscScalar *aa; 1810 MPI_Comm comm = ((PetscObject)viewer)->comm; 1811 1812 PetscFunctionBegin; 1813 ierr = PetscOptionsGetInt(PETSC_NULL,"-matload_block_size",&bs,PETSC_NULL);CHKERRQ(ierr); 1814 bs2 = bs*bs; 1815 1816 ierr = MPI_Comm_size(comm,&size);CHKERRQ(ierr); 1817 if (size > 1) SETERRQ(PETSC_ERR_ARG_WRONG,"view must have one processor"); 1818 ierr = PetscViewerBinaryGetDescriptor(viewer,&fd);CHKERRQ(ierr); 1819 ierr = PetscBinaryRead(fd,header,4,PETSC_INT);CHKERRQ(ierr); 1820 if (header[0] != MAT_FILE_COOKIE) SETERRQ(PETSC_ERR_FILE_UNEXPECTED,"not Mat object"); 1821 M = header[1]; N = header[2]; nz = header[3]; 1822 1823 if (header[3] < 0) { 1824 SETERRQ(PETSC_ERR_FILE_UNEXPECTED,"Matrix stored in special format, cannot load as SeqSBAIJ"); 1825 } 1826 1827 if (M != N) SETERRQ(PETSC_ERR_SUP,"Can only do square matrices"); 1828 1829 /* 1830 This code adds extra rows to make sure the number of rows is 1831 divisible by the blocksize 1832 */ 1833 mbs = M/bs; 1834 extra_rows = bs - M + bs*(mbs); 1835 if (extra_rows == bs) extra_rows = 0; 1836 else mbs++; 1837 if (extra_rows) { 1838 PetscLogInfo(0,"MatLoad_SeqSBAIJ:Padding loaded matrix to match blocksize\n"); 1839 } 1840 1841 /* read in row lengths */ 1842 ierr = PetscMalloc((M+extra_rows)*sizeof(int),&rowlengths);CHKERRQ(ierr); 1843 ierr = PetscBinaryRead(fd,rowlengths,M,PETSC_INT);CHKERRQ(ierr); 1844 for (i=0; i<extra_rows; i++) rowlengths[M+i] = 1; 1845 1846 /* read in column indices */ 1847 ierr = PetscMalloc((nz+extra_rows)*sizeof(int),&jj);CHKERRQ(ierr); 1848 ierr = PetscBinaryRead(fd,jj,nz,PETSC_INT);CHKERRQ(ierr); 1849 for (i=0; i<extra_rows; i++) jj[nz+i] = M+i; 1850 1851 /* loop over row lengths determining block row lengths */ 1852 ierr = PetscMalloc(mbs*sizeof(int),&s_browlengths);CHKERRQ(ierr); 1853 ierr = PetscMemzero(s_browlengths,mbs*sizeof(int));CHKERRQ(ierr); 1854 ierr = PetscMalloc(2*mbs*sizeof(int),&mask);CHKERRQ(ierr); 1855 ierr = PetscMemzero(mask,mbs*sizeof(int));CHKERRQ(ierr); 1856 masked = mask + mbs; 1857 rowcount = 0; nzcount = 0; 1858 for (i=0; i<mbs; i++) { 1859 nmask = 0; 1860 for (j=0; j<bs; j++) { 1861 kmax = rowlengths[rowcount]; 1862 for (k=0; k<kmax; k++) { 1863 tmp = jj[nzcount++]/bs; /* block col. index */ 1864 if (!mask[tmp] && tmp >= i) {masked[nmask++] = tmp; mask[tmp] = 1;} 1865 } 1866 rowcount++; 1867 } 1868 s_browlengths[i] += nmask; 1869 1870 /* zero out the mask elements we set */ 1871 for (j=0; j<nmask; j++) mask[masked[j]] = 0; 1872 } 1873 1874 /* create our matrix */ 1875 ierr = MatCreate(comm,M+extra_rows,N+extra_rows,M+extra_rows,N+extra_rows,&B);CHKERRQ(ierr); 1876 ierr = MatSetType(B,type);CHKERRQ(ierr); 1877 ierr = MatSeqSBAIJSetPreallocation(B,bs,0,s_browlengths);CHKERRQ(ierr); 1878 a = (Mat_SeqSBAIJ*)B->data; 1879 1880 /* set matrix "i" values */ 1881 a->i[0] = 0; 1882 for (i=1; i<= mbs; i++) { 1883 a->i[i] = a->i[i-1] + s_browlengths[i-1]; 1884 a->ilen[i-1] = s_browlengths[i-1]; 1885 } 1886 a->nz = a->i[mbs]; 1887 1888 /* read in nonzero values */ 1889 ierr = PetscMalloc((nz+extra_rows)*sizeof(PetscScalar),&aa);CHKERRQ(ierr); 1890 ierr = PetscBinaryRead(fd,aa,nz,PETSC_SCALAR);CHKERRQ(ierr); 1891 for (i=0; i<extra_rows; i++) aa[nz+i] = 1.0; 1892 1893 /* set "a" and "j" values into matrix */ 1894 nzcount = 0; jcount = 0; 1895 for (i=0; i<mbs; i++) { 1896 nzcountb = nzcount; 1897 nmask = 0; 1898 for (j=0; j<bs; j++) { 1899 kmax = rowlengths[i*bs+j]; 1900 for (k=0; k<kmax; k++) { 1901 tmp = jj[nzcount++]/bs; /* block col. index */ 1902 if (!mask[tmp] && tmp >= i) { masked[nmask++] = tmp; mask[tmp] = 1;} 1903 } 1904 } 1905 /* sort the masked values */ 1906 ierr = PetscSortInt(nmask,masked);CHKERRQ(ierr); 1907 1908 /* set "j" values into matrix */ 1909 maskcount = 1; 1910 for (j=0; j<nmask; j++) { 1911 a->j[jcount++] = masked[j]; 1912 mask[masked[j]] = maskcount++; 1913 } 1914 1915 /* set "a" values into matrix */ 1916 ishift = bs2*a->i[i]; 1917 for (j=0; j<bs; j++) { 1918 kmax = rowlengths[i*bs+j]; 1919 for (k=0; k<kmax; k++) { 1920 tmp = jj[nzcountb]/bs ; /* block col. index */ 1921 if (tmp >= i){ 1922 block = mask[tmp] - 1; 1923 point = jj[nzcountb] - bs*tmp; 1924 idx = ishift + bs2*block + j + bs*point; 1925 a->a[idx] = aa[nzcountb]; 1926 } 1927 nzcountb++; 1928 } 1929 } 1930 /* zero out the mask elements we set */ 1931 for (j=0; j<nmask; j++) mask[masked[j]] = 0; 1932 } 1933 if (jcount != a->nz) SETERRQ(PETSC_ERR_FILE_UNEXPECTED,"Bad binary matrix"); 1934 1935 ierr = PetscFree(rowlengths);CHKERRQ(ierr); 1936 ierr = PetscFree(s_browlengths);CHKERRQ(ierr); 1937 ierr = PetscFree(aa);CHKERRQ(ierr); 1938 ierr = PetscFree(jj);CHKERRQ(ierr); 1939 ierr = PetscFree(mask);CHKERRQ(ierr); 1940 1941 ierr = MatAssemblyBegin(B,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr); 1942 ierr = MatAssemblyEnd(B,MAT_FINAL_ASSEMBLY);CHKERRQ(ierr); 1943 ierr = MatView_Private(B);CHKERRQ(ierr); 1944 *A = B; 1945 PetscFunctionReturn(0); 1946 } 1947 1948 #undef __FUNCT__ 1949 #define __FUNCT__ "MatRelax_SeqSBAIJ" 1950 int MatRelax_SeqSBAIJ(Mat A,Vec bb,PetscReal omega,MatSORType flag,PetscReal fshift,int its,int lits,Vec xx) 1951 { 1952 Mat_SeqSBAIJ *a = (Mat_SeqSBAIJ*)A->data; 1953 MatScalar *aa=a->a,*v,*v1; 1954 PetscScalar *x,*b,*t,sum,d; 1955 int m=a->mbs,bs=a->bs,*ai=a->i,*aj=a->j,ierr; 1956 int nz,nz1,*vj,*vj1,i; 1957 1958 PetscFunctionBegin; 1959 its = its*lits; 1960 if (its <= 0) SETERRQ2(PETSC_ERR_ARG_WRONG,"Relaxation requires global its %d and local its %d both positive",its,lits); 1961 1962 if (bs > 1) 1963 SETERRQ(PETSC_ERR_SUP,"SSOR for block size > 1 is not yet implemented"); 1964 1965 ierr = VecGetArray(xx,&x);CHKERRQ(ierr); 1966 if (xx != bb) { 1967 ierr = VecGetArray(bb,&b);CHKERRQ(ierr); 1968 } else { 1969 b = x; 1970 } 1971 1972 ierr = PetscMalloc(m*sizeof(PetscScalar),&t);CHKERRQ(ierr); 1973 1974 if (flag & SOR_ZERO_INITIAL_GUESS) { 1975 if (flag & SOR_FORWARD_SWEEP || flag & SOR_LOCAL_FORWARD_SWEEP){ 1976 for (i=0; i<m; i++) 1977 t[i] = b[i]; 1978 1979 for (i=0; i<m; i++){ 1980 d = *(aa + ai[i]); /* diag[i] */ 1981 v = aa + ai[i] + 1; 1982 vj = aj + ai[i] + 1; 1983 nz = ai[i+1] - ai[i] - 1; 1984 x[i] = omega*t[i]/d; 1985 while (nz--) t[*vj++] -= x[i]*(*v++); /* update rhs */ 1986 PetscLogFlops(2*nz-1); 1987 } 1988 } 1989 1990 if (flag & SOR_BACKWARD_SWEEP || flag & SOR_LOCAL_BACKWARD_SWEEP){ 1991 for (i=0; i<m; i++) 1992 t[i] = b[i]; 1993 1994 for (i=0; i<m-1; i++){ /* update rhs */ 1995 v = aa + ai[i] + 1; 1996 vj = aj + ai[i] + 1; 1997 nz = ai[i+1] - ai[i] - 1; 1998 while (nz--) t[*vj++] -= x[i]*(*v++); 1999 PetscLogFlops(2*nz-1); 2000 } 2001 for (i=m-1; i>=0; i--){ 2002 d = *(aa + ai[i]); 2003 v = aa + ai[i] + 1; 2004 vj = aj + ai[i] + 1; 2005 nz = ai[i+1] - ai[i] - 1; 2006 sum = t[i]; 2007 while (nz--) sum -= x[*vj++]*(*v++); 2008 PetscLogFlops(2*nz-1); 2009 x[i] = (1-omega)*x[i] + omega*sum/d; 2010 } 2011 } 2012 its--; 2013 } 2014 2015 while (its--) { 2016 /* 2017 forward sweep: 2018 for i=0,...,m-1: 2019 sum[i] = (b[i] - U(i,:)x )/d[i]; 2020 x[i] = (1-omega)x[i] + omega*sum[i]; 2021 b = b - x[i]*U^T(i,:); 2022 2023 */ 2024 if (flag & SOR_FORWARD_SWEEP || flag & SOR_LOCAL_FORWARD_SWEEP){ 2025 for (i=0; i<m; i++) 2026 t[i] = b[i]; 2027 2028 for (i=0; i<m; i++){ 2029 d = *(aa + ai[i]); /* diag[i] */ 2030 v = aa + ai[i] + 1; v1=v; 2031 vj = aj + ai[i] + 1; vj1=vj; 2032 nz = ai[i+1] - ai[i] - 1; nz1=nz; 2033 sum = t[i]; 2034 while (nz1--) sum -= (*v1++)*x[*vj1++]; 2035 x[i] = (1-omega)*x[i] + omega*sum/d; 2036 while (nz--) t[*vj++] -= x[i]*(*v++); 2037 PetscLogFlops(4*nz-2); 2038 } 2039 } 2040 2041 if (flag & SOR_BACKWARD_SWEEP || flag & SOR_LOCAL_BACKWARD_SWEEP){ 2042 /* 2043 backward sweep: 2044 b = b - x[i]*U^T(i,:), i=0,...,n-2 2045 for i=m-1,...,0: 2046 sum[i] = (b[i] - U(i,:)x )/d[i]; 2047 x[i] = (1-omega)x[i] + omega*sum[i]; 2048 */ 2049 for (i=0; i<m; i++) 2050 t[i] = b[i]; 2051 2052 for (i=0; i<m-1; i++){ /* update rhs */ 2053 v = aa + ai[i] + 1; 2054 vj = aj + ai[i] + 1; 2055 nz = ai[i+1] - ai[i] - 1; 2056 while (nz--) t[*vj++] -= x[i]*(*v++); 2057 PetscLogFlops(2*nz-1); 2058 } 2059 for (i=m-1; i>=0; i--){ 2060 d = *(aa + ai[i]); 2061 v = aa + ai[i] + 1; 2062 vj = aj + ai[i] + 1; 2063 nz = ai[i+1] - ai[i] - 1; 2064 sum = t[i]; 2065 while (nz--) sum -= x[*vj++]*(*v++); 2066 PetscLogFlops(2*nz-1); 2067 x[i] = (1-omega)*x[i] + omega*sum/d; 2068 } 2069 } 2070 } 2071 2072 ierr = PetscFree(t); CHKERRQ(ierr); 2073 ierr = VecRestoreArray(xx,&x);CHKERRQ(ierr); 2074 if (bb != xx) { 2075 ierr = VecRestoreArray(bb,&b);CHKERRQ(ierr); 2076 } 2077 2078 PetscFunctionReturn(0); 2079 } 2080 2081 2082 2083 2084 2085 2086