1 |
C $Header: /u/gcmpack/MITgcm/model/src/solve_tridiagonal.F,v 1.1 2004/01/03 00:41:55 jmc Exp $ |
2 |
C $Name: $ |
3 |
|
4 |
#include "CPP_OPTIONS.h" |
5 |
|
6 |
CBOP |
7 |
C !ROUTINE: SOLVE_TRIDIAGONAL |
8 |
C !INTERFACE: |
9 |
SUBROUTINE SOLVE_TRIDIAGONAL( |
10 |
I iMin,iMax, jMin,jMax, |
11 |
I a3d, b3d, c3d, |
12 |
U y3d, |
13 |
O errCode, |
14 |
I bi, bj, myThid ) |
15 |
C !DESCRIPTION: \bv |
16 |
C *==========================================================* |
17 |
C | S/R SOLVE_TRIDIAGONAL |
18 |
C | o Solve a tri-diagonal system A*X=Y (dimension Nr) |
19 |
C *==========================================================* |
20 |
C | o Used to solve implicitly vertical advection & diffusion |
21 |
C *==========================================================* |
22 |
C \ev |
23 |
|
24 |
C !USES: |
25 |
IMPLICIT NONE |
26 |
C == Global data == |
27 |
#include "SIZE.h" |
28 |
#include "EEPARAMS.h" |
29 |
|
30 |
C !INPUT/OUTPUT PARAMETERS: |
31 |
C == Routine Arguments == |
32 |
C a3d :: matrix lower diagnonal |
33 |
C b3d :: matrix main diagnonal |
34 |
C c3d :: matrix upper diagnonal |
35 |
C y3d :: Input = Y vector ; Output = X = solution of A*X=Y |
36 |
C errCode :: > 0 if singular matrix |
37 |
INTEGER iMin,iMax,jMin,jMax |
38 |
_RL a3d(1-Olx:sNx+Olx,1-Oly:sNy+Oly,Nr) |
39 |
_RL b3d(1-Olx:sNx+Olx,1-Oly:sNy+Oly,Nr) |
40 |
_RL c3d(1-Olx:sNx+Olx,1-Oly:sNy+Oly,Nr) |
41 |
_RL y3d(1-Olx:sNx+Olx,1-Oly:sNy+Oly,Nr,nSx,nSy) |
42 |
INTEGER errCode |
43 |
INTEGER bi, bj, myThid |
44 |
|
45 |
C !LOCAL VARIABLES: |
46 |
C == Local variables == |
47 |
INTEGER i,j,k |
48 |
_RL bet(1-Olx:sNx+Olx,1-Oly:sNy+Oly,Nr) |
49 |
_RL tmpvar |
50 |
CEOP |
51 |
|
52 |
errCode = 0 |
53 |
|
54 |
C-- Beginning of forward sweep (top level) |
55 |
DO j=jMin,jMax |
56 |
DO i=iMin,iMax |
57 |
IF ( b3d(i,j,1).NE.0. _d 0 ) THEN |
58 |
bet(i,j,1) = 1. _d 0 / b3d(i,j,1) |
59 |
ELSE |
60 |
bet(i,j,1) = 0. _d 0 |
61 |
errCode = 1 |
62 |
ENDIF |
63 |
ENDDO |
64 |
ENDDO |
65 |
|
66 |
C-- Middle of forward sweep |
67 |
DO k=2,Nr |
68 |
DO j=jMin,jMax |
69 |
DO i=iMin,iMax |
70 |
tmpvar = b3d(i,j,k) - a3d(i,j,k)*c3d(i,j,k-1)*bet(i,j,k-1) |
71 |
IF ( tmpvar .NE. 0. _d 0 ) THEN |
72 |
bet(i,j,k) = 1. _d 0 / tmpvar |
73 |
ELSE |
74 |
bet(i,j,k) = 0. _d 0 |
75 |
errCode = 1 |
76 |
ENDIF |
77 |
ENDDO |
78 |
ENDDO |
79 |
ENDDO |
80 |
|
81 |
DO j=jMin,jMax |
82 |
DO i=iMin,iMax |
83 |
y3d(i,j,1,bi,bj) = y3d(i,j,1,bi,bj)*bet(i,j,1) |
84 |
ENDDO |
85 |
ENDDO |
86 |
DO k=2,Nr |
87 |
DO j=jMin,jMax |
88 |
DO i=iMin,iMax |
89 |
y3d(i,j,k,bi,bj) = ( y3d(i,j,k,bi,bj) |
90 |
& - a3d(i,j,k)*y3d(i,j,k-1,bi,bj) |
91 |
& )*bet(i,j,k) |
92 |
ENDDO |
93 |
ENDDO |
94 |
ENDDO |
95 |
|
96 |
C-- Backward sweep |
97 |
CADJ loop = sequential |
98 |
DO k=Nr-1,1,-1 |
99 |
DO j=jMin,jMax |
100 |
DO i=iMin,iMax |
101 |
y3d(i,j,k,bi,bj) = y3d(i,j,k,bi,bj) |
102 |
& - c3d(i,j,k)*bet(i,j,k)*y3d(i,j,k+1,bi,bj) |
103 |
ENDDO |
104 |
ENDDO |
105 |
ENDDO |
106 |
|
107 |
RETURN |
108 |
END |