blob: 96e0a8941fe5a7ca31efc0d7b761699329be0147 (
plain)
1
2
3
4
5
6
7
8
9
10
|
Modify body Jacobian F. Junho has an identity in the db/db term, which is not
consistent with the handling of X and V.
Update covariance based on known estimate (GPS aided)
Dynamically adjusted state size. We can add and delete features as needed.
Junho's code requires a fixed state size.
Treat measurements as independent. Compute S_i individually for each measurement
and compose S as block diagonal for speed improvement.
|