Added bundle adjustment. Added necessary mappings - which 3D point is which 2D point in each image.
Color drawing is strated but not finished.