Skip to content

Add WNOA support for AugmentedPoint and QCQP/SDP conversion (unstable) - #2930

Draft
oafolaya wants to merge 2 commits into
borglab:developfrom
oafolaya:feature/wnoa-augmented-point-unstable
Draft

oafolaya wants to merge 2 commits into
borglab:developfrom
oafolaya:feature/wnoa-augmented-point-unstable

Conversation

@oafolaya

@oafolaya oafolaya commented Nov 11, 2026 •

Copy link
Copy Markdown
Contributor

Summary

This PR adds WNOA support for AugmentedPoint and introduces a continuous-time range-only localization example using WNOA.

It also adds QCQP conversion for WNOA motion and interpolated squared-range factors, building on the existing AugmentedPoint lifting and KnownLandmarkSquaredRangeFactor. The resulting range-only localization problem can then be relaxed and solved using GTSAM's SDP infrastructure.

Changes

  • Extended WNOA interpolation and motion factors to work with AugmentedPoint, including Python and MATLAB wrappers.
  • Added qcqpFactors() support for WNOA motion and interpolation factors.
  • Added auxiliary lifted points and interpolation constraints for squared-range measurements between knots.
  • Extended LiftedSDPProblem to support multi-key linear equalities.
  • Updated the range-only notebook to demonstrate the QCQP/SDP formulation.
  • Added C++, Python, and MATLAB tests.

Testing

The relevant C++ and Python tests pass, including checks for QCQP objective equivalence and interpolation constraints. MATLAB wrapper generation was checked, but the MATLAB tests have not been run yet.

To Do

  • Revert the LiftedSDPProblem extension for multi-key linear equalities and revisit the WNOA QCQP conversion to work within the existing single-key linear equality framework.
  • Run MOSEK to verify the monolithic and chordal SDP formulations.
  • Run the MATLAB tests and check MEX compilation.
  • Verify the SDP results and numerical tightness in the notebook.

This PR will remain a draft until the WNOA QCQP conversion is compatible with the existing single-key linear equality support in LiftedSDPProblem, and the MATLAB and MOSEK tests have been run locally.

This branch has not been deployed

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

Labels

None yet

Projects

None yet

Development

Successfully merging this pull request may close these issues.

1 participant