c++ - 卡尔曼，最小二乘或

为了帮助人们理解我所问的问题，我选择完全改写。我希望这可以解决。

我正在以1秒的速率收集gps数据（经纬度）。了解到此数据可能不是100％准确的，并且偶有（1个或多个）数据点很不合理，因此，删除异常点以确定最准确的过程的最合适方法是：车速？这种车辆通常每小时可以直线行驶0-60英里，但也可能会突然转弯（加权值？）。

对于造成的混淆，我深表歉意。此外，对于未能理解已经提出的建议，我深表歉意。

最佳答案

标准算法adjacent_difference将在一系列迭代器中的每个元素之间产生差异。因此，如果有5个元素，则会产生4个差异。

这些是我们将使用的标准库：

#include <vector>
#include <iostream>
#include <iterator>
#include <algorithm>
#include <numeric>

我不知道您的GPS班长什么样。我将假设它是一维的：

class Position
{
public:
    Position() :
    m_position(0)
    {
    }

    Position(int position) :
    m_position(position)
    {
    }

    Position operator-(const Position& other) const
    {
        return Position(m_position - other.m_position);
    }
    operator int() const
    {
        return m_position;
    }
private:
    int m_position;
};

Position abs_sum(const Position& lhs, const Position& rhs)
{
    return Position(abs(int(lhs)) + abs(int(rhs)));
}

把它放在一起：

int main()
{
    using namespace std; // for brevity - don't really do this in your code

    vector<Position> positions;
    positions.push_back(Position(13));
    positions.push_back(Position(23));
    positions.push_back(Position(17));
    positions.push_back(Position(19));

    vector<Position> displacements;

    adjacent_difference(positions.begin(), positions.end(),
                        back_inserter(displacements));

    cout << "Displacements: ";
    copy(displacements.begin(), displacements.end(),
         ostream_iterator<int>(cout, ", "));

    cout << endl;

    int distance = accumulate(displacements.begin(), displacements.end(),
                              0, abs_sum);
    cout << "Total: " << distance << endl;

    return 0;
}

输出：

Displacements: 13, 10, -6, 2,
Total: 31

关于c++ - 卡尔曼，最小二乘或，我们在Stack Overflow上找到一个类似的问题：https://stackoverflow.com/questions/10094180/