Ejemplo n.º 1
0
    void Optimize(List <List <int> > cycles)
    {
        if (!allowOptimization)
        {
            return;
        }

        isOptimizing = true;

        for (int i = 0; i < optimizeEpoch; i++)
        {
            OptimizeOnce(ref robotTrace_predict, landmarkTrace, cycles);
        }

        //Debug.Log("Before update: " + X_rob_predict.ToString());
        X_rob_predict = robotTrace_predict[robotTrace_predict.Count - 1];

        //Debug.Log("After update: " + robotTrace_predict[robotTrace_predict.Count - 1].ToString());
        //Debug.Log("Actual pose: " + X_rob_actual.ToString());

        isOptimizing = !graphVisualizer.OptimizedVisualization(robotTrace_predict);
    }