- fixed ys calculation

git-svn-id: http://moon:8086/svn/matlab/trunk@121 801c6759-fa7c-4059-a304-17956f83a07c
2019-03-31 11:27:41 +00:00
parent 09630a8ed9
commit 4f18293ec4
1 changed files with 3 additions and 3 deletions
@@ -103,13 +103,13 @@ else
 		% -----------------------
 		%y = sin(2*pi*i/200)
 		%ys = cos(2*pi*i/200)
-		ys = (Y(1) - y)/dt;
+		dy = dy + 0.00;
 		y = y + dy;
-		dy = dy + 0.0
+		ys = (y - Y(1))/dt;
 		% -----------------------

 		Z = variance*randn(size(Z))/sqrt(12);
-		Y = C*[y ys]' + Z;
+		Y = C*[y ys]'  + Z;
 		
 		% Update process matrix P and state matrix X
 		I = eye(length(K));