Lines Matching refs:measurements
67 void updateKalmanFilter( KalmanFilter &KF, Mat &measurements,
69 void fillMeasurements( Mat &measurements,
143 double dt = 0.125; // time between measurements (1/FPS)
146 Mat measurements(nMeasurements, 1, CV_64F); measurements.setTo(Scalar(0));
261 // fill the measurements vector
262 fillMeasurements(measurements, translation_measured, rotation_measured);
272 // update the Kalman filter with good measurements
273 updateKalmanFilter( KF, measurements,
457 void fillMeasurements( Mat &measurements,
465 measurements.at<double>(0) = translation_measured.at<double>(0); // x
466 measurements.at<double>(1) = translation_measured.at<double>(1); // y
467 measurements.at<double>(2) = translation_measured.at<double>(2); // z
468 measurements.at<double>(3) = measured_eulers.at<double>(0); // roll
469 measurements.at<double>(4) = measured_eulers.at<double>(1); // pitch
470 measurements.at<double>(5) = measured_eulers.at<double>(2); // yaw
