Incremental rotation update
1.
Small angle approximation
Δ
R
=
I
+ sin
θ
[
n
]
+ (1- cos
θ
) [
n
]
2
≈
θ
[
n
]
= [
ω
]
linear in
ω
2.
Update original
R
matrix
R
←
R
Δ
R