Release code for InCOpt: Incremental Constrained Optimization using the Bayes Tree (IROS 2022) - View it on GitHub