Skip to content

Instantly share code, notes, and snippets.

@UditSinghParihar
Created September 5, 2019 02:14
Show Gist options
  • Save UditSinghParihar/54104d180a5cb0d0edb1cfb0432c272e to your computer and use it in GitHub Desktop.
Save UditSinghParihar/54104d180a5cb0d0edb1cfb0432c272e to your computer and use it in GitHub Desktop.
Comparison of trajectory optimization using different algorithms
  1. Following are the results of noisy trajectory optmization in g2o using Cauchy Cost Function vs DCS Algorithm.
@UditSinghParihar
Copy link
Author

UditSinghParihar commented Sep 5, 2019

  1. Left : Cauchy Algorithm (Kernel width = 1) and Right : DCS Algorithm (Kernel width = 1).
    Orange color trajectory is the output from optimization.
    dcs_comp_data2
  2. Manhattan constraints on the left side of the graph has high noise, which are successfully detected by DCS Algorithm and turned off in optimization, while Cauchy Algorithm fails to detect them as faulty constraints, so it used them in optmization.
    manh
  3. Left : G2o optimized with Cauchy Algorithm and Right : G2o optimized with DCS algorithm:
    comb_dcs_data2
    4 . Using DCS Algorithm with star shaped trajectories (highly distorted) does not lead to any optimization and it just simply turns off all the loop closing manhattan constraints.

Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment