#include <kalman_filter.h>
Definition at line 28 of file kalman_filter.h.
Public Member Functions | |
| vgl_point_2d< double > | get_cur_epipole () const |
| get backprojection for debugging. | |
| vcl_vector< vnl_matrix< double > > | get_back_projection () const |
| vnl_matrix< double > | get_predicted_curve () |
| predict next curve. | |
| vnl_double_3 | get_next_motion (vnl_double_3 v) |
| vcl_vector< vgl_point_2d< double > > | get_pre_observes () |
| vcl_vector< vgl_point_2d< double > > | get_cur_observes () |
| vcl_vector< vgl_point_2d< double > > | get_next_observes () |
| vcl_vector< vgl_point_3d< double > > | get_local_pts () |
| bugl_curve_3d | get_curve_3d () |
| void | read_data (const char *fname) |
| read all the data including time stampes, trackers. | |
| vcl_vector< vdgl_digital_curve_sptr > | read_tracker_file (char *fname) |
| read vishual tracker result out of a file. | |
| void | init () |
| initialize the kalman filter states. | |
| void | init_epipole (double x, double y) |
| void | inc () |
| vnl_double_2 | projection (const vnl_double_3x4 &P, const vnl_double_3 &X) |
| kalman_filter () | |
| constructors. | |
| kalman_filter (const char *fname) | |
| virtual | ~kalman_filter () |
Protected Member Functions | |
| vcl_vector< double > | read_timestamp_file (char *fname) |
| read time stamp. | |
| double | matched_point_prob (vnl_double_2 &z, vnl_double_2 &z_pred) |
| if the zero probability returned, the matched point is a outlier. | |
| vnl_matrix_fixed< double, 6, 6 > | get_transit_matrix (int i, int j) |
| get time interval from ith frame to j-th frame. | |
| void | update_confidence () |
| update the confidence for each 3d point. | |
| void | update_observes (const vnl_double_3x4 &P, int iframe) |
| update the matched points in the next frame using closest neighbour. | |
| void | init_velocity () |
| vnl_matrix_fixed< double, 2, 6 > | get_H_matrix (vnl_double_3x4 &P, vnl_double_3 &Y) |
| set linearized observation matrix. | |
| vnl_double_3x4 | get_projective_matrix (const vnl_double_3 &v) const |
| compute projective matrix from predicted position. | |
| void | init_covariant_matrix () |
| void | init_cam_intrinsic () |
| void | init_state_3d_estimation () |
| void | init_transit_matrix () |
Private Attributes | |
| bugl_curve_3d | curve_3d_ |
| position and confidence of feature samples. | |
| vcl_vector< double > | prob_ |
| vcl_vector< vcl_vector< bugl_gaussian_point_2d< double > > > | observes_ |
| used for matching point. | |
| vcl_vector< double > | time_tick_ |
| each element represents shooting times for this frame. | |
| vcl_vector< vcl_vector< vdgl_digital_curve_sptr > > | trackers_ |
| each element of the vector represents a projection of the same 3D curves. | |
| vcl_vector< vnl_double_3 > | motions_ |
| int | cur_pos_ |
| current frame position in history pool. | |
| int | queue_size_ |
| int | num_points_ |
| int | memory_size_ |
| how much the queue has been used. | |
| vnl_vector_fixed< double, 6 > | X_ |
| state vector. | |
| vnl_matrix_fixed< double, 6, 6 > | Q_ |
| covariant matrix of state vector. | |
| vnl_matrix_fixed< double, 6, 2 > | G_ |
| constraint kalman gain matrix. | |
| vnl_matrix_fixed< double, 2, 2 > | R_ |
| initial covariant matrix of state vector. | |
| vnl_matrix_fixed< double, 6, 6 > | Q0_ |
| covariant matrix of 2D projection. | |
| vnl_double_2 * | e_ |
| initial epipole. | |
| vnl_double_3x3 | K_ |
| camera intrinsic parameters. | |
Static Private Attributes | |
| static const double | large_num_ |
| used to denote outlier point in image. | |
|
|
constructors.
|
|
|
|
|
|
|
|
|
|
|
|
get backprojection for debugging.
|
|
|
|
|
|
|
|
||||||||||||
|
set linearized observation matrix.
|
|
|
|
|
|
|
|
|
|
|
|
|
|
|
predict next curve.
|
|
|
compute projective matrix from predicted position.
|
|
||||||||||||
|
get time interval from ith frame to j-th frame.
|
|
|
|
|
|
initialize the kalman filter states.
|
|
|
|
|
|
|
|
||||||||||||
|
|
|
|
|
|
|
|
|
|
|
|
||||||||||||
|
if the zero probability returned, the matched point is a outlier.
|
|
||||||||||||
|
|
|
|
read all the data including time stampes, trackers.
|
|
|
read time stamp.
|
|
|
read vishual tracker result out of a file.
|
|
|
update the confidence for each 3d point.
|
|
||||||||||||
|
update the matched points in the next frame using closest neighbour.
|
|
|
current frame position in history pool.
Definition at line 107 of file kalman_filter.h. |
|
|
position and confidence of feature samples.
Definition at line 93 of file kalman_filter.h. |
|
|
initial epipole.
Definition at line 130 of file kalman_filter.h. |
|
|
constraint kalman gain matrix.
Definition at line 121 of file kalman_filter.h. |
|
|
camera intrinsic parameters.
Definition at line 133 of file kalman_filter.h. |
|
|
used to denote outlier point in image.
Definition at line 136 of file kalman_filter.h. |
|
|
how much the queue has been used.
Definition at line 112 of file kalman_filter.h. |
|
|
Definition at line 105 of file kalman_filter.h. |
|
|
Definition at line 109 of file kalman_filter.h. |
|
|
used for matching point.
Definition at line 98 of file kalman_filter.h. |
|
|
Definition at line 95 of file kalman_filter.h. |
|
|
covariant matrix of 2D projection.
Definition at line 127 of file kalman_filter.h. |
|
|
covariant matrix of state vector.
Definition at line 118 of file kalman_filter.h. |
|
|
Definition at line 108 of file kalman_filter.h. |
|
|
initial covariant matrix of state vector.
Definition at line 124 of file kalman_filter.h. |
|
|
each element represents shooting times for this frame.
Definition at line 101 of file kalman_filter.h. |
|
|
each element of the vector represents a projection of the same 3D curves.
Definition at line 103 of file kalman_filter.h. |
|
|
state vector.
Definition at line 115 of file kalman_filter.h. |
1.4.4