Sparse Bundle Adjustment from http://users.ics.forth.gr/~lourakis/sba/