Implemented sparse object bundle adjustment, not working correctly tho