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
|
subroutine forblk(flag,nevprt,t,xd,x,nx,z,nz,tvec,ntvec,
& rpar,nrpar,ipar,nipar,u,nu,y,ny)
c Copyright INRIA
c Scicos block simulator
c For block
c
double precision t,xd(*),x(*),z(*),tvec(*),rpar(*),u(*),y(*)
integer flag,nevprt,nx,nz,ntvec,nrpar,ipar(*)
integer nipar,nu,ny
c
common /dbcos/ idb
double precision atol,rtol,ttol,deltat
common /costol/ atol,rtol,ttol,deltat
c
if(idb.eq.1) then
write(6,'(''For t='',e10.3,'' flag='',i1)') t,flag
endif
c
if(flag.eq.3) then
if(nevprt.eq.1) then
z(2)=u(1)
z(1)=1.d0
c
if(u(1).ge.1) then
tvec(1)=t-1.d0
tvec(2)=t+ttol/2.0d0
else
tvec(1)=t-1.d0
tvec(2)=t-1.d0
endif
else
z(1)=z(1)+1.d0
c
if(z(1).ge.z(2)) then
tvec(1)=t+ttol/2.0d0
tvec(2)=t-1.d0
else
tvec(1)=t-1.d0
tvec(2)=t+ttol/2.0d0
endif
endif
endif
if(flag.eq.1.or.flag.eq.3) then
y(1)=z(1)
endif
end
|
