00001
00002
00003
00004
00005
00006
00007
00008
00009
00010
00011
00012
00013 #include "f2c.h"
00014 #include "blaswrap.h"
00015
00016
00017
00018 static complex c_b1 = {1.f,0.f};
00019 static integer c__1 = 1;
00020
00021 int clavhp_(char *uplo, char *trans, char *diag, integer *n,
00022 integer *nrhs, complex *a, integer *ipiv, complex *b, integer *ldb,
00023 integer *info)
00024 {
00025
00026 integer b_dim1, b_offset, i__1, i__2;
00027 complex q__1, q__2, q__3;
00028
00029
00030 void r_cnjg(complex *, complex *);
00031
00032
00033 integer j, k;
00034 complex t1, t2, d11, d12, d21, d22;
00035 integer kc, kp;
00036 extern int cscal_(integer *, complex *, complex *,
00037 integer *);
00038 extern logical lsame_(char *, char *);
00039 extern int cgemv_(char *, integer *, integer *, complex *
00040 , complex *, integer *, complex *, integer *, complex *, complex *
00041 , integer *), cgeru_(integer *, integer *, complex *,
00042 complex *, integer *, complex *, integer *, complex *, integer *),
00043 cswap_(integer *, complex *, integer *, complex *, integer *),
00044 clacgv_(integer *, complex *, integer *), xerbla_(char *, integer
00045 *);
00046 integer kcnext;
00047 logical nounit;
00048
00049
00050
00051
00052
00053
00054
00055
00056
00057
00058
00059
00060
00061
00062
00063
00064
00065
00066
00067
00068
00069
00070
00071
00072
00073
00074
00075
00076
00077
00078
00079
00080
00081
00082
00083
00084
00085
00086
00087
00088
00089
00090
00091
00092
00093
00094
00095
00096
00097
00098
00099
00100
00101
00102
00103
00104
00105
00106
00107
00108
00109
00110
00111
00112
00113
00114
00115
00116
00117
00118
00119
00120
00121
00122
00123
00124
00125
00126
00127
00128
00129
00130
00131
00132
00133
00134
00135
00136
00137
00138
00139
00140
00141
00142
00143
00144
00145
00146
00147
00148
00149
00150
00151
00152
00153
00154
00155
00156
00157
00158
00159
00160
00161
00162
00163
00164
00165 --a;
00166 --ipiv;
00167 b_dim1 = *ldb;
00168 b_offset = 1 + b_dim1;
00169 b -= b_offset;
00170
00171
00172 *info = 0;
00173 if (! lsame_(uplo, "U") && ! lsame_(uplo, "L")) {
00174 *info = -1;
00175 } else if (! lsame_(trans, "N") && ! lsame_(trans,
00176 "C")) {
00177 *info = -2;
00178 } else if (! lsame_(diag, "U") && ! lsame_(diag,
00179 "N")) {
00180 *info = -3;
00181 } else if (*n < 0) {
00182 *info = -4;
00183 } else if (*ldb < max(1,*n)) {
00184 *info = -8;
00185 }
00186 if (*info != 0) {
00187 i__1 = -(*info);
00188 xerbla_("CLAVHP ", &i__1);
00189 return 0;
00190 }
00191
00192
00193
00194 if (*n == 0) {
00195 return 0;
00196 }
00197
00198 nounit = lsame_(diag, "N");
00199
00200
00201
00202
00203
00204 if (lsame_(trans, "N")) {
00205
00206
00207
00208
00209 if (lsame_(uplo, "U")) {
00210
00211
00212
00213 k = 1;
00214 kc = 1;
00215 L10:
00216 if (k > *n) {
00217 goto L30;
00218 }
00219
00220
00221
00222 if (ipiv[k] > 0) {
00223
00224
00225
00226 if (nounit) {
00227 cscal_(nrhs, &a[kc + k - 1], &b[k + b_dim1], ldb);
00228 }
00229
00230
00231
00232 if (k > 1) {
00233
00234
00235
00236 i__1 = k - 1;
00237 cgeru_(&i__1, nrhs, &c_b1, &a[kc], &c__1, &b[k + b_dim1],
00238 ldb, &b[b_dim1 + 1], ldb);
00239
00240
00241
00242 kp = ipiv[k];
00243 if (kp != k) {
00244 cswap_(nrhs, &b[k + b_dim1], ldb, &b[kp + b_dim1],
00245 ldb);
00246 }
00247 }
00248 kc += k;
00249 ++k;
00250 } else {
00251
00252
00253
00254 kcnext = kc + k;
00255
00256
00257
00258 if (nounit) {
00259 i__1 = kcnext - 1;
00260 d11.r = a[i__1].r, d11.i = a[i__1].i;
00261 i__1 = kcnext + k;
00262 d22.r = a[i__1].r, d22.i = a[i__1].i;
00263 i__1 = kcnext + k - 1;
00264 d12.r = a[i__1].r, d12.i = a[i__1].i;
00265 r_cnjg(&q__1, &d12);
00266 d21.r = q__1.r, d21.i = q__1.i;
00267 i__1 = *nrhs;
00268 for (j = 1; j <= i__1; ++j) {
00269 i__2 = k + j * b_dim1;
00270 t1.r = b[i__2].r, t1.i = b[i__2].i;
00271 i__2 = k + 1 + j * b_dim1;
00272 t2.r = b[i__2].r, t2.i = b[i__2].i;
00273 i__2 = k + j * b_dim1;
00274 q__2.r = d11.r * t1.r - d11.i * t1.i, q__2.i = d11.r *
00275 t1.i + d11.i * t1.r;
00276 q__3.r = d12.r * t2.r - d12.i * t2.i, q__3.i = d12.r *
00277 t2.i + d12.i * t2.r;
00278 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00279 b[i__2].r = q__1.r, b[i__2].i = q__1.i;
00280 i__2 = k + 1 + j * b_dim1;
00281 q__2.r = d21.r * t1.r - d21.i * t1.i, q__2.i = d21.r *
00282 t1.i + d21.i * t1.r;
00283 q__3.r = d22.r * t2.r - d22.i * t2.i, q__3.i = d22.r *
00284 t2.i + d22.i * t2.r;
00285 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00286 b[i__2].r = q__1.r, b[i__2].i = q__1.i;
00287
00288 }
00289 }
00290
00291
00292
00293 if (k > 1) {
00294
00295
00296
00297 i__1 = k - 1;
00298 cgeru_(&i__1, nrhs, &c_b1, &a[kc], &c__1, &b[k + b_dim1],
00299 ldb, &b[b_dim1 + 1], ldb);
00300 i__1 = k - 1;
00301 cgeru_(&i__1, nrhs, &c_b1, &a[kcnext], &c__1, &b[k + 1 +
00302 b_dim1], ldb, &b[b_dim1 + 1], ldb);
00303
00304
00305
00306 kp = (i__1 = ipiv[k], abs(i__1));
00307 if (kp != k) {
00308 cswap_(nrhs, &b[k + b_dim1], ldb, &b[kp + b_dim1],
00309 ldb);
00310 }
00311 }
00312 kc = kcnext + k + 1;
00313 k += 2;
00314 }
00315 goto L10;
00316 L30:
00317
00318
00319
00320
00321 ;
00322 } else {
00323
00324
00325
00326 k = *n;
00327 kc = *n * (*n + 1) / 2 + 1;
00328 L40:
00329 if (k < 1) {
00330 goto L60;
00331 }
00332 kc -= *n - k + 1;
00333
00334
00335
00336
00337 if (ipiv[k] > 0) {
00338
00339
00340
00341
00342
00343 if (nounit) {
00344 cscal_(nrhs, &a[kc], &b[k + b_dim1], ldb);
00345 }
00346
00347
00348
00349 if (k != *n) {
00350 kp = ipiv[k];
00351
00352
00353
00354 i__1 = *n - k;
00355 cgeru_(&i__1, nrhs, &c_b1, &a[kc + 1], &c__1, &b[k +
00356 b_dim1], ldb, &b[k + 1 + b_dim1], ldb);
00357
00358
00359
00360
00361 if (kp != k) {
00362 cswap_(nrhs, &b[k + b_dim1], ldb, &b[kp + b_dim1],
00363 ldb);
00364 }
00365 }
00366 --k;
00367
00368 } else {
00369
00370
00371
00372 kcnext = kc - (*n - k + 2);
00373
00374
00375
00376 if (nounit) {
00377 i__1 = kcnext;
00378 d11.r = a[i__1].r, d11.i = a[i__1].i;
00379 i__1 = kc;
00380 d22.r = a[i__1].r, d22.i = a[i__1].i;
00381 i__1 = kcnext + 1;
00382 d21.r = a[i__1].r, d21.i = a[i__1].i;
00383 r_cnjg(&q__1, &d21);
00384 d12.r = q__1.r, d12.i = q__1.i;
00385 i__1 = *nrhs;
00386 for (j = 1; j <= i__1; ++j) {
00387 i__2 = k - 1 + j * b_dim1;
00388 t1.r = b[i__2].r, t1.i = b[i__2].i;
00389 i__2 = k + j * b_dim1;
00390 t2.r = b[i__2].r, t2.i = b[i__2].i;
00391 i__2 = k - 1 + j * b_dim1;
00392 q__2.r = d11.r * t1.r - d11.i * t1.i, q__2.i = d11.r *
00393 t1.i + d11.i * t1.r;
00394 q__3.r = d12.r * t2.r - d12.i * t2.i, q__3.i = d12.r *
00395 t2.i + d12.i * t2.r;
00396 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00397 b[i__2].r = q__1.r, b[i__2].i = q__1.i;
00398 i__2 = k + j * b_dim1;
00399 q__2.r = d21.r * t1.r - d21.i * t1.i, q__2.i = d21.r *
00400 t1.i + d21.i * t1.r;
00401 q__3.r = d22.r * t2.r - d22.i * t2.i, q__3.i = d22.r *
00402 t2.i + d22.i * t2.r;
00403 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00404 b[i__2].r = q__1.r, b[i__2].i = q__1.i;
00405
00406 }
00407 }
00408
00409
00410
00411 if (k != *n) {
00412
00413
00414
00415 i__1 = *n - k;
00416 cgeru_(&i__1, nrhs, &c_b1, &a[kc + 1], &c__1, &b[k +
00417 b_dim1], ldb, &b[k + 1 + b_dim1], ldb);
00418 i__1 = *n - k;
00419 cgeru_(&i__1, nrhs, &c_b1, &a[kcnext + 2], &c__1, &b[k -
00420 1 + b_dim1], ldb, &b[k + 1 + b_dim1], ldb);
00421
00422
00423
00424
00425 kp = (i__1 = ipiv[k], abs(i__1));
00426 if (kp != k) {
00427 cswap_(nrhs, &b[k + b_dim1], ldb, &b[kp + b_dim1],
00428 ldb);
00429 }
00430 }
00431 kc = kcnext;
00432 k += -2;
00433 }
00434 goto L40;
00435 L60:
00436 ;
00437 }
00438
00439
00440
00441
00442
00443 } else {
00444
00445
00446
00447
00448
00449 if (lsame_(uplo, "U")) {
00450
00451
00452
00453 k = *n;
00454 kc = *n * (*n + 1) / 2 + 1;
00455 L70:
00456 if (k < 1) {
00457 goto L90;
00458 }
00459 kc -= k;
00460
00461
00462
00463 if (ipiv[k] > 0) {
00464 if (k > 1) {
00465
00466
00467
00468 kp = ipiv[k];
00469 if (kp != k) {
00470 cswap_(nrhs, &b[k + b_dim1], ldb, &b[kp + b_dim1],
00471 ldb);
00472 }
00473
00474
00475
00476
00477
00478 clacgv_(nrhs, &b[k + b_dim1], ldb);
00479 i__1 = k - 1;
00480 cgemv_("Conjugate", &i__1, nrhs, &c_b1, &b[b_offset], ldb,
00481 &a[kc], &c__1, &c_b1, &b[k + b_dim1], ldb);
00482 clacgv_(nrhs, &b[k + b_dim1], ldb);
00483 }
00484 if (nounit) {
00485 cscal_(nrhs, &a[kc + k - 1], &b[k + b_dim1], ldb);
00486 }
00487 --k;
00488
00489
00490
00491 } else {
00492 kcnext = kc - (k - 1);
00493 if (k > 2) {
00494
00495
00496
00497 kp = (i__1 = ipiv[k], abs(i__1));
00498 if (kp != k - 1) {
00499 cswap_(nrhs, &b[k - 1 + b_dim1], ldb, &b[kp + b_dim1],
00500 ldb);
00501 }
00502
00503
00504
00505 clacgv_(nrhs, &b[k + b_dim1], ldb);
00506 i__1 = k - 2;
00507 cgemv_("Conjugate", &i__1, nrhs, &c_b1, &b[b_offset], ldb,
00508 &a[kc], &c__1, &c_b1, &b[k + b_dim1], ldb);
00509 clacgv_(nrhs, &b[k + b_dim1], ldb);
00510
00511 clacgv_(nrhs, &b[k - 1 + b_dim1], ldb);
00512 i__1 = k - 2;
00513 cgemv_("Conjugate", &i__1, nrhs, &c_b1, &b[b_offset], ldb,
00514 &a[kcnext], &c__1, &c_b1, &b[k - 1 + b_dim1],
00515 ldb);
00516 clacgv_(nrhs, &b[k - 1 + b_dim1], ldb);
00517 }
00518
00519
00520
00521 if (nounit) {
00522 i__1 = kc - 1;
00523 d11.r = a[i__1].r, d11.i = a[i__1].i;
00524 i__1 = kc + k - 1;
00525 d22.r = a[i__1].r, d22.i = a[i__1].i;
00526 i__1 = kc + k - 2;
00527 d12.r = a[i__1].r, d12.i = a[i__1].i;
00528 r_cnjg(&q__1, &d12);
00529 d21.r = q__1.r, d21.i = q__1.i;
00530 i__1 = *nrhs;
00531 for (j = 1; j <= i__1; ++j) {
00532 i__2 = k - 1 + j * b_dim1;
00533 t1.r = b[i__2].r, t1.i = b[i__2].i;
00534 i__2 = k + j * b_dim1;
00535 t2.r = b[i__2].r, t2.i = b[i__2].i;
00536 i__2 = k - 1 + j * b_dim1;
00537 q__2.r = d11.r * t1.r - d11.i * t1.i, q__2.i = d11.r *
00538 t1.i + d11.i * t1.r;
00539 q__3.r = d12.r * t2.r - d12.i * t2.i, q__3.i = d12.r *
00540 t2.i + d12.i * t2.r;
00541 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00542 b[i__2].r = q__1.r, b[i__2].i = q__1.i;
00543 i__2 = k + j * b_dim1;
00544 q__2.r = d21.r * t1.r - d21.i * t1.i, q__2.i = d21.r *
00545 t1.i + d21.i * t1.r;
00546 q__3.r = d22.r * t2.r - d22.i * t2.i, q__3.i = d22.r *
00547 t2.i + d22.i * t2.r;
00548 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00549 b[i__2].r = q__1.r, b[i__2].i = q__1.i;
00550
00551 }
00552 }
00553 kc = kcnext;
00554 k += -2;
00555 }
00556 goto L70;
00557 L90:
00558
00559
00560
00561
00562
00563 ;
00564 } else {
00565
00566
00567
00568 k = 1;
00569 kc = 1;
00570 L100:
00571 if (k > *n) {
00572 goto L120;
00573 }
00574
00575
00576
00577 if (ipiv[k] > 0) {
00578 if (k < *n) {
00579
00580
00581
00582 kp = ipiv[k];
00583 if (kp != k) {
00584 cswap_(nrhs, &b[k + b_dim1], ldb, &b[kp + b_dim1],
00585 ldb);
00586 }
00587
00588
00589
00590 clacgv_(nrhs, &b[k + b_dim1], ldb);
00591 i__1 = *n - k;
00592 cgemv_("Conjugate", &i__1, nrhs, &c_b1, &b[k + 1 + b_dim1]
00593 , ldb, &a[kc + 1], &c__1, &c_b1, &b[k + b_dim1],
00594 ldb);
00595 clacgv_(nrhs, &b[k + b_dim1], ldb);
00596 }
00597 if (nounit) {
00598 cscal_(nrhs, &a[kc], &b[k + b_dim1], ldb);
00599 }
00600 kc = kc + *n - k + 1;
00601 ++k;
00602
00603
00604
00605 } else {
00606 kcnext = kc + *n - k + 1;
00607 if (k < *n - 1) {
00608
00609
00610
00611 kp = (i__1 = ipiv[k], abs(i__1));
00612 if (kp != k + 1) {
00613 cswap_(nrhs, &b[k + 1 + b_dim1], ldb, &b[kp + b_dim1],
00614 ldb);
00615 }
00616
00617
00618
00619 clacgv_(nrhs, &b[k + 1 + b_dim1], ldb);
00620 i__1 = *n - k - 1;
00621 cgemv_("Conjugate", &i__1, nrhs, &c_b1, &b[k + 2 + b_dim1]
00622 , ldb, &a[kcnext + 1], &c__1, &c_b1, &b[k + 1 +
00623 b_dim1], ldb);
00624 clacgv_(nrhs, &b[k + 1 + b_dim1], ldb);
00625
00626 clacgv_(nrhs, &b[k + b_dim1], ldb);
00627 i__1 = *n - k - 1;
00628 cgemv_("Conjugate", &i__1, nrhs, &c_b1, &b[k + 2 + b_dim1]
00629 , ldb, &a[kc + 2], &c__1, &c_b1, &b[k + b_dim1],
00630 ldb);
00631 clacgv_(nrhs, &b[k + b_dim1], ldb);
00632 }
00633
00634
00635
00636 if (nounit) {
00637 i__1 = kc;
00638 d11.r = a[i__1].r, d11.i = a[i__1].i;
00639 i__1 = kcnext;
00640 d22.r = a[i__1].r, d22.i = a[i__1].i;
00641 i__1 = kc + 1;
00642 d21.r = a[i__1].r, d21.i = a[i__1].i;
00643 r_cnjg(&q__1, &d21);
00644 d12.r = q__1.r, d12.i = q__1.i;
00645 i__1 = *nrhs;
00646 for (j = 1; j <= i__1; ++j) {
00647 i__2 = k + j * b_dim1;
00648 t1.r = b[i__2].r, t1.i = b[i__2].i;
00649 i__2 = k + 1 + j * b_dim1;
00650 t2.r = b[i__2].r, t2.i = b[i__2].i;
00651 i__2 = k + j * b_dim1;
00652 q__2.r = d11.r * t1.r - d11.i * t1.i, q__2.i = d11.r *
00653 t1.i + d11.i * t1.r;
00654 q__3.r = d12.r * t2.r - d12.i * t2.i, q__3.i = d12.r *
00655 t2.i + d12.i * t2.r;
00656 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00657 b[i__2].r = q__1.r, b[i__2].i = q__1.i;
00658 i__2 = k + 1 + j * b_dim1;
00659 q__2.r = d21.r * t1.r - d21.i * t1.i, q__2.i = d21.r *
00660 t1.i + d21.i * t1.r;
00661 q__3.r = d22.r * t2.r - d22.i * t2.i, q__3.i = d22.r *
00662 t2.i + d22.i * t2.r;
00663 q__1.r = q__2.r + q__3.r, q__1.i = q__2.i + q__3.i;
00664 b[i__2].r = q__1.r, b[i__2].i = q__1.i;
00665
00666 }
00667 }
00668 kc = kcnext + (*n - k);
00669 k += 2;
00670 }
00671 goto L100;
00672 L120:
00673 ;
00674 }
00675
00676 }
00677 return 0;
00678
00679
00680
00681 }