[todo] add graph structure

[kemfic]

something like this
https://www.bogotobogo.com/python/python_graph_data_structures.php

makes both bundle adjustment, and visual odometry much nicer.