iCub-main
|
Go to the source code of this file.
Functions | |
exp (-x3 *T)] | |
zeros (2, 2) eye(2 | |
Variables | |
function [xhat, yhat, F, H] | |
x2 =sym('x2') | |
x3 =sym('x3') | |
x4 =sym('x4') | |
T =0.01 | |
Ad =[1 (1-exp(-x3*T))/x3 | |
Bd =x4*[(exp(-x3*T)+x3*T-1)/(x3*x3) | |
A_aug =[Ad zeros(2,2) | |
B_aug =[Bd | |
C_aug =[1 0 0 0] | |
x =[x1 | |
f =A_aug*x+B_aug*u_1 | |
h =C_aug*x | |
F =jacobian(f,x) | |
H =jacobian(h,x) | |
x1 =subs(x1,xhat_1(1)) | |
xhat =subs(f) | |
yhat =subs(h) | |
exp | ( | -x3 * | T | ) |
zeros | ( | 2 | , |
2 | |||
) |
Definition at line 17 of file compute_ekf_sym.m.
B_aug =[Bd |
Definition at line 18 of file compute_ekf_sym.m.
C_aug =[1 0 0 0] |
Definition at line 19 of file compute_ekf_sym.m.
Definition at line 25 of file compute_ekf_sym.m.
Definition at line 1 of file compute_ekf_sym.m.
Definition at line 23 of file compute_ekf_sym.m.
Definition at line 26 of file compute_ekf_sym.m.
T =0.01 |
Definition at line 12 of file compute_ekf_sym.m.
new axes x =[x1 |
Definition at line 21 of file compute_ekf_sym.m.
x1 =subs(x1,xhat_1(1)) |
Definition at line 28 of file compute_ekf_sym.m.
x2 =sym('x2') |
Definition at line 9 of file compute_ekf_sym.m.
x3 =sym('x3') |
Definition at line 10 of file compute_ekf_sym.m.
x4 =sym('x4') |
Definition at line 11 of file compute_ekf_sym.m.
xhat =subs(f) |
Definition at line 33 of file compute_ekf_sym.m.
yhat =subs(h) |
Definition at line 34 of file compute_ekf_sym.m.