Skip to content

Commit b215e99

Browse files
committed
minor code cleaning
1 parent 072f604 commit b215e99

File tree

1 file changed

+8
-4
lines changed

1 file changed

+8
-4
lines changed

src/estimator/mhe.jl

Lines changed: 8 additions & 4 deletions
Original file line numberDiff line numberDiff line change
@@ -1142,16 +1142,20 @@ function con_nonlinprog!(g, estim::MovingHorizonEstimator, ::SimModel, X̂, V̂)
11421142
estim.con.i_g[i] || continue
11431143
if i nX̂con
11441144
j = i
1145-
g[i] = j > nX̂ ? 0 : estim.con.X̂min[nX̂con-nX̂+j] - X̂[j]
1145+
jcon = nX̂con-nX̂+j
1146+
g[i] = j > nX̂ ? 0 : estim.con.X̂min[jcon] - X̂[j]
11461147
elseif i 2nX̂con
11471148
j = i - nX̂con
1148-
g[i] = j > nX̂ ? 0 : X̂[j] - estim.con.X̂max[nX̂con-nX̂+j]
1149+
jcon = nX̂con-nX̂+j
1150+
g[i] = j > nX̂ ? 0 : X̂[j] - estim.con.X̂max[jcon]
11491151
elseif i 2nX̂con + nV̂con
11501152
j = i - 2nX̂con
1151-
g[i] = j > nV̂ ? 0 : estim.con.V̂min[nV̂con-nV̂+j] - V̂[j]
1153+
jcon = nV̂con-nV̂+j
1154+
g[i] = j > nV̂ ? 0 : estim.con.V̂min[jcon] - V̂[j]
11521155
else
11531156
j = i - 2nX̂con - nV̂con
1154-
g[i] = j > nV̂ ? 0 : V̂[j] - estim.con.V̂max[nV̂con-nV̂+j]
1157+
jcon = nV̂con-nV̂+j
1158+
g[i] = j > nV̂ ? 0 : V̂[j] - estim.con.V̂max[jcon]
11551159
end
11561160
end
11571161
return g

0 commit comments

Comments
 (0)