Age | Commit message (Collapse) | Author |
|
types.h contains all of the type definitions, they were moved out of
main.h because I couldn't successfully compile that way.
|
|
|
|
|
|
|
|
This is a method for computing S for an independent measurement. It can
provide a speed improvement over computing a full, correlated S, but may
reduce quality if correlated measurements are treated as independent.
|
|
The motion model is broken into two parts, the creation of the L matrix
and the state update. This means that ydot can be computed from the
state object for many features at once, saving computation time.
|
|
Used a slightly simplified expression to compute pib0. Replaced the
Householder Transform with quaternion based reflection (untested).
|
|
|
|
|
|
|
|
Rather than maintain X and P in the main function they are moved into
the body and state classes, respectively. This will become much more
important when features are added and the accounting becomes more
complicated.
|
|
|
|
|
|
The State class contains the body and feature classes. It is responsible
for composing matrices, and performing Kalman updates.
|
|
The position and velocity covariances are rotated into the correct
frames: NED and FRD.
|
|
The new coordinates frame for the world and the body correspond to
Junho's code and work well in other versions of this code.
|
|
The coordinates are not working correctly. When I run integration on a
known dataset the body seems to turn in the opposite direction of
reality. It's probably best to change it to NED and FRD. Currenty it is
ENU and RFU.
|
|
|
|
Sensor inputs can be read in from stdin if compiled without USE_ROS.
Now "callback" functions can be written.
|