34 SUBROUTINE lag_gjnt(GJBUFI ,GJBUFR ,X ,VR ,AR ,
35 2 IADLL ,LLL ,JLL ,SLL ,XLL ,
36 3 COMNTAG,LTSM ,ICFTAG ,JCFTAG ,MS ,
37 4 IN ,V ,A ,ISKIP ,NCF_S ,
42#include "implicit_f.inc"
54 INTEGER NC,ISKIP,NCF_S,
55 . LLL(*),JLL(*),SLL(*),IADLL(*),GJBUFI(LKJNI,*),
56 . COMNTAG(*),ICFTAG(*),JCFTAG(*)
58 . gjbufr(lkjnr,*),ltsm(6,*),xll(*),ms(*),in(*),
59 . x(3,*),v(3,*),a(3,*),vr(3,*),ar(3,*)
63 INTEGER I,IC,NC_INI,NCL,
65 . (3),DVR(3),(3),P(9),L1(3),L2(3),L3(3),, DTD
75 vrn(1) = vr(1,n0) + dt12*ar(1,n0)
76 vrn(2) = vr(2,n0) + dt12*ar(2,n0)
77 vrn(3) = vr(3,n0) + dt12*ar(3,n0)
78 vl(1) = gjbufr( 2,i)*vr(1,n0)
79 . +gjbufr( 3,i)*vr(2,n0)
80 . +gjbufr( 4,i)*vr(3,n0)
81 vl(2) = gjbufr( 5,i)*vr(1,n0)
82 . +gjbufr( 6,i)*vr(2,n0)
83 . +gjbufr( 7,i)*vr(3,n0)
84 vl(3) = gjbufr( 8,i)*vr(1,n0)
85 . +gjbufr( 9,i)*vr(2,n0)
86 . +gjbufr(10,i)*vr(3,n0)
87 CALL rotbmr (vl ,gjbufr(2,i) ,dt1)
89 dvr(1) = dt12*ar(1,n0)
90 dvr(2) = dt12*ar(2,n0)
91 dvr(3) = dt12*ar(3,n0)
101 vl(1)=gjbufr(2,i)*vrn(1)+gjbufr(3,i)*vrn(2)+gjbufr(4,i)*vrn(3)
102 vl(2)=gjbufr(5,i)*vrn(1)+gjbufr(6,i)*vrn(2)+gjbufr(7,i)*vrn(3)
103 vl(3)=gjbufr(8,i)*vrn(1)+gjbufr(9,i)*vrn(2)+gjbufr(10,i)*vrn(3)
104 vl(1)=p(1)*dvr(1)+p(2)*dvr(2)+p(3)*dvr(3)
105 vl(2)=p(4)*dvr(1)+p(5)*dvr(2)+p(6)*dvr(3)
106 vl(3)=p(7)*dvr(1)+p(8)*dvr(2)+p(9)*dvr(3)
119 IF (comntag(n0)>1) comflag = 1
120 IF (comntag(n1)>1) comflag = 1
121 IF (comntag(n2)>1) comflag = 1
126 2 iadll ,lll ,jll ,sll ,xll ,
128 ELSEIF (jtyp==2)
THEN
129 IF (comntag(n3)>1) comflag = 1
135 2 iadll ,lll ,jll ,sll ,xll ,
136 3 x ,n0 ,n1 ,n2 ,n3 ,
138 ELSEIF (jtyp==3)
THEN
141 2 iadll ,lll ,jll ,sll ,xll ,
157 icftag(ic) = ic + iskip
158 jcftag(ic+iskip) = nc_ini + k
subroutine gjnt_diff(sk, l1, l2, l3, alpha, iadll, lll, jll, sll, xll, x, n0, n1, n2, n3, nc)
subroutine gjnt_gear(sk, l1, l2, alpha, x, iadll, lll, jll, sll, xll, n0, n1, n2, nc)
subroutine gjnt_rack(sk, l1, l2, alpha, x, iadll, lll, jll, sll, xll, n0, n1, n2, nc)
subroutine lag_gjnt(gjbufi, gjbufr, x, vr, ar, iadll, lll, jll, sll, xll, comntag, ltsm, icftag, jcftag, ms, in, v, a, iskip, ncf_s, nc)