Started to try and incorporate sparse bundle adjustment. Getting some odd crashes at the moment...