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
|
subroutine tcsltj(flag,nevprt,t,xd,x,nx,z,nz,tvec,ntvec,
& rpar,nrpar,ipar,nipar,u2,nu2,y,ny)
c Copyright INRIA
c Scicos block simulator
c continuous state space linear system simulator
c rpar(1:nx*nx)=A
c rpar(nx*nx+1:nx*nx+nx*nu)=B
c rpar(nx*nx+nx*nu+1:nx*nx+nx*nu+nx*ny)=C
c rpar(nx*nx+nx*nu+nx*ny+1:nx*nx+nx*nu+nx*ny+ny*nu)=D
c!
c
double precision t,xd(*),x(*),z(*),tvec(*),rpar(*)
double precision u2(*),y(*)
integer flag,nevprt,nx,nz,ntvec,nrpar,ipar(*)
integer nipar,nu2,ny
common /dbcos/ idb
c
if(idb.eq.1) then
write(6,'(''Tcsltj t='',e10.3,'' flag='',i1)') t,flag
endif
la=1
lb=nx*nx+la
lc=lb
if(flag.eq.1.or.flag.eq.6) then
c y=c*x
call dmmul(rpar(lc),ny,x,nx,y,ny,ny,nx,1)
elseif(flag.eq.2.and.nevprt.eq.1) then
c x+=u2
call dcopy(nx,u2,1,x,1)
elseif(flag.eq.0.and.nevprt.eq.0) then
c xd=a*x
call dmmul(rpar(la),nx,x,nx,xd,nx,nx,nx,1)
endif
return
end
|
