Jessemapel bundle adjust (#71)

* added to bundle adjust nb, up to setting up bundle iteration, known issues

* Rought bundle adjust utilities

* bug fixes and adding tests

Co-authored-by: Jesse Mapel <jam826@nau.edu>