Nonholonomic constant velocity motion model. More...
#include <motion_model.h>
Public Member Functions | |
constant_velocity_nh (double _l, double _dt, scan_matching_method _method) | |
Constructor. | |
void | updateDt (double _dt) |
Update the iteration interval. | |
Public Attributes | |
double | dt |
Iteration interval. | |
double | l |
Wheel base of the nonholonomic vehicle. | |
Protected Member Functions | |
void | makeA () |
Make the process Jacobian matrix. | |
void | makeH () |
Make measurement sensitivity matrix. | |
void | makeMeasure () |
Make measurement, used when measurement is not possible (i'm not using it now). | |
void | makeProcess () |
Make process, model iteration. | |
void | makeQ () |
Make process noise covariance matrix. | |
void | makeR () |
Make measurement noise covariance matrix. | |
void | makeV () |
Make measurement noise sensitivity matrix. | |
void | makeW () |
Make process noise sensitivity matrix. | |
Protected Attributes | |
scan_matching_method | method |
Scan matching method used, this will influence the errors. |
Nonholonomic constant velocity motion model.
Extended Kalman Filter using a nonholonomic constant velocity motion model, by other works a simplistic non-linear car model.
Definition at line 47 of file motion_model.h.
constant_velocity_nh::constant_velocity_nh | ( | double | _l, | |
double | _dt, | |||
scan_matching_method | _method | |||
) |
Constructor.
Definition at line 34 of file motion_model.cpp.
void constant_velocity_nh::makeA | ( | ) | [protected] |
Make the process Jacobian matrix.
Definition at line 71 of file motion_model.cpp.
void constant_velocity_nh::makeH | ( | ) | [protected] |
Make measurement sensitivity matrix.
Definition at line 123 of file motion_model.cpp.
void constant_velocity_nh::makeMeasure | ( | ) | [protected] |
Make measurement, used when measurement is not possible (i'm not using it now).
Definition at line 209 of file motion_model.cpp.
void constant_velocity_nh::makeProcess | ( | ) | [protected] |
Make process, model iteration.
Definition at line 185 of file motion_model.cpp.
void constant_velocity_nh::makeQ | ( | ) | [protected] |
Make process noise covariance matrix.
Definition at line 313 of file motion_model.cpp.
void constant_velocity_nh::makeR | ( | ) | [protected] |
Make measurement noise covariance matrix.
Definition at line 223 of file motion_model.cpp.
void constant_velocity_nh::makeV | ( | ) | [protected] |
Make measurement noise sensitivity matrix.
Definition at line 215 of file motion_model.cpp.
void constant_velocity_nh::makeW | ( | ) | [protected] |
Make process noise sensitivity matrix.
Definition at line 140 of file motion_model.cpp.
void constant_velocity_nh::updateDt | ( | double | _dt | ) |
Update the iteration interval.
Definition at line 66 of file motion_model.cpp.
double constant_velocity_nh::dt |
Iteration interval.
Definition at line 58 of file motion_model.h.
double constant_velocity_nh::l |
Wheel base of the nonholonomic vehicle.
Definition at line 56 of file motion_model.h.
scan_matching_method constant_velocity_nh::method [protected] |
Scan matching method used, this will influence the errors.
Definition at line 108 of file motion_model.h.