Measurement equations
Measurement equations
u
fp
=
i
f
T
s
p
i
f
: rotation,
s
p
: position
v
fp
=
j
f
T
s
p
Stack them up…
W
=
R S
R
= (
i
1
,…,
i
F
,
j
1
,…,
j
F
)
T
S
= (
s
1
,…,
s
P
)