OpenRadioss 2025.1.11
OpenRadioss project
Loading...
Searching...
No Matches
s6cortho3.F File Reference
#include "implicit_f.inc"
#include "mvsiz_p.inc"

Go to the source code of this file.

Functions/Subroutines

subroutine s6cortho3 (x1, x2, x3, x4, x5, x6, y1, y2, y3, y4, y5, y6, z1, z2, z3, z4, z5, z6, e1x, e2x, e3x, e1y, e2y, e3y, e1z, e2z, e3z, rx, ry, rz, sx, sy, sz, tx, ty, tz, nel)

Function/Subroutine Documentation

◆ s6cortho3()

subroutine s6cortho3 ( dimension(mvsiz) x1,
dimension(mvsiz) x2,
dimension(mvsiz) x3,
dimension(mvsiz) x4,
dimension(mvsiz) x5,
dimension(mvsiz) x6,
dimension(mvsiz) y1,
dimension(mvsiz) y2,
dimension(mvsiz) y3,
dimension(mvsiz) y4,
dimension(mvsiz) y5,
dimension(mvsiz) y6,
dimension(mvsiz) z1,
dimension(mvsiz) z2,
dimension(mvsiz) z3,
dimension(mvsiz) z4,
dimension(mvsiz) z5,
dimension(mvsiz) z6,
dimension(mvsiz) e1x,
dimension(mvsiz) e2x,
dimension(mvsiz) e3x,
dimension(mvsiz) e1y,
dimension(mvsiz) e2y,
dimension(mvsiz) e3y,
dimension(mvsiz) e1z,
dimension(mvsiz) e2z,
dimension(mvsiz) e3z,
dimension(mvsiz) rx,
dimension(mvsiz) ry,
dimension(mvsiz) rz,
dimension(mvsiz) sx,
dimension(mvsiz) sy,
dimension(mvsiz) sz,
dimension(mvsiz) tx,
dimension(mvsiz) ty,
dimension(mvsiz) tz,
integer, intent(in) nel )

Definition at line 29 of file s6cortho3.F.

40C-----------------------------------------------
41C I m p l i c i t T y p e s
42C-----------------------------------------------
43#include "implicit_f.inc"
44C-----------------------------------------------
45C G l o b a l P a r a m e t e r s
46C-----------------------------------------------
47#include "mvsiz_p.inc"
48C-----------------------------------------------
49C D u m m y A r g u m e n t s
50C-----------------------------------------------
51 INTEGER, INTENT(IN) :: NEL
52C REAL
53 my_real, INTENT(IN), DIMENSION(MVSIZ) ::
54 . x1, x2, x3, x4, x5, x6,
55 . y1, y2, y3, y4, y5, y6,
56 . z1, z2, z3, z4, z5, z6
57 my_real, INTENT(OUT), DIMENSION(MVSIZ) ::
58 . rx, ry, rz, sx, sy, sz, tx, ty, tz,
59 . e1x, e1y, e1z, e2x, e2y, e2z, e3x, e3y, e3z
60C-----------------------------------------------
61C C o m m o n B l o c k s
62C-----------------------------------------------
63C-----------------------------------------------
64C L o c a l V a r i a b l e s
65C-----------------------------------------------
66 INTEGER I
67C REAL
69 . x14 ,y14 , z14
71 . det,c1,c2
72C-----------------------------------------------
73 DO i=1,nel
74 x14=x1(i)+x4(i)
75 y14=y1(i)+y4(i)
76 z14=z1(i)+z4(i)
77C--------ksi---------
78 tx(i)=x2(i)+x5(i)-x14
79 ty(i)=y2(i)+y5(i)-y14
80 tz(i)=z2(i)+z5(i)-z14
81C--------eta---------
82 rx(i)=x3(i)+x6(i)-x14
83 ry(i)=y3(i)+y6(i)-y14
84 rz(i)=z3(i)+z6(i)-z14
85 ENDDO
86 DO i=1,nel
87 sx(i)= (x4(i)+x5(i)+x6(i)-x1(i)-x2(i)-x3(i))*third
88 sy(i)= (y4(i)+y5(i)+y6(i)-y1(i)-y2(i)-y3(i))*third
89 sz(i)= (z4(i)+z5(i)+z6(i)-z1(i)-z2(i)-z3(i))*third
90 ENDDO
91c~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
92 DO 100 i=1,nel
93C
94 e3x(i) = ty(i) * rz(i) - tz(i) * ry(i)
95 e3y(i) = tz(i) * rx(i) - tx(i) * rz(i)
96 e3z(i) = tx(i) * ry(i) - ty(i) * rx(i)
97C
98 det = sqrt(e3x(i)*e3x(i) + e3y(i)*e3y(i) + e3z(i)*e3z(i))
99 IF ( det/=zero) det = one / det
100 e3x(i) = e3x(i) * det
101 e3y(i) = e3y(i) * det
102 e3z(i) = e3z(i) * det
103C
104 c1=sqrt(tx(i)*tx(i)+ty(i)*ty(i)+tz(i)*tz(i))
105 c2=sqrt(rx(i)*rx(i)+ry(i)*ry(i)+rz(i)*rz(i))
106 e1x(i)=tx(i)*c2 +(ry(i) * e3z(i) - rz(i) * e3y(i))*c1
107 e1y(i)=ty(i)*c2 +(rz(i) * e3x(i) - rx(i) * e3z(i))*c1
108 e1z(i)=tz(i)*c2 +(rx(i) * e3y(i) - ry(i) * e3x(i))*c1
109 det = sqrt(e1x(i)*e1x(i) + e1y(i)*e1y(i) + e1z(i)*e1z(i))
110 IF ( det/=zero) det = one / det
111 e1x(i) = e1x(i)*det
112 e1y(i) = e1y(i)*det
113 e1z(i) = e1z(i)*det
114C
115 e2x(i) = e3y(i) * e1z(i) - e3z(i) * e1y(i)
116 e2y(i) = e3z(i) * e1x(i) - e3x(i) * e1z(i)
117 e2z(i) = e3x(i) * e1y(i) - e3y(i) * e1x(i)
118 100 CONTINUE
119c~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~~
120 RETURN
#define my_real
Definition cppsort.cpp:32