1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88
89
90
91
92
93
94
95
96
97
98
99
100
101
102
103
104
105
|
SUBROUTINE CRDRD2 (*,*,MU,INDCOM,N23)
C
C WRITE THE RIGID ROD ELEMENT ON THE RG FILE
C
C EXTERNAL ORF ,LSHIFT
C INTEGER ORF
INTEGER GEOMP ,BGPDT ,CSTM ,RGT ,SCR1 ,
1 BUF(20),MASK16 ,GPOINT ,Z(1) ,MCODE(2)
REAL RZ(1)
DOUBLE PRECISION INDTFM(9),DEPTFM(9),RODCOS(3),IDRCOS(3),
1 DDRCOS(3),
2 DZ(1) ,XD ,YD ,ZD ,RLNGTH ,CDEP
COMMON /ZZZZZZ/ Z
COMMON /GP4FIL/ GEOMP ,BGPDT ,CSTM ,RGT ,SCR1
COMMON /GP4PRM/ BUF ,BUF1 ,BUF2 ,BUF3 ,BUF4 ,KNKL1 ,
1 MASK16 ,NOGO ,GPOINT ,KN
EQUIVALENCE (Z(1) ,DZ(1)) ,(Z(1) ,RZ(1))
DATA MASK15 /32767/
C
C INDTFM = INDEPENDENT GRID POINT TRANSFORMATION MATRIX
C DEPTFM = DEPENDENT GRID POINT TRANSFORMATION MATRIX
C RODCOS = BASIC COSINES OF ROD ELEMENT
C IDRCOS = DIRECTION COSINES OF INDEPENDENT GRID POINT
C DDRCOS = DIRECTION COSINES OF DEPENDENT GRID POINT
C
C OBTAIN TRANSFORMATION MATRIX
C
IF (Z(KNKL1+3) .EQ. 0) GO TO 50
DO 10 I = 1,4
BUF(I) = Z(KNKL1+2+I)
10 CONTINUE
CALL TRANSD (BUF,INDTFM)
50 IF (Z(KNKL1+10) .EQ. 0) GO TO 70
DO 60 I = 1,4
BUF(I) = Z(KNKL1+9+I)
60 CONTINUE
CALL TRANSD (BUF,DEPTFM)
C
C COMPUTE THE LENGTH OF THE RIGID ROD ELEMENT
C
70 XD = RZ(KNKL1+11) - RZ(KNKL1+4)
YD = RZ(KNKL1+12) - RZ(KNKL1+5)
ZD = RZ(KNKL1+13) - RZ(KNKL1+6)
C
C CHECK TO SEE IF LENGTH OF ROD IS ZERO
C
IF (XD.EQ.0.0D0 .AND. YD.EQ.0.0D0 .AND. ZD.EQ.0.0D0) RETURN 1
RLNGTH = DSQRT(XD*XD + YD*YD + ZD*ZD)
C
C COMPUTE THE BASIC DIRECTION COSINES OF THE RIGID ROD ELEMENT
C
RODCOS (1) = XD/RLNGTH
RODCOS (2) = YD/RLNGTH
RODCOS (3) = ZD/RLNGTH
C
C OBTAIN THE DIRECTION COSINES ASSOCIATED WITH
C THE INDEPENDENT GRID POINT
C
IF (Z(KNKL1+3) .NE. 0) GO TO 100
DO 80 I = 1,3
IDRCOS(I) = RODCOS(I)
80 CONTINUE
GO TO 200
100 CALL GMMATD (RODCOS,1,3,0,INDTFM,3,3,0,IDRCOS)
C
C OBTAIN THE DIRECTION COSINES ASSOCIATED WITH
C THE DEPENDENT GRID POINT
C
200 IF (Z(KNKL1+10) .NE. 0) GO TO 300
DO 250 I = 1,3
DDRCOS(I) = RODCOS(I)
250 CONTINUE
GO TO 400
300 CALL GMMATD (RODCOS,1,3,0,DEPTFM,3,3,0,DDRCOS)
C
C DETERMINE THE DEPENDENT SIL AND THE CORRESPONDING COEFFICIENT
C
400 DO 500 I = 1,3
IF (INDCOM .NE. I) GO TO 500
IDEP = Z(KNKL1+6+I)
CDEP = RODCOS(I)
GO TO 600
500 CONTINUE
C
C CHECK TO SEE IF RIGID ROD IS PROPERLY DEFINED
C
600 IF (DABS(CDEP) .LT. 0.001D0) RETURN 2
MCODE(2) = IDEP
IF (IDEP .GT. MASK15) N23 = 3
DO 700 I = 1, 3
MCODE(1) = Z(KNKL1+I-1)
IF (MCODE(1) .GT. MASK15) N23 = 3
COEFF = -IDRCOS(I)/CDEP
CALL WRITE (RGT,MCODE,2,0)
CALL WRITE (RGT,COEFF,1,0)
MCODE(1) = Z(KNKL1+6+I)
IF (MCODE(1) .GT. MASK15) N23 = 3
COEFF = DDRCOS(I)/CDEP
CALL WRITE (RGT,MCODE,2,0)
CALL WRITE (RGT,COEFF,1,0)
700 CONTINUE
Z(MU) = IDEP
MU = MU - 1
RETURN
END
|
