blob: 096ee7d0d09d9cbb38789db0b6f95d68431e5791 (
plain)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
|
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.
Use quaternion reflection instead of Householder Transformation for determining
the predicted reflection measurement.
Below here is not yet implemented:
Add initial reflection view.
|
