Skip to content

Implement P2D NDT optimization problem

Description

This MR implements P2D ndt optimization problem.

  • For more details, see the issue which will be linked below.

Notes for Reviewer

  • A cached expression template class is implemented for efficient expression computation. A state machine is implemented to track the state of a cached expression at run time.
  • Optimization problem API had to be refactored to make the templates work and fix Eigen reference issues.
  • A significant portion of the mathematical code is taken from PCL/autoware.ai implementation as they were already nicely named and formulated to begin with.

Checklist

Closes #140 (closed)

Edited by Yunus Emre Çalışkan

Merge request reports