80 setDim(4, 1, 2, 2, 2);
91 A(1,2) = Period - Period*Period*Bfriction/Mass*x(2);
96 A(2,2) = 1 - 2*Period*Bfriction/Mass*x(2);
101 A(3,2) = Period*Period*Portance/Mass*x(2);
106 A(4,2) = 2*Period*Portance/Mass*x(2);
126 Q(1,2) = 0.01*0.01/10.0;
127 Q(2,1) = 0.01*0.01/10.0;
133 H(1,1) = -x(3)/(x(1)*x(1)+x(3)*x(3));
135 H(1,3) = x(1)/(x(1)*x(1)+x(3)*x(3));
138 H(2,1) = x(1)/sqrt(x(1)*x(1)+x(3)*x(3));
140 H(2,3) = x(3)/sqrt(x(1)*x(1)+x(3)*x(3));
163 x_(1) = x(1) + x(2)*Period + (Period*Period)/2*(u(1)/Mass - Bfriction/Mass*x(2)*x(2));
164 x_(2) = x(2) + (u(1)/Mass - Bfriction/Mass*x(2)*x(2))*Period;
165 x_(3) = x(3) + x(4)*Period + (Period*Period)/2*(Portance/Mass*x(2)*x(2)-Gravity);
166 x_(4) = x(4) + (Portance/Mass*x(2)*x(2)-Gravity)*Period;
172 z(1)=atan2(x(3), x(1));
173 z(2)=sqrt(x(1)*x(1)+x(3)*x(3));
void makeA()
Virtual creator of A.
void makeR()
Virtual creator of R.
void makeW()
Virtual creator of W.
void makeQ()
Virtual creator of Q.
void swap(KVector &v)
Constant-time swap function between two vectors.
void makeH()
Virtual creator of H.
void makeV()
Virtual creator of V.
void makeProcess()
Actual process . Fills in new x by using old x.
void makeMeasure()
Actual measurement function . Fills in z.