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
|
function [state0,state,sim]=modipar(newparameters,state0,state,sim,scs_m,cor)
//store modified parameters in compiled structure state,sim
//newparameters gives modified blocks numbers in original structure scs_m
//cor is the correspondance table from original structure to compiled one
// Copyright INRIA
xptr=sim('xptr')
zptr=sim('zptr')
izptr=sim('izptr')
rpptr=sim('rpptr')
ipptr=sim('ipptr')
ipar=sim('ipar')
rpar=sim('rpar')
[st,dst]=state(['x','z'])
[st0,dst0]=state0(['x','z'])
nb=prod(size(rpptr))-1
for k=newparameters
if prod(size(k))==1 then //parameter of a simple block
[fun,statek,dstatek,rpark,ipark]=scs_m(k)(3)([1 6:9]);
if type(fun)==15 then
if fun(2)==3 then
rpark=var2vec(rpark),
dstatek=var2vec(dstatek),
end
end
kc=cor(k) //index of modified block in compiled structure
else //parameter of a super block
kc=get_tree_elt(cor,k); //index of the modified sub_block in compiled structure
nk=size(k,2)
o=scs_m(get_subobj_path(k))
[fun,statek,dstatek,rpark,ipark]=o(3)([1 6:9])
if type(fun)==15 then
if fun(2)==3 then
rpark=var2vec(rpark),
dstatek=var2vec(dstatek),
end
end
end
if kc>0 then
//Change continuuous state
nek=prod(size(statek))-(xptr(kc+1)-xptr(kc))
if nek<>0&kc<>nb then
st(nek+(xptr(kc+1)-1:xptr($)-1))=st((xptr(kc+1)-1:xptr($)-1))
st0(nek+(xptr(kc+1)-1:xptr($)-1))=st0((xptr(kc+1)-1:xptr($)-1))
end
xptr(kc+1:$)=xptr(kc+1:$)+nek
st(xptr(kc):xptr(kc+1)-1)=statek,
st0(xptr(kc):xptr(kc+1)-1)=statek,
//Change discrete state
nek=prod(size(dstatek))-(zptr(kc+1)-zptr(kc))
if nek<>0&kc<>nb then
dst(nek+(zptr(kc+1)-1:zptr($)-1))=dst((zptr(kc+1)-1:zptr($)-1))
dst0(nek+(zptr(kc+1)-1:zptr($)-1))=dst0((zptr(kc+1)-1:zptr($)-1))
end
zptr(kc+1:$)=zptr(kc+1:$)+nek
dst(zptr(kc):zptr(kc+1)-1)=dstatek,
dst0(zptr(kc):zptr(kc+1)-1)=dstatek,
//Change real parameters
nek=prod(size(rpark))-(rpptr(kc+1)-rpptr(kc))
if nek<>0&kc<>nb then
rpar(nek+(rpptr(kc+1)-1:rpptr($)-1))=rpar((rpptr(kc+1)-1:rpptr($)-1))
end
rpptr(kc+1:$)=rpptr(kc+1:$)+nek
rpar(rpptr(kc):rpptr(kc+1)-1)=rpark,
//Change integer parameters
nek=prod(size(ipark))-(ipptr(kc+1)-ipptr(kc))
if nek<>0&kc<>nb then
ipar(nek+(ipptr(kc+1)-1:ipptr($)-1))=ipar((ipptr(kc+1)-1:ipptr($)-1))
end
ipptr(kc+1:$)=ipptr(kc+1:$)+nek
ipar(ipptr(kc):ipptr(kc+1)-1)=ipark,
end
end
sim('xptr')=xptr
sim('zptr')=zptr
sim('izptr')=izptr
sim('rpar')=rpar;
sim('rpptr')=rpptr;
sim('ipar')=ipar;
sim('ipptr')=ipptr
state('x')=st
state('z')=dst
state0('x')=st0
state0('z')=dst0
|
