blob: c454a27c0d72bfbe857bebc2d490dfa5e7f13fdd (
plain)
| 1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
 | /* Copyright (c) 2019, Stephane Lenclud <github@lenclud.com>
 * Permission to use, copy, modify, and/or distribute this
 * software for any purpose with or without fee is hereby granted,
 * provided that the above copyright notice and this permission
 * notice appear in all copies.
 */
#pragma once
#include <opencv2/core.hpp>
#include <opencv2/video/tracking.hpp>
namespace EasyTracker
{
    ///
    /// TODO: do not use a constant time difference
    ///
    class KalmanFilterPose: public cv::KalmanFilter
    {
    public:
        KalmanFilterPose();
        void Init(int aStateCount, int aMeasurementCount, int aInputCount, double aDt);
        void Update(double& aX, double& aY, double& aZ, double& aRoll, double& aPitch, double& aYaw);
        cv::Mat iMeasurements;
    };
}
 |