https://colab.research.google.com/drive/1QHtpdPqkTHpM0XJMAP7VEEVUPq7JrRKe?usp=sharing
https://github.com/AerialRobotics-IITK/imav2019/blob/master/imav_planner/src/planner.cxx https://boost-ext.github.io/sml/overview.html
Link to IMAV repo- https://github.com/AerialRobotics-IITK/imav2019